Newer
Older
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
120
121
122
#include "denm_types.hh"
#include "denm_layer_factory.hh"
#include "loggers.hh"
denm_layer::denm_layer(const std::string & p_type, const std::string & param) : t_layer<LibItsDenm__TestSystem::DenmPort>(p_type), _params(), _codec() {
loggers::get_instance().log(">>> denm_layer::denm_layer: %s, %s", to_string().c_str(), param.c_str());
// Setup parameters
params::convert(_params, param);
_params.insert(std::make_pair<std::string, std::string>("its_aid", "37")); // ETSI TS 102 965 V1.2.1 (2015-06)
_params.insert(std::make_pair<std::string, std::string>("payload_type", "1")); // DE message id - See ETSI TS 102 894
}
void denm_layer::sendMsg(const LibItsDenm__TestSystem::DenmReq& p, params& params){
loggers::get_instance().log_msg(">>> denm_layer::sendMsg: ", p);
// Encode DENM PDU
OCTETSTRING data;
if (_codec.encode(p.msgOut(), data) == -1) {
loggers::get_instance().warning("denm_layer::sendMsg: Encodeing failure");
return;
}
send_data(data, _params);
}
void denm_layer::send_data(OCTETSTRING& data, params& params) {
loggers::get_instance().log_msg(">>> denm_layer::send_data: ", data);
//params.log();
send_to_all_layers(data, params);
}
void denm_layer::receive_data(OCTETSTRING& data, params& params)
{
loggers::get_instance().log_msg(">>> denm_layer::receive_data: ", data);
// Sanity check
if (*(static_cast<const unsigned char*>(data)+ 1) != 0x01) { // Check that received packet has DEN message id - See ETSI TS 102 894
// Not a DENM message, discard it
loggers::get_instance().warning("denm_layer::receive_data: Wrong message id: 0x%02x", *(static_cast<const unsigned char*>(data)+ 1));
return;
}
// Decode the payload
LibItsDenm__TestSystem::DenmInd p;
_codec.decode(data, p.msgIn());
if (!p.msgIn().is_bound()) {
// Discard it
return;
} // else, continue
// Process lower layer data
// gnNextHeader
params::const_iterator it = params.find(params::gn_next_header);
if (it != params.cend()) {
p.gnNextHeader() = std::stoi(it->second);
} else {
p.gnNextHeader().set_to_omit();
}
// gnHeaderType
it = params.find(params::gn_header_type);
if (it != params.cend()) {
p.gnHeaderType() = std::stoi(it->second);
} else {
p.gnHeaderType().set_to_omit();
}
// gnHeaderSubtype
it = params.find(params::gn_header_sub_type);
if (it != params.cend()) {
p.gnHeaderSubtype() = std::stoi(it->second);
} else {
p.gnHeaderSubtype().set_to_omit();
}
// gnLifetime
it = params.find(params::gn_lifetime);
if (it != params.cend()) {
p.gnLifetime() = std::stoi(it->second);
} else {
p.gnLifetime().set_to_omit();
}
// gnTrafficClass
it = params.find(params::gn_traffic_class);
if (it != params.cend()) {
p.gnTrafficClass() = std::stoi(it->second);
} else {
p.gnTrafficClass().set_to_omit();
}
// btpDestinationPort
it = params.find(params::btp_destination_port);
if (it != params.cend()) {
p.btpDestinationPort() = std::stoi(it->second);
} else {
p.btpDestinationPort().set_to_omit();
}
// btpInfo
it = params.find(params::btp_info);
if (it != params.cend()) {
p.btpInfo() = std::stoi(it->second);
} else {
p.btpInfo().set_to_omit();
}
// ssp
it = params.find(_params[params::its_aid]);
if (it != params.cend()) {
loggers::get_instance().log("denm_layer::receive_data: ssp=%s", it->second.c_str());
p.ssp() = oct2bit(str2oct(CHARSTRING(it->second.c_str())));
} else {
p.ssp().set_to_omit();
}
// its_aid
if (it != params.cend()) {
p.its__aid() = std::stoi(it->second);
} else {
p.its__aid().set_to_omit();
}
// Pass it to the ports if amy
to_all_upper_ports(p, params);
}
denm_layer_factory denm_layer_factory::_f;