blob: e5cb4baa78f06496aa5a9ee9c3d4522ad618c85b (
plain)
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
|
// Copyright (C) 2014-2017 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 "../../../../../e2e_protection/include/e2e/profile/profile01/protector.hpp"
#include <vsomeip/internal/logger.hpp>
#include <iostream>
#include <sstream>
#include <string>
#include <iomanip>
namespace vsomeip_v3 {
namespace e2e {
namespace profile01 {
/** @req [SWS_E2E_00195] */
void protector::protect(e2e_buffer &_buffer, instance_t _instance) {
(void)_instance;
std::lock_guard<std::mutex> lock(protect_mutex_);
if (profile_01::is_buffer_length_valid(config_, _buffer)) {
// write the current Counter value in Data
write_counter(_buffer);
// write DataID nibble in Data (E2E_P01_DATAID_NIBBLE) in Data
write_data_id(_buffer);
// compute the CRC over DataID and Data
uint8_t computed_crc = profile_01::compute_crc(config_, _buffer);
// write CRC in Data
write_crc(_buffer, computed_crc);
// increment the Counter (new value will be used in the next invocation of E2E_P01Protect()),
increment_counter();
}
}
/** @req [SRS_E2E_08528] */
void protector::write_counter(e2e_buffer &_buffer) {
if (config_.counter_offset_ % 8 == 0) {
// write write counter value into low nibble
_buffer[config_.counter_offset_ / 8] =
static_cast<uint8_t>((_buffer[config_.counter_offset_ / 8] & 0xF0) | (counter_ & 0x0F));
} else {
// write counter into high nibble
_buffer[config_.counter_offset_ / 8] =
static_cast<uint8_t>((_buffer[config_.counter_offset_ / 8] & 0x0F) | ((counter_ << 4) & 0xF0));
}
}
/** @req [SRS_E2E_08528] */
void protector::write_data_id(e2e_buffer &_buffer) {
if (config_.data_id_mode_ == p01_data_id_mode::E2E_P01_DATAID_NIBBLE) {
if (config_.data_id_nibble_offset_ % 8 == 0) {
// write low nibble of high byte of Data ID
_buffer[config_.data_id_nibble_offset_ / 8] =
static_cast<uint8_t>((_buffer[config_.data_id_nibble_offset_ / 8] & 0xF0) | ((config_.data_id_ >> 8) & 0x0F));
} else {
// write low nibble of high byte of Data ID
_buffer[config_.data_id_nibble_offset_ / 8] =
static_cast<uint8_t>((_buffer[config_.data_id_nibble_offset_ / 8] & 0x0F) | ((config_.data_id_ >> 4) & 0xF0));
}
}
}
/** @req [SRS_E2E_08528] */
void protector::write_crc(e2e_buffer &_buffer, uint8_t _computed_crc) {
_buffer[config_.crc_offset_] = _computed_crc;
}
/** @req [SWS_E2E_00075] */
void protector::increment_counter(void) {
counter_ = static_cast<uint8_t>((counter_ + 1U) % 15);
}
} // namespace profile01
} // namespace e2e
} // namespace vsomeip_v3
|