79 lines
2.0 KiB
C++
79 lines
2.0 KiB
C++
/*
|
||
* eth_udp.cpp
|
||
*
|
||
* Created on: 15 <20><><EFBFBD>. 2023 <20>.
|
||
* Author: sychev
|
||
*/
|
||
#include "ethernet_ip/eth_udp_server.hpp"
|
||
#include "ethernet_ip/eth_udp_types.h"
|
||
#include "ethernet_ip/eth_ip_types.h"
|
||
#include "base/swap.h"
|
||
|
||
|
||
free_rtos::EthUdpServer::EthUdpServer(EthIpIface& ip_iface) :
|
||
ip_iface_{ip_iface}
|
||
{
|
||
|
||
}
|
||
|
||
std::shared_ptr<free_rtos::EthUpdClient> free_rtos::EthUdpServer::createClient(uint16_t port_dst,
|
||
uint16_t port_src,
|
||
bool use_chksum)
|
||
{
|
||
port_dst = BASE_SWAP16(port_dst);
|
||
port_src = BASE_SWAP16(port_src);
|
||
|
||
/// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><> <20><><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD>
|
||
if (connections_.count(port_dst)) {
|
||
return nullptr;
|
||
}
|
||
|
||
std::shared_ptr<EthUpdClient> p_client = std::make_shared<EthUpdClient>(ip_iface_, port_id_,
|
||
port_dst, port_src, use_chksum);
|
||
|
||
if (p_client == nullptr) {
|
||
return nullptr;
|
||
}
|
||
|
||
connections_[port_dst] = p_client;
|
||
|
||
return p_client;
|
||
}
|
||
|
||
int32_t free_rtos::EthUdpServer::Process(uint8_t * p_data, uint32_t len)
|
||
{
|
||
if (len <= sizeof(TUdpHeader)) {
|
||
return 0;
|
||
}
|
||
|
||
TUdpHeader * hdr = (TUdpHeader *)p_data;
|
||
|
||
uint16_t port = hdr->Dst_port;
|
||
|
||
auto item = connections_.find(port);
|
||
|
||
/// <20><><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> <20><> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||
if (item == connections_.end()) {
|
||
return 0;
|
||
}
|
||
|
||
auto& client = item->second;
|
||
|
||
TIpHeader * p_ip_hdr = (TIpHeader*)(p_data - sizeof(TIpHeader));
|
||
|
||
uint32_t src_ip;
|
||
|
||
memcpy(&src_ip, p_ip_hdr->ip_src, ETH_IP_ADDR_LEN);
|
||
|
||
/// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> udp
|
||
client->put_data(src_ip, p_data + sizeof(TUdpHeader), len - sizeof(TUdpHeader));
|
||
|
||
return 0;
|
||
}
|
||
|
||
uint32_t free_rtos::EthUdpServer::Sender(uint8_t * p_data, size_t scatter_segment)
|
||
{
|
||
return 0;
|
||
}
|
||
|