20#include <winpr/assert.h>
21#include <winpr/cast.h>
23#include <winpr/synch.h>
24#include <winpr/winsock.h>
26#include <freerdp/log.h>
29#include "udplistener_internal.h"
31#define TAG FREERDP_TAG("core.udplistener")
33rdpUdpFlow* freerdp_udp_flow_new(
const BYTE cookieHash[32])
35 WINPR_ASSERT(cookieHash);
37 rdpUdpFlow* flow = calloc(1,
sizeof(rdpUdpFlow));
40 if (!InitializeCriticalSectionAndSpinCount(&flow->lock, 4000))
45 flow->event = CreateEvent(
nullptr, TRUE, FALSE,
nullptr);
48 DeleteCriticalSection(&flow->lock);
52 memcpy(flow->cookieHash, cookieHash,
sizeof(flow->cookieHash));
53 flow->sockfd = INVALID_SOCKET;
54 flow->relay = INVALID_SOCKET;
58void freerdp_udp_flow_free(rdpUdpFlow* flow)
66 freerdp_udp_listener_remove_flow(flow->listener, flow);
68 if (flow->relay != INVALID_SOCKET)
71 if (_send(flow->relay,
"", 0, MSG_NOSIGNAL) < 0)
72 WLog_DBG(TAG,
"the flow relay is already gone");
73 closesocket(flow->relay);
74 if (!WSACloseEvent(flow->relayEvent))
75 WLog_WARN(TAG,
"failed to close the socket event");
77 (void)CloseHandle(flow->event);
78 DeleteCriticalSection(&flow->lock);
83const BYTE* freerdp_udp_flow_get_cookie_hash(
const rdpUdpFlow* flow)
86 return flow->cookieHash;
89void freerdp_udp_flow_set_receive(rdpUdpFlow* flow, FreeRDP_UdpFlowReceiveFn receive,
void* custom)
92 EnterCriticalSection(&flow->lock);
93 flow->receive = receive;
94 flow->receiveCustom = custom;
95 LeaveCriticalSection(&flow->lock);
98void freerdp_udp_flow_set_send(rdpUdpFlow* flow, FreeRDP_UdpFlowSendFn send,
void* custom)
101 EnterCriticalSection(&flow->lock);
103 flow->sendCustom = custom;
104 LeaveCriticalSection(&flow->lock);
107BOOL freerdp_udp_flow_set_socket(rdpUdpFlow* flow,
int fd)
112 if (!udpsocket_is_message_socket((SOCKET)fd))
115 HANDLE
event = WSACreateEvent();
120 EnterCriticalSection(&flow->lock);
122 if ((flow->relay == INVALID_SOCKET) && (WSAEventSelect((SOCKET)fd, event, FD_READ) == 0))
124 flow->relay = (SOCKET)fd;
125 flow->relayEvent = event;
127 udpsocket_set_no_inherit((SOCKET)fd);
130 LeaveCriticalSection(&flow->lock);
132 if (!rc && !WSACloseEvent(event))
133 WLog_WARN(TAG,
"failed to close the socket event");
139static BOOL udpflow_grow(rdpUdpFlow* flow)
143 const size_t slots = (flow->slots == 0) ? UDPFLOW_FIRST_SLOTS : 2 * flow->slots;
144 if (slots > UDPFLOW_SLOTS)
146 BYTE* ring = malloc(slots * UDPFLOW_MAX_DATAGRAM);
150 UINT16 lengths[UDPFLOW_SLOTS] = WINPR_C_ARRAY_INIT;
152 const size_t count = (flow->slots > 0) ? flow->count : 0;
153 for (
size_t x = 0; x < count; x++)
155 const size_t from = (flow->head + x) % flow->slots;
156 memcpy(&ring[x * UDPFLOW_MAX_DATAGRAM], &flow->ring[from * UDPFLOW_MAX_DATAGRAM],
157 flow->lengths[from]);
158 lengths[x] = flow->lengths[from];
160 memcpy(flow->lengths, lengths,
sizeof(lengths));
168BOOL freerdp_udp_flow_deliver(rdpUdpFlow* flow,
const BYTE* data,
size_t length)
171 WINPR_ASSERT(data || (length == 0));
173 if (length > UDPFLOW_MAX_DATAGRAM)
177 EnterCriticalSection(&flow->lock);
178 if ((flow->count < flow->slots) || udpflow_grow(flow))
180 const size_t slot = (flow->head + flow->count) % flow->slots;
182 memcpy(&flow->ring[slot * UDPFLOW_MAX_DATAGRAM], data, length);
183 flow->lengths[slot] = WINPR_ASSERTING_INT_CAST(UINT16, length);
185 (void)SetEvent(flow->event);
188 LeaveCriticalSection(&flow->lock);
192BOOL udpflow_read(rdpUdpFlow* flow, BYTE* data,
size_t* length)
196 WINPR_ASSERT(length);
199 EnterCriticalSection(&flow->lock);
202 *length = flow->lengths[flow->head];
203 memcpy(data, &flow->ring[flow->head * UDPFLOW_MAX_DATAGRAM], *length);
204 flow->head = (flow->head + 1) % flow->slots;
208 if (flow->count == 0)
209 (void)ResetEvent(flow->event);
211 if (!rc && (flow->relay != INVALID_SOCKET) && !flow->relayClosed)
213 (void)WSAResetEvent(flow->relayEvent);
214 const int got = _recv(flow->relay, (
char*)data, UDPFLOW_MAX_DATAGRAM, 0);
217 *length = WINPR_ASSERTING_INT_CAST(
size_t, got);
223 WLog_DBG(TAG,
"flow relay has been closed");
224 flow->relayClosed = TRUE;
227 LeaveCriticalSection(&flow->lock);
231void udpflow_wake(rdpUdpFlow* flow)
236 (void)SetEvent(flow->event);
239DWORD udpflow_get_events(rdpUdpFlow* flow, HANDLE events[2])
242 WINPR_ASSERT(events);
245 EnterCriticalSection(&flow->lock);
246 events[count++] = flow->event;
247 if ((flow->relay != INVALID_SOCKET) && !flow->relayClosed)
248 events[count++] = flow->relayEvent;
249 LeaveCriticalSection(&flow->lock);
253void udpflow_set_worker(rdpUdpFlow* flow, BOOL (*check)(
void* custom),
254 UINT32 (*timeout)(
void* custom),
void* custom)
258 flow->timeout = timeout;
259 flow->workerCustom = custom;
262BOOL freerdp_udp_flow_send(rdpUdpFlow* flow,
const BYTE* data,
size_t length)
267 EnterCriticalSection(&flow->lock);
268 const FreeRDP_UdpFlowSendFn sendFn = flow->send;
269 void* custom = flow->sendCustom;
272 if (!sendFn && (flow->relay != INVALID_SOCKET))
274 const int sent = _send(flow->relay, (
const char*)data,
275 WINPR_ASSERTING_INT_CAST(
int, length), MSG_NOSIGNAL);
276 rc = (sent >= 0) || rdpudp_socket_error_is_transient(WSAGetLastError());
278 else if (!sendFn && (flow->sockfd != INVALID_SOCKET))
282 BOOL fallback = !flow->local.valid;
285 rc = udpsocket_send_from(flow->sockfd, &flow->peer, flow->peerLength, &flow->local,
290 fallback = udpsocket_source_address_unavailable(&error);
291 rc = !fallback && rdpudp_socket_error_is_transient(error);
297 _sendto(flow->sockfd, (
const char*)data, WINPR_ASSERTING_INT_CAST(
int, length), 0,
298 (
const struct sockaddr*)&flow->peer,
299 WINPR_ASSERTING_INT_CAST(
int, flow->peerLength));
300 rc = (sent >= 0) || rdpudp_socket_error_is_transient(WSAGetLastError());
305 rc = sendFn(custom, data, length);
306 LeaveCriticalSection(&flow->lock);
310HANDLE freerdp_udp_flow_get_event(rdpUdpFlow* flow)
314 EnterCriticalSection(&flow->lock);
315 const BOOL relay = (flow->relay != INVALID_SOCKET) && !flow->relayClosed;
316 HANDLE
event = relay ? flow->relayEvent : flow->event;
317 LeaveCriticalSection(&flow->lock);
321UINT32 freerdp_udp_flow_get_timeout(rdpUdpFlow* flow)
324 return flow->timeout ? flow->timeout(flow->workerCustom) : UINT32_MAX;
327BOOL freerdp_udp_flow_check(rdpUdpFlow* flow)
330 return flow->check ? flow->check(flow->workerCustom) : FALSE;