1 files changed, 144 insertions, 0 deletions
diff --git a/implementation/protocol/src/subscribe_command.cpp b/implementation/protocol/src/subscribe_command.cpp
new file mode 100644
index 0000000..89f19af
--- /dev/null
+++ b/implementation/protocol/src/subscribe_command.cpp
@@ -0,0 +1,144 @@
+// Copyright (C) 2021 Bayerische Motoren Werke Aktiengesellschaft (BMW AG)
+// This Source Code Form is subject to the terms of the Mozilla Public
+// License, v. 2.0. If a copy of the MPL was not distributed with this
+// file, You can obtain one at http://mozilla.org/MPL/2.0/.
+
+#include <limits>
+
+#include <vsomeip/constants.hpp>
+
+#include "../include/subscribe_command.hpp"
+
+namespace vsomeip_v3 {
+namespace protocol {
+
+subscribe_command::subscribe_command()
+    : subscribe_command_base(id_e::SUBSCRIBE_ID) {
+}
+
+std::shared_ptr<debounce_filter_t>
+subscribe_command::get_filter() const {
+
+    return filter_;
+}
+
+void
+subscribe_command::set_filter(
+        const std::shared_ptr<debounce_filter_t> &_filter) {
+
+    filter_ = _filter;
+}
+
+void
+subscribe_command::serialize(std::vector<byte_t> &_buffer,
+        error_e &_error) const {
+
+    size_t its_size(COMMAND_HEADER_SIZE
+            + sizeof(service_) + sizeof(instance_)
+            + sizeof(eventgroup_) + sizeof(major_)
+            + sizeof(event_) + sizeof(pending_id_));
+    size_t its_offset(its_size);
+
+    if (filter_) {
+        its_size += sizeof(filter_->on_change_)
+                + sizeof(filter_->on_change_resets_interval_)
+                + sizeof(filter_->interval_)
+                + (filter_->ignore_.size() * (sizeof(size_t) + sizeof(byte_t)));
+    }
+
+    if (its_size > std::numeric_limits<command_size_t>::max()) {
+
+        _error = error_e::ERROR_MAX_COMMAND_SIZE_EXCEEDED;
+        return;
+    }
+
+    // resize buffer
+    _buffer.resize(its_size);
+
+    // set size
+    size_ = static_cast<command_size_t>(its_size - COMMAND_HEADER_SIZE);
+
+    // serialize header
+    subscribe_command_base::serialize(_buffer, _error);
+    if (_error != error_e::ERROR_OK)
+        return;
+
+    if (filter_) {
+
+        _buffer[its_offset] = static_cast<byte_t>(filter_->on_change_);
+        its_offset += sizeof(filter_->on_change_);
+        _buffer[its_offset] = static_cast<byte_t>(filter_->on_change_resets_interval_);
+        its_offset += sizeof(filter_->on_change_resets_interval_);
+        std::memcpy(&_buffer[its_offset], &filter_->interval_, sizeof(filter_->interval_));
+        its_offset += sizeof(filter_->interval_);
+        for (const auto &its_ignore : filter_->ignore_) {
+            std::memcpy(&_buffer[its_offset], &its_ignore.first, sizeof(size_t));
+            its_offset += sizeof(size_t);
+            _buffer[its_offset] = its_ignore.second;
+            its_offset += sizeof(byte_t);
+        }
+    }
+}
+
+void
+subscribe_command::deserialize(const std::vector<byte_t> &_buffer,
+        error_e &_error) {
+
+    size_t its_size(COMMAND_HEADER_SIZE
+            + sizeof(service_) + sizeof(instance_)
+            + sizeof(eventgroup_) + sizeof(major_)
+            + sizeof(event_) + sizeof(pending_id_));
+
+    if (its_size > _buffer.size()) {
+
+        _error = error_e::ERROR_NOT_ENOUGH_BYTES;
+        return;
+    }
+
+    // deserialize header
+    command::deserialize(_buffer, _error);
+    if (_error != error_e::ERROR_OK)
+        return;
+
+    // deserialize subscription
+    subscribe_command_base::deserialize(_buffer, _error);
+    if (_error != error_e::ERROR_OK)
+        return;
+
+    // deserialize filter
+    size_t its_offset(its_size);
+    if (_buffer.size() - its_offset
+            >= sizeof(bool) + sizeof(bool) + sizeof(int64_t)) {
+
+        filter_ = std::make_shared<debounce_filter_t>();
+        std::memcpy(&filter_->on_change_, &_buffer[its_offset], sizeof(filter_->on_change_));
+        its_offset += sizeof(filter_->on_change_);
+        std::memcpy(&filter_->on_change_resets_interval_, &_buffer[its_offset], sizeof(filter_->on_change_resets_interval_));
+        its_offset += sizeof(filter_->on_change_resets_interval_);
+        std::memcpy(&filter_->interval_, &_buffer[its_offset], sizeof(filter_->interval_));
+        its_offset += sizeof(filter_->interval_);
+
+        while (_buffer.size() - its_offset
+                >= sizeof(size_t) + sizeof(byte_t)) {
+
+            size_t its_key;
+            byte_t its_value;
+
+            std::memcpy(&its_key, &_buffer[its_offset], sizeof(its_key));
+            if (filter_->ignore_.find(its_key) != filter_->ignore_.end()) {
+
+                _error = error_e::ERROR_MALFORMED;
+                return;
+            }
+
+            its_offset += sizeof(its_key);
+            its_value = _buffer[its_offset];
+            its_offset += sizeof(its_value);
+
+            filter_->ignore_.emplace(std::make_pair(its_key, its_value));
+        }
+    }
+}
+
+} // namespace protocol
+} // namespace vsomeip