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
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
|
// Copyright (C) 2022 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/.
#ifndef VSOMEIP_V3_UDP_SERVER_ENDPOINT_IMPL_RECEIVE_OP_HPP_
#define VSOMEIP_V3_UDP_SERVER_ENDPOINT_IMPL_RECEIVE_OP_HPP_
#if VSOMEIP_BOOST_VERSION >= 106600
#if defined(__linux__) || defined(ANDROID)
#include <iomanip>
#include <boost/asio/ip/udp.hpp>
#include <vsomeip/internal/logger.hpp>
namespace vsomeip_v3 {
struct udp_server_endpoint_impl_receive_op {
using socket_type_t = boost::asio::ip::udp::socket;
using endpoint_type_t = boost::asio::ip::udp::endpoint;
using receive_handler_t =
std::function<void(boost::system::error_code const &_error, std::size_t _size,
std::uint8_t, const boost::asio::ip::address &)>;
socket_type_t &socket_;
endpoint_type_t &sender_;
receive_handler_t handler_;
byte_t *buffer_;
size_t length_;
uint8_t multicast_id_;
bool is_v4_;
boost::asio::ip::address destination_;
size_t bytes_;
void operator()(boost::system::error_code _error) {
sender_ = endpoint_type_t(); // reset
if (!_error) {
if (!socket_.native_non_blocking())
socket_.native_non_blocking(true, _error);
for (;;) {
ssize_t its_result;
int its_flags(0);
// Create control elements
msghdr its_header = msghdr();
struct iovec its_vec[1];
// Prepare
its_vec[0].iov_base = buffer_;
its_vec[0].iov_len = length_;
// Add io buffer
its_header.msg_iov = its_vec;
its_header.msg_iovlen = 1;
// Sender & destination address info
union {
struct sockaddr_in v4;
struct sockaddr_in6 v6;
} addr;
union {
struct cmsghdr cmh;
union {
char v4[CMSG_SPACE(sizeof(struct in_pktinfo))];
char v6[CMSG_SPACE(sizeof(struct in6_pktinfo))];
} control;
} control_un;
// Prepare
if (is_v4_) {
its_header.msg_name = &addr;
its_header.msg_namelen = sizeof(sockaddr_in);
its_header.msg_control = control_un.control.v4;
its_header.msg_controllen = sizeof(control_un.control.v4);
} else {
its_header.msg_name = &addr;
its_header.msg_namelen = sizeof(sockaddr_in6);
its_header.msg_control = control_un.control.v6;
its_header.msg_controllen = sizeof(control_un.control.v6);
}
// Call recvmsg and handle its result
errno = 0;
its_result = ::recvmsg(socket_.native_handle(), &its_header, its_flags);
_error = boost::system::error_code(its_result < 0 ? errno : 0,
boost::asio::error::get_system_category());
bytes_ += _error ? 0 : static_cast<size_t>(its_result);
if (_error == boost::asio::error::interrupted)
continue;
if (_error == boost::asio::error::would_block
|| _error == boost::asio::error::try_again) {
socket_.async_wait(socket_type_t::wait_read, *this);
return;
}
if (_error)
break;
if (bytes_ == 0)
_error = boost::asio::error::eof;
// Extract sender & destination addresses
if (is_v4_) {
// sender
boost::asio::ip::address_v4 its_sender_address(
ntohl(addr.v4.sin_addr.s_addr));
in_port_t its_sender_port(ntohs(addr.v4.sin_port));
sender_ = endpoint_type_t(its_sender_address, its_sender_port);
// destination
struct in_pktinfo *its_pktinfo_v4;
for (struct cmsghdr *cmsg = CMSG_FIRSTHDR(&its_header);
cmsg != NULL;
cmsg = CMSG_NXTHDR(&its_header, cmsg)) {
if (cmsg->cmsg_level == IPPROTO_IP
&& cmsg->cmsg_type == IP_PKTINFO
&& cmsg->cmsg_len == CMSG_LEN(sizeof(*its_pktinfo_v4))) {
its_pktinfo_v4 = (struct in_pktinfo*) CMSG_DATA(cmsg);
if (its_pktinfo_v4) {
destination_ = boost::asio::ip::address_v4(
ntohl(its_pktinfo_v4->ipi_addr.s_addr));
break;
}
}
}
} else {
boost::asio::ip::address_v6::bytes_type its_bytes;
// sender
boost::asio::ip::address_v6 its_sender_address;
for (size_t i = 0; i < its_bytes.size(); i++)
its_bytes[i] = addr.v6.sin6_addr.s6_addr[i];
in_port_t its_sender_port(ntohs(addr.v6.sin6_port));
sender_ = endpoint_type_t(its_sender_address, its_sender_port);
struct in6_pktinfo *its_pktinfo_v6;
for (struct cmsghdr *cmsg = CMSG_FIRSTHDR(&its_header);
cmsg != NULL;
cmsg = CMSG_NXTHDR(&its_header, cmsg)) {
if (cmsg->cmsg_level == IPPROTO_IPV6
&& cmsg->cmsg_type == IPV6_PKTINFO
&& cmsg->cmsg_len == CMSG_LEN(sizeof(*its_pktinfo_v6))) {
its_pktinfo_v6 = (struct in6_pktinfo *) CMSG_DATA(cmsg);
if (its_pktinfo_v6) {
for (size_t i = 0; i < its_bytes.size(); i++)
its_bytes[i] = its_pktinfo_v6->ipi6_addr.s6_addr[i];
destination_ = boost::asio::ip::address_v6(its_bytes);
break;
}
}
}
}
break;
}
}
// Call the handler
handler_(_error, bytes_, multicast_id_, destination_);
}
};
} // namespace vsomeip
#endif // __linux__ || ANDROID
#endif // VSOMEIP_BOOST_VERSION >= 106600
#endif // VSOMEIP_V3_UDP_SERVER_ENDPOINT_IMPL_RECEIVE_OP_HPP_
|
