1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
|
// 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 "../include/multiple_services_command_base.hpp"
namespace vsomeip_v3 {
namespace protocol {
multiple_services_command_base::multiple_services_command_base(id_e _id)
: command(_id) {
}
void
multiple_services_command_base::serialize(std::vector<byte_t> &_buffer,
error_e &_error) const {
size_t its_size(COMMAND_HEADER_SIZE
+ (services_.size()
* (sizeof(service::service_) + sizeof(service::instance_)
+ sizeof(service::major_) + sizeof(service::minor_))));
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
command::serialize(_buffer, _error);
if (_error != error_e::ERROR_OK)
return;
// serialize payload
size_t its_offset(COMMAND_POSITION_PAYLOAD);
for (const auto &s : services_) {
std::memcpy(&_buffer[its_offset], &s.service_, sizeof(s.service_));
its_offset += sizeof(s.service_);
std::memcpy(&_buffer[its_offset], &s.instance_, sizeof(s.instance_));
its_offset += sizeof(s.instance_);
_buffer[its_offset] = s.major_;
its_offset += sizeof(s.major_);
std::memcpy(&_buffer[its_offset], &s.minor_, sizeof(s.minor_));
its_offset += sizeof(s.minor_);
}
}
void
multiple_services_command_base::deserialize(const std::vector<byte_t> &_buffer,
error_e &_error) {
if (COMMAND_HEADER_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 payload
size_t its_offset(COMMAND_POSITION_PAYLOAD);
size_t its_count = (_buffer.size() - its_offset) /
(sizeof(service::service_) + sizeof(service::instance_)
+ sizeof(service::major_) + sizeof(service::minor_));
for (size_t i = 0; i < its_count; i++) {
service its_service;
std::memcpy(&its_service.service_, &_buffer[its_offset],
sizeof(its_service.service_));
its_offset += sizeof(its_service.service_);
std::memcpy(&its_service.instance_, &_buffer[its_offset],
sizeof(its_service.instance_));
its_offset += sizeof(its_service.instance_);
std::memcpy(&its_service.major_, &_buffer[its_offset],
sizeof(its_service.major_));
its_offset += sizeof(its_service.major_);
std::memcpy(&its_service.minor_, &_buffer[its_offset],
sizeof(its_service.minor_));
its_offset += sizeof(its_service.minor_);
services_.insert(its_service);
}
}
std::set<service>
multiple_services_command_base::get_services() const {
return (services_);
}
void
multiple_services_command_base::set_services(const std::set<service> &_services) {
services_ = _services;
}
void
multiple_services_command_base::add_service(const service &_service) {
services_.insert(_service);
}
} // namespace protocol
} // namespace vsomeip
|