diff options
Diffstat (limited to 'implementation/endpoints/src/udp_client_endpoint_impl.cpp')
| -rw-r--r-- | implementation/endpoints/src/udp_client_endpoint_impl.cpp | 807 |
1 files changed, 432 insertions, 375 deletions
diff --git a/implementation/endpoints/src/udp_client_endpoint_impl.cpp b/implementation/endpoints/src/udp_client_endpoint_impl.cpp index 67c9703..ec8c991 100644 --- a/implementation/endpoints/src/udp_client_endpoint_impl.cpp +++ b/implementation/endpoints/src/udp_client_endpoint_impl.cpp @@ -1,382 +1,439 @@ -// 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 <iomanip>
-#include <sstream>
-
-#include <boost/asio/ip/multicast.hpp>
-
-#include "../include/endpoint_host.hpp"
-#include "../include/udp_client_endpoint_impl.hpp"
-#include "../../logging/include/logger.hpp"
-#include "../../utility/include/utility.hpp"
-
-namespace vsomeip {
-
-udp_client_endpoint_impl::udp_client_endpoint_impl(
- std::shared_ptr< endpoint_host > _host,
- endpoint_type _local,
- endpoint_type _remote,
- boost::asio::io_service &_io,
- configuration::endpoint_queue_limit_t _queue_limit,
- std::uint32_t _udp_receive_buffer_size)
- : udp_client_endpoint_base_impl(_host, _local, _remote, _io,
- VSOMEIP_MAX_UDP_MESSAGE_SIZE, _queue_limit),
- remote_address_(_remote.address()),
- remote_port_(_remote.port()),
- udp_receive_buffer_size_(_udp_receive_buffer_size) {
-}
-
-udp_client_endpoint_impl::~udp_client_endpoint_impl() {
- std::shared_ptr<endpoint_host> its_host = host_.lock();
- if (its_host) {
- its_host->release_port(local_.port(), false);
- }
-}
-
-bool udp_client_endpoint_impl::is_local() const {
- return false;
-}
-
-void udp_client_endpoint_impl::connect() {
- std::lock_guard<std::mutex> its_lock(socket_mutex_);
- boost::system::error_code its_error;
- socket_->open(remote_.protocol(), its_error);
- if (!its_error || its_error == boost::asio::error::already_open) {
- // Enable SO_REUSEADDR to avoid bind problems with services going offline
- // and coming online again and the user has specified only a small number
- // of ports in the clients section for one service instance
- socket_->set_option(boost::asio::socket_base::reuse_address(true), its_error);
- if (its_error) {
- VSOMEIP_WARNING << "udp_client_endpoint_impl::connect: couldn't enable "
- << "SO_REUSEADDR: " << its_error.message() << " remote:"
- << get_address_port_remote();
- }
- socket_->set_option(boost::asio::socket_base::receive_buffer_size(
- udp_receive_buffer_size_), its_error);
- if (its_error) {
- VSOMEIP_WARNING << "udp_client_endpoint_impl::connect: couldn't set "
- << "SO_RCVBUF: " << its_error.message() << " to: "
- << std::dec << udp_receive_buffer_size_ << " remote:"
- << get_address_port_remote();
- } else {
- boost::asio::socket_base::receive_buffer_size its_option;
- socket_->get_option(its_option, its_error);
- if (its_error) {
- VSOMEIP_WARNING << "udp_client_endpoint_impl::connect: couldn't get "
- << "SO_RCVBUF: " << its_error.message() << " remote:"
- << get_address_port_remote();
- } else {
- VSOMEIP_INFO << "udp_client_endpoint_impl::connect: SO_RCVBUF is: "
- << std::dec << its_option.value();
- }
- }
-
- // In case a client endpoint port was configured,
- // bind to it before connecting
- if (local_.port() != ILLEGAL_PORT) {
- boost::system::error_code its_bind_error;
- socket_->bind(local_, its_bind_error);
- if(its_bind_error) {
- VSOMEIP_WARNING << "udp_client_endpoint::connect: "
- "Error binding socket: " << its_bind_error.message()
- << " remote:" << get_address_port_remote();
- try {
- // don't connect on bind error to avoid using a random port
+// Copyright (C) 2014-2018 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 <iomanip> +#include <sstream> + +#include <boost/asio/ip/multicast.hpp> +#include <vsomeip/internal/logger.hpp> + +#include "../include/endpoint_host.hpp" +#include "../include/tp.hpp" +#include "../../routing/include/routing_host.hpp" +#include "../include/udp_client_endpoint_impl.hpp" +#include "../../utility/include/utility.hpp" + +namespace vsomeip_v3 { + +udp_client_endpoint_impl::udp_client_endpoint_impl( + const std::shared_ptr<endpoint_host>& _endpoint_host, + const std::shared_ptr<routing_host>& _routing_host, + const endpoint_type& _local, + const endpoint_type& _remote, + boost::asio::io_service &_io, + const std::shared_ptr<configuration>& _configuration) + : udp_client_endpoint_base_impl(_endpoint_host, _routing_host, _local, + _remote, _io, VSOMEIP_MAX_UDP_MESSAGE_SIZE, + _configuration->get_endpoint_queue_limit( + _remote.address().to_string(), + _remote.port()), + _configuration), + remote_address_(_remote.address()), + remote_port_(_remote.port()), + udp_receive_buffer_size_(_configuration->get_udp_receive_buffer_size()), + tp_reassembler_(std::make_shared<tp::tp_reassembler>( + _configuration->get_max_message_size_unreliable(), _io)) { + is_supporting_someip_tp_ = true; +} + +udp_client_endpoint_impl::~udp_client_endpoint_impl() { + std::shared_ptr<endpoint_host> its_host = endpoint_host_.lock(); + if (its_host) { + its_host->release_port(local_.port(), false); + } + tp_reassembler_->stop(); +} + +bool udp_client_endpoint_impl::is_local() const { + return false; +} + +void udp_client_endpoint_impl::connect() { + std::lock_guard<std::mutex> its_lock(socket_mutex_); + boost::system::error_code its_error; + socket_->open(remote_.protocol(), its_error); + if (!its_error || its_error == boost::asio::error::already_open) { + // Enable SO_REUSEADDR to avoid bind problems with services going offline + // and coming online again and the user has specified only a small number + // of ports in the clients section for one service instance + socket_->set_option(boost::asio::socket_base::reuse_address(true), its_error); + if (its_error) { + VSOMEIP_WARNING << "udp_client_endpoint_impl::connect: couldn't enable " + << "SO_REUSEADDR: " << its_error.message() << " remote:" + << get_address_port_remote(); + } + socket_->set_option(boost::asio::socket_base::receive_buffer_size( + udp_receive_buffer_size_), its_error); + if (its_error) { + VSOMEIP_WARNING << "udp_client_endpoint_impl::connect: couldn't set " + << "SO_RCVBUF: " << its_error.message() << " to: " + << std::dec << udp_receive_buffer_size_ << " remote:" + << get_address_port_remote(); + } else { + boost::asio::socket_base::receive_buffer_size its_option; + socket_->get_option(its_option, its_error); + if (its_error) { + VSOMEIP_WARNING << "udp_client_endpoint_impl::connect: couldn't get " + << "SO_RCVBUF: " << its_error.message() << " remote:" + << get_address_port_remote(); + } else { + VSOMEIP_INFO << "udp_client_endpoint_impl::connect: SO_RCVBUF is: " + << std::dec << its_option.value(); + } + } + +#ifndef _WIN32 + // If specified, bind to device + std::string its_device(configuration_->get_device()); + if (its_device != "") { + if (setsockopt(socket_->native_handle(), + SOL_SOCKET, SO_BINDTODEVICE, its_device.c_str(), (int)its_device.size()) == -1) { + VSOMEIP_WARNING << "UDP Client: Could not bind to device \"" << its_device << "\""; + } + } +#endif + + // In case a client endpoint port was configured, + // bind to it before connecting + if (local_.port() != ILLEGAL_PORT) { + boost::system::error_code its_bind_error; + socket_->bind(local_, its_bind_error); + if(its_bind_error) { + VSOMEIP_WARNING << "udp_client_endpoint::connect: " + "Error binding socket: " << its_bind_error.message() + << " remote:" << get_address_port_remote(); + try { + // don't connect on bind error to avoid using a random port strand_.post(std::bind(&client_endpoint_impl::connect_cbk, - shared_from_this(), its_bind_error));
- } catch (const std::exception &e) {
- VSOMEIP_ERROR << "udp_client_endpoint_impl::connect: "
- << e.what() << " remote:" << get_address_port_remote();
- }
- return;
- }
- }
- state_ = cei_state_e::CONNECTING;
- socket_->async_connect(
- remote_,
+ shared_from_this(), its_bind_error)); + } catch (const std::exception &e) { + VSOMEIP_ERROR << "udp_client_endpoint_impl::connect: " + << e.what() << " remote:" << get_address_port_remote(); + } + return; + } + } + + state_ = cei_state_e::CONNECTING; + socket_->async_connect( + remote_, strand_.wrap( std::bind( &udp_client_endpoint_base_impl::connect_cbk, shared_from_this(), std::placeholders::_1 ) - )
- );
- } else {
- VSOMEIP_WARNING << "udp_client_endpoint::connect: Error opening socket: "
- << its_error.message() << " remote:" << get_address_port_remote();
- strand_.post(std::bind(&udp_client_endpoint_base_impl::connect_cbk,
- shared_from_this(), its_error));
- }
-}
-
-void udp_client_endpoint_impl::start() {
- connect();
-}
-
-void udp_client_endpoint_impl::restart(bool _force) {
- if (!_force && state_ == cei_state_e::CONNECTING) {
- return;
- }
- state_ = cei_state_e::CONNECTING;
- {
- std::lock_guard<std::mutex> its_lock(mutex_);
- queue_.clear();
- }
- std::string local;
- {
- std::lock_guard<std::mutex> its_lock(socket_mutex_);
- local = get_address_port_local();
- }
- shutdown_and_close_socket(false);
- was_not_connected_ = true;
- reconnect_counter_ = 0;
- VSOMEIP_WARNING << "uce::restart: local: " << local
- << " remote: " << get_address_port_remote();
- start_connect_timer();
-}
-
-void udp_client_endpoint_impl::send_queued() {
- message_buffer_ptr_t its_buffer;
- if(queue_.size()) {
- its_buffer = queue_.front();
- } else {
- return;
- }
-#if 0
- std::stringstream msg;
- msg << "ucei<" << remote_.address() << ":"
- << std::dec << remote_.port() << ">::sq: ";
- for (std::size_t i = 0; i < its_buffer->size(); i++)
- msg << std::hex << std::setw(2) << std::setfill('0')
- << (int)(*its_buffer)[i] << " ";
- VSOMEIP_INFO << msg.str();
-#endif
- {
- std::lock_guard<std::mutex> its_lock(socket_mutex_);
- socket_->async_send(
- boost::asio::buffer(*its_buffer),
- std::bind(
- &udp_client_endpoint_base_impl::send_cbk,
- shared_from_this(),
- std::placeholders::_1,
- std::placeholders::_2,
- its_buffer
- )
- );
- }
-}
-
-void udp_client_endpoint_impl::receive() {
- std::lock_guard<std::mutex> its_lock(socket_mutex_);
- if (!socket_->is_open()) {
- return;
- }
- message_buffer_ptr_t its_buffer = std::make_shared<message_buffer_t>(VSOMEIP_MAX_UDP_MESSAGE_SIZE);
- socket_->async_receive_from(
- boost::asio::buffer(*its_buffer),
- remote_,
- strand_.wrap(
- std::bind(
- &udp_client_endpoint_impl::receive_cbk,
- std::dynamic_pointer_cast<
- udp_client_endpoint_impl
- >(shared_from_this()),
- std::placeholders::_1,
- std::placeholders::_2,
- its_buffer
- )
- )
- );
-}
-
-bool udp_client_endpoint_impl::get_remote_address(
- boost::asio::ip::address &_address) const {
- if (remote_address_.is_unspecified()) {
- return false;
- }
- _address = remote_address_;
- return true;
-}
-
-void udp_client_endpoint_impl::set_local_port() {
- std::lock_guard<std::mutex> its_lock(socket_mutex_);
- boost::system::error_code its_error;
- if (socket_->is_open()) {
- endpoint_type its_endpoint = socket_->local_endpoint(its_error);
- if (!its_error) {
- local_port_ = its_endpoint.port();
- } else {
- VSOMEIP_WARNING << "udp_client_endpoint_impl::set_local_port() "
- << " couldn't get local_endpoint: " << its_error.message();
- }
- }
-}
-
-std::uint16_t udp_client_endpoint_impl::get_remote_port() const {
- return remote_port_;
-}
-
-void udp_client_endpoint_impl::receive_cbk(
- boost::system::error_code const &_error, std::size_t _bytes,
- message_buffer_ptr_t _recv_buffer) {
- if (_error == boost::asio::error::operation_aborted) {
- // endpoint was stopped
- return;
- }
- std::shared_ptr<endpoint_host> its_host = host_.lock();
- if (!_error && 0 < _bytes && its_host) {
-#if 0
- std::stringstream msg;
- msg << "ucei::rcb(" << _error.message() << "): ";
- for (std::size_t i = 0; i < _bytes + recv_buffer_size_; ++i)
- msg << std::hex << std::setw(2) << std::setfill('0')
- << (int) (*_recv_buffer)[i] << " ";
- VSOMEIP_INFO << msg.str();
-#endif
- std::size_t remaining_bytes = _bytes;
- std::size_t i = 0;
-
- do {
- uint64_t read_message_size
- = utility::get_message_size(&(*_recv_buffer)[i],
- remaining_bytes);
- if (read_message_size > MESSAGE_SIZE_UNLIMITED) {
- VSOMEIP_ERROR << "Message size exceeds allowed maximum!";
- return;
- }
- uint32_t current_message_size = static_cast<uint32_t>(read_message_size);
- if (current_message_size > VSOMEIP_SOMEIP_HEADER_SIZE &&
- current_message_size <= remaining_bytes) {
- if (remaining_bytes - current_message_size > remaining_bytes) {
- VSOMEIP_ERROR << "buffer underflow in udp client endpoint ~> abort!";
- return;
- } else if (current_message_size > VSOMEIP_RETURN_CODE_POS &&
- ((*_recv_buffer)[i + VSOMEIP_PROTOCOL_VERSION_POS] != VSOMEIP_PROTOCOL_VERSION ||
- !utility::is_valid_message_type(static_cast<message_type_e>((*_recv_buffer)[i + VSOMEIP_MESSAGE_TYPE_POS])) ||
- !utility::is_valid_return_code(static_cast<return_code_e>((*_recv_buffer)[i + VSOMEIP_RETURN_CODE_POS]))
- )) {
- if ((*_recv_buffer)[i + VSOMEIP_PROTOCOL_VERSION_POS] != VSOMEIP_PROTOCOL_VERSION) {
- VSOMEIP_ERROR << "uce: Wrong protocol version: 0x"
- << std::hex << std::setw(2) << std::setfill('0')
- << std::uint32_t((*_recv_buffer)[i + VSOMEIP_PROTOCOL_VERSION_POS])
- << " local: " << get_address_port_local()
- << " remote: " << get_address_port_remote();
- // ensure to send back a message w/ wrong protocol version
- its_host->on_message(&(*_recv_buffer)[i],
- VSOMEIP_SOMEIP_HEADER_SIZE + 8, this,
- boost::asio::ip::address(),
- VSOMEIP_ROUTING_CLIENT,
- remote_address_,
- remote_port_);
- } else if (!utility::is_valid_message_type(static_cast<message_type_e>(
- (*_recv_buffer)[i + VSOMEIP_MESSAGE_TYPE_POS]))) {
- VSOMEIP_ERROR << "uce: Invalid message type: 0x"
- << std::hex << std::setw(2) << std::setfill('0')
- << std::uint32_t((*_recv_buffer)[i + VSOMEIP_MESSAGE_TYPE_POS])
- << " local: " << get_address_port_local()
- << " remote: " << get_address_port_remote();
- } else if (!utility::is_valid_return_code(static_cast<return_code_e>(
- (*_recv_buffer)[i + VSOMEIP_RETURN_CODE_POS]))) {
- VSOMEIP_ERROR << "uce: Invalid return code: 0x"
- << std::hex << std::setw(2) << std::setfill('0')
- << std::uint32_t((*_recv_buffer)[i + VSOMEIP_RETURN_CODE_POS])
- << " local: " << get_address_port_local()
- << " remote: " << get_address_port_remote();
- }
- receive();
- return;
- }
- remaining_bytes -= current_message_size;
-
- its_host->on_message(&(*_recv_buffer)[i], current_message_size,
- this, boost::asio::ip::address(),
- VSOMEIP_ROUTING_CLIENT, remote_address_,
- remote_port_);
- } else {
- VSOMEIP_ERROR << "Received a unreliable vSomeIP message with bad "
- "length field. Message size: " << current_message_size
- << " Bytes. From: " << remote_.address() << ":"
- << remote_.port() << ". Dropping message.";
- remaining_bytes = 0;
- }
- i += current_message_size;
- } while (remaining_bytes > 0);
- }
- if (!_error) {
- receive();
- } else {
- if (_error == boost::asio::error::connection_refused) {
- shutdown_and_close_socket(false);
- } else {
- receive();
- }
- }
-}
-
-const std::string udp_client_endpoint_impl::get_address_port_remote() const {
- boost::system::error_code ec;
- std::string its_address_port;
- its_address_port.reserve(21);
- boost::asio::ip::address its_address;
- if (get_remote_address(its_address)) {
- its_address_port += its_address.to_string();
- }
- its_address_port += ":";
- its_address_port += std::to_string(remote_port_);
- return its_address_port;
-}
-
-const std::string udp_client_endpoint_impl::get_address_port_local() const {
- std::string its_address_port;
- its_address_port.reserve(21);
- boost::system::error_code ec;
- if (socket_->is_open()) {
- endpoint_type its_local_endpoint = socket_->local_endpoint(ec);
- if (!ec) {
- its_address_port += its_local_endpoint.address().to_string(ec);
- its_address_port += ":";
- its_address_port.append(std::to_string(its_local_endpoint.port()));
- }
- }
- return its_address_port;
-}
-
-void udp_client_endpoint_impl::print_status() {
- std::size_t its_data_size(0);
- std::size_t its_queue_size(0);
- {
- std::lock_guard<std::mutex> its_lock(mutex_);
- its_queue_size = queue_.size();
- its_data_size = queue_size_;
- }
- std::string local;
- {
- std::lock_guard<std::mutex> its_lock(socket_mutex_);
- local = get_address_port_local();
- }
-
- VSOMEIP_INFO << "status uce: " << local << " -> "
- << get_address_port_remote()
- << " queue: " << std::dec << its_queue_size
- << " data: " << std::dec << its_data_size;
-}
-
-std::string udp_client_endpoint_impl::get_remote_information() const {
- boost::system::error_code ec;
- return remote_.address().to_string(ec) + ":"
- + std::to_string(remote_.port());
-}
-
-std::uint32_t udp_client_endpoint_impl::get_max_allowed_reconnects() const {
- return MAX_RECONNECTS_UNLIMITED;
-}
-
-void udp_client_endpoint_impl::max_allowed_reconnects_reached() {
- return;
-}
-
-} // namespace vsomeip
+ ) + ); + } else { + VSOMEIP_WARNING << "udp_client_endpoint::connect: Error opening socket: " + << its_error.message() << " remote:" << get_address_port_remote(); + strand_.post(std::bind(&udp_client_endpoint_base_impl::connect_cbk, + shared_from_this(), its_error)); + } +} + +void udp_client_endpoint_impl::start() { + connect(); +} + +void udp_client_endpoint_impl::restart(bool _force) { + if (!_force && state_ == cei_state_e::CONNECTING) { + return; + } + state_ = cei_state_e::CONNECTING; + { + std::lock_guard<std::mutex> its_lock(mutex_); + queue_.clear(); + } + std::string local; + { + std::lock_guard<std::mutex> its_lock(socket_mutex_); + local = get_address_port_local(); + } + shutdown_and_close_socket(false); + was_not_connected_ = true; + reconnect_counter_ = 0; + VSOMEIP_WARNING << "uce::restart: local: " << local + << " remote: " << get_address_port_remote(); + start_connect_timer(); +} + +void udp_client_endpoint_impl::send_queued() { + message_buffer_ptr_t its_buffer; + if(queue_.size()) { + its_buffer = queue_.front(); + } else { + return; + } +#if 0 + std::stringstream msg; + msg << "ucei<" << remote_.address() << ":" + << std::dec << remote_.port() << ">::sq: "; + for (std::size_t i = 0; i < its_buffer->size(); i++) + msg << std::hex << std::setw(2) << std::setfill('0') + << (int)(*its_buffer)[i] << " "; + VSOMEIP_INFO << msg.str(); +#endif + { + std::lock_guard<std::mutex> its_lock(socket_mutex_); + socket_->async_send( + boost::asio::buffer(*its_buffer), + std::bind( + &udp_client_endpoint_base_impl::send_cbk, + shared_from_this(), + std::placeholders::_1, + std::placeholders::_2, + its_buffer + ) + ); + } +} + +void udp_client_endpoint_impl::get_configured_times_from_endpoint( + service_t _service, method_t _method, + std::chrono::nanoseconds *_debouncing, + std::chrono::nanoseconds *_maximum_retention) const { + configuration_->get_configured_timing_requests(_service, + remote_address_.to_string(), remote_port_, _method, + _debouncing, _maximum_retention); +} + +void udp_client_endpoint_impl::receive() { + std::lock_guard<std::mutex> its_lock(socket_mutex_); + if (!socket_->is_open()) { + return; + } + message_buffer_ptr_t its_buffer = std::make_shared<message_buffer_t>(VSOMEIP_MAX_UDP_MESSAGE_SIZE); + socket_->async_receive_from( + boost::asio::buffer(*its_buffer), + const_cast<endpoint_type&>(remote_), + strand_.wrap( + std::bind( + &udp_client_endpoint_impl::receive_cbk, + std::dynamic_pointer_cast< + udp_client_endpoint_impl + >(shared_from_this()), + std::placeholders::_1, + std::placeholders::_2, + its_buffer + ) + ) + ); +} + +bool udp_client_endpoint_impl::get_remote_address( + boost::asio::ip::address &_address) const { + if (remote_address_.is_unspecified()) { + return false; + } + _address = remote_address_; + return true; +} + +void udp_client_endpoint_impl::set_local_port() { + std::lock_guard<std::mutex> its_lock(socket_mutex_); + boost::system::error_code its_error; + if (socket_->is_open()) { + endpoint_type its_endpoint = socket_->local_endpoint(its_error); + if (!its_error) { + local_port_ = its_endpoint.port(); + } else { + VSOMEIP_WARNING << "udp_client_endpoint_impl::set_local_port() " + << " couldn't get local_endpoint: " << its_error.message(); + } + } +} + +std::uint16_t udp_client_endpoint_impl::get_remote_port() const { + return remote_port_; +} + +void udp_client_endpoint_impl::receive_cbk( + boost::system::error_code const &_error, std::size_t _bytes, + const message_buffer_ptr_t& _recv_buffer) { + if (_error == boost::asio::error::operation_aborted) { + // endpoint was stopped + return; + } + std::shared_ptr<routing_host> its_host = routing_host_.lock(); + if (!_error && 0 < _bytes && its_host) { +#if 0 + std::stringstream msg; + msg << "ucei::rcb(" << _error.message() << "): "; + for (std::size_t i = 0; i < _bytes + recv_buffer_size_; ++i) + msg << std::hex << std::setw(2) << std::setfill('0') + << (int) (*_recv_buffer)[i] << " "; + VSOMEIP_INFO << msg.str(); +#endif + std::size_t remaining_bytes = _bytes; + std::size_t i = 0; + + do { + uint64_t read_message_size + = utility::get_message_size(&(*_recv_buffer)[i], + remaining_bytes); + if (read_message_size > MESSAGE_SIZE_UNLIMITED) { + VSOMEIP_ERROR << "Message size exceeds allowed maximum!"; + return; + } + uint32_t current_message_size = static_cast<uint32_t>(read_message_size); + if (current_message_size > VSOMEIP_SOMEIP_HEADER_SIZE && + current_message_size <= remaining_bytes) { + if (remaining_bytes - current_message_size > remaining_bytes) { + VSOMEIP_ERROR << "buffer underflow in udp client endpoint ~> abort!"; + return; + } else if (current_message_size > VSOMEIP_RETURN_CODE_POS && + ((*_recv_buffer)[i + VSOMEIP_PROTOCOL_VERSION_POS] != VSOMEIP_PROTOCOL_VERSION || + !utility::is_valid_message_type(tp::tp::tp_flag_unset((*_recv_buffer)[i + VSOMEIP_MESSAGE_TYPE_POS])) || + !utility::is_valid_return_code(static_cast<return_code_e>((*_recv_buffer)[i + VSOMEIP_RETURN_CODE_POS])) + )) { + if ((*_recv_buffer)[i + VSOMEIP_PROTOCOL_VERSION_POS] != VSOMEIP_PROTOCOL_VERSION) { + VSOMEIP_ERROR << "uce: Wrong protocol version: 0x" + << std::hex << std::setw(2) << std::setfill('0') + << std::uint32_t((*_recv_buffer)[i + VSOMEIP_PROTOCOL_VERSION_POS]) + << " local: " << get_address_port_local() + << " remote: " << get_address_port_remote(); + // ensure to send back a message w/ wrong protocol version + its_host->on_message(&(*_recv_buffer)[i], + VSOMEIP_SOMEIP_HEADER_SIZE + 8, this, + boost::asio::ip::address(), + VSOMEIP_ROUTING_CLIENT, + std::make_pair(ANY_UID, ANY_GID), + remote_address_, + remote_port_); + } else if (!utility::is_valid_message_type(tp::tp::tp_flag_unset( + (*_recv_buffer)[i + VSOMEIP_MESSAGE_TYPE_POS]))) { + VSOMEIP_ERROR << "uce: Invalid message type: 0x" + << std::hex << std::setw(2) << std::setfill('0') + << std::uint32_t((*_recv_buffer)[i + VSOMEIP_MESSAGE_TYPE_POS]) + << " local: " << get_address_port_local() + << " remote: " << get_address_port_remote(); + } else if (!utility::is_valid_return_code(static_cast<return_code_e>( + (*_recv_buffer)[i + VSOMEIP_RETURN_CODE_POS]))) { + VSOMEIP_ERROR << "uce: Invalid return code: 0x" + << std::hex << std::setw(2) << std::setfill('0') + << std::uint32_t((*_recv_buffer)[i + VSOMEIP_RETURN_CODE_POS]) + << " local: " << get_address_port_local() + << " remote: " << get_address_port_remote(); + } + receive(); + return; + } else if (tp::tp::tp_flag_is_set((*_recv_buffer)[i + VSOMEIP_MESSAGE_TYPE_POS])) { + const auto res = tp_reassembler_->process_tp_message( + &(*_recv_buffer)[i], current_message_size, + remote_address_, remote_port_); + if (res.first) { + its_host->on_message(&res.second[0], + static_cast<std::uint32_t>(res.second.size()), + this, boost::asio::ip::address(), + VSOMEIP_ROUTING_CLIENT, + std::make_pair(ANY_UID, ANY_GID), + remote_address_, + remote_port_); + } + } else { + its_host->on_message(&(*_recv_buffer)[i], current_message_size, + this, boost::asio::ip::address(), + VSOMEIP_ROUTING_CLIENT, + std::make_pair(ANY_UID, ANY_GID), + remote_address_, + remote_port_); + } + remaining_bytes -= current_message_size; + } else { + VSOMEIP_ERROR << "Received a unreliable vSomeIP message with bad " + "length field. Message size: " << current_message_size + << " Bytes. From: " << remote_.address() << ":" + << remote_.port() << ". Dropping message."; + remaining_bytes = 0; + } + i += current_message_size; + } while (remaining_bytes > 0); + } + if (!_error) { + receive(); + } else { + if (_error == boost::asio::error::connection_refused) { + shutdown_and_close_socket(false); + } else { + receive(); + } + } +} + +const std::string udp_client_endpoint_impl::get_address_port_remote() const { + boost::system::error_code ec; + std::string its_address_port; + its_address_port.reserve(21); + boost::asio::ip::address its_address; + if (get_remote_address(its_address)) { + its_address_port += its_address.to_string(); + } + its_address_port += ":"; + its_address_port += std::to_string(remote_port_); + return its_address_port; +} + +const std::string udp_client_endpoint_impl::get_address_port_local() const { + std::string its_address_port; + its_address_port.reserve(21); + boost::system::error_code ec; + if (socket_->is_open()) { + endpoint_type its_local_endpoint = socket_->local_endpoint(ec); + if (!ec) { + its_address_port += its_local_endpoint.address().to_string(ec); + its_address_port += ":"; + its_address_port.append(std::to_string(its_local_endpoint.port())); + } + } + return its_address_port; +} + +void udp_client_endpoint_impl::print_status() { + std::size_t its_data_size(0); + std::size_t its_queue_size(0); + { + std::lock_guard<std::mutex> its_lock(mutex_); + its_queue_size = queue_.size(); + its_data_size = queue_size_; + } + std::string local; + { + std::lock_guard<std::mutex> its_lock(socket_mutex_); + local = get_address_port_local(); + } + + VSOMEIP_INFO << "status uce: " << local << " -> " + << get_address_port_remote() + << " queue: " << std::dec << its_queue_size + << " data: " << std::dec << its_data_size; +} + +std::string udp_client_endpoint_impl::get_remote_information() const { + boost::system::error_code ec; + return remote_.address().to_string(ec) + ":" + + std::to_string(remote_.port()); +} + +bool udp_client_endpoint_impl::tp_segmentation_enabled(service_t _service, + method_t _method) const { + return configuration_->tp_segment_messages_client_to_service(_service, + remote_address_.to_string(), remote_port_, _method); +} + +bool udp_client_endpoint_impl::is_reliable() const { + return false; +} + +std::uint32_t udp_client_endpoint_impl::get_max_allowed_reconnects() const { + return MAX_RECONNECTS_UNLIMITED; +} + +void udp_client_endpoint_impl::max_allowed_reconnects_reached() { + return; +} + +} // namespace vsomeip_v3 |