2016-06-18 14:46:12 +02:00
|
|
|
/*************************************************************************/
|
|
|
|
/* packet_peer_udp_winsock.cpp */
|
|
|
|
/*************************************************************************/
|
|
|
|
/* This file is part of: */
|
|
|
|
/* GODOT ENGINE */
|
2017-08-27 14:16:55 +02:00
|
|
|
/* https://godotengine.org */
|
2016-06-18 14:46:12 +02:00
|
|
|
/*************************************************************************/
|
2017-01-01 22:01:57 +01:00
|
|
|
/* Copyright (c) 2007-2017 Juan Linietsky, Ariel Manzur. */
|
2017-04-08 00:11:42 +02:00
|
|
|
/* Copyright (c) 2014-2017 Godot Engine contributors (cf. AUTHORS.md) */
|
2016-06-18 14:46:12 +02:00
|
|
|
/* */
|
|
|
|
/* Permission is hereby granted, free of charge, to any person obtaining */
|
|
|
|
/* a copy of this software and associated documentation files (the */
|
|
|
|
/* "Software"), to deal in the Software without restriction, including */
|
|
|
|
/* without limitation the rights to use, copy, modify, merge, publish, */
|
|
|
|
/* distribute, sublicense, and/or sell copies of the Software, and to */
|
|
|
|
/* permit persons to whom the Software is furnished to do so, subject to */
|
|
|
|
/* the following conditions: */
|
|
|
|
/* */
|
|
|
|
/* The above copyright notice and this permission notice shall be */
|
|
|
|
/* included in all copies or substantial portions of the Software. */
|
|
|
|
/* */
|
|
|
|
/* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */
|
|
|
|
/* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */
|
|
|
|
/* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/
|
|
|
|
/* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */
|
|
|
|
/* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */
|
|
|
|
/* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */
|
|
|
|
/* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */
|
|
|
|
/*************************************************************************/
|
2014-11-12 15:23:23 +01:00
|
|
|
#include "packet_peer_udp_winsock.h"
|
|
|
|
|
|
|
|
#include <winsock2.h>
|
2016-10-20 12:04:10 +02:00
|
|
|
#include <ws2tcpip.h>
|
|
|
|
|
|
|
|
#include "drivers/unix/socket_helpers.h"
|
2014-11-12 15:23:23 +01:00
|
|
|
|
|
|
|
int PacketPeerUDPWinsock::get_available_packet_count() const {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Error err = const_cast<PacketPeerUDPWinsock *>(this)->_poll(false);
|
|
|
|
if (err != OK)
|
2014-11-12 15:23:23 +01:00
|
|
|
return 0;
|
|
|
|
|
|
|
|
return queue_count;
|
|
|
|
}
|
|
|
|
|
2017-12-15 16:05:42 +01:00
|
|
|
Error PacketPeerUDPWinsock::get_packet(const uint8_t **r_buffer, int &r_buffer_size) {
|
2014-11-12 15:23:23 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
Error err = const_cast<PacketPeerUDPWinsock *>(this)->_poll(false);
|
|
|
|
if (err != OK)
|
2014-11-12 15:23:23 +01:00
|
|
|
return err;
|
2017-03-05 16:44:50 +01:00
|
|
|
if (queue_count == 0)
|
2014-11-12 15:23:23 +01:00
|
|
|
return ERR_UNAVAILABLE;
|
|
|
|
|
|
|
|
uint32_t size;
|
2016-10-20 12:04:10 +02:00
|
|
|
uint8_t type;
|
|
|
|
rb.read(&type, 1, true);
|
2016-12-05 16:32:38 +01:00
|
|
|
if (type == IP::TYPE_IPV4) {
|
|
|
|
uint8_t ip[4];
|
2017-03-05 16:44:50 +01:00
|
|
|
rb.read(ip, 4, true);
|
2016-12-05 16:32:38 +01:00
|
|
|
packet_ip.set_ipv4(ip);
|
2016-10-20 12:04:10 +02:00
|
|
|
} else {
|
2016-12-05 16:32:38 +01:00
|
|
|
uint8_t ip[16];
|
2017-03-05 16:44:50 +01:00
|
|
|
rb.read(ip, 16, true);
|
2016-12-05 16:32:38 +01:00
|
|
|
packet_ip.set_ipv6(ip);
|
2016-10-20 12:04:10 +02:00
|
|
|
};
|
2017-03-05 16:44:50 +01:00
|
|
|
rb.read((uint8_t *)&packet_port, 4, true);
|
|
|
|
rb.read((uint8_t *)&size, 4, true);
|
|
|
|
rb.read(packet_buffer, size, true);
|
2014-11-12 15:23:23 +01:00
|
|
|
--queue_count;
|
2017-03-05 16:44:50 +01:00
|
|
|
*r_buffer = packet_buffer;
|
|
|
|
r_buffer_size = size;
|
2014-11-12 15:23:23 +01:00
|
|
|
return OK;
|
|
|
|
}
|
2017-03-05 16:44:50 +01:00
|
|
|
Error PacketPeerUDPWinsock::put_packet(const uint8_t *p_buffer, int p_buffer_size) {
|
2014-11-12 15:23:23 +01:00
|
|
|
|
2017-01-18 10:24:26 +01:00
|
|
|
ERR_FAIL_COND_V(!peer_addr.is_valid(), ERR_UNCONFIGURED);
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (sock_type == IP::TYPE_NONE)
|
2017-01-18 10:24:26 +01:00
|
|
|
sock_type = peer_addr.is_ipv4() ? IP::TYPE_IPV4 : IP::TYPE_IPV6;
|
|
|
|
|
2016-11-30 20:45:19 +01:00
|
|
|
int sock = _get_socket();
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(sock == -1, FAILED);
|
2016-10-20 12:04:10 +02:00
|
|
|
struct sockaddr_storage addr;
|
2017-01-18 10:24:26 +01:00
|
|
|
size_t addr_size = _set_sockaddr(&addr, peer_addr, peer_port, sock_type);
|
2014-11-13 04:53:12 +01:00
|
|
|
|
2017-03-08 17:14:01 +01:00
|
|
|
_set_sock_blocking(blocking);
|
2014-11-13 04:53:12 +01:00
|
|
|
|
2014-11-12 15:23:23 +01:00
|
|
|
errno = 0;
|
|
|
|
int err;
|
2017-03-05 16:44:50 +01:00
|
|
|
while ((err = sendto(sock, (const char *)p_buffer, p_buffer_size, 0, (struct sockaddr *)&addr, addr_size)) != p_buffer_size) {
|
2014-11-12 15:23:23 +01:00
|
|
|
|
|
|
|
if (WSAGetLastError() != WSAEWOULDBLOCK) {
|
|
|
|
return FAILED;
|
2017-03-08 17:14:01 +01:00
|
|
|
} else if (!blocking) {
|
|
|
|
return ERR_UNAVAILABLE;
|
|
|
|
}
|
2014-11-12 15:23:23 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
return OK;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
int PacketPeerUDPWinsock::get_max_packet_size() const {
|
2014-11-12 15:23:23 +01:00
|
|
|
|
|
|
|
return 512; // uhm maybe not
|
|
|
|
}
|
|
|
|
|
2017-03-08 17:14:01 +01:00
|
|
|
void PacketPeerUDPWinsock::_set_sock_blocking(bool p_blocking) {
|
2014-11-13 04:53:12 +01:00
|
|
|
|
2017-03-08 17:14:01 +01:00
|
|
|
if (sock_blocking == p_blocking)
|
2014-11-13 04:53:12 +01:00
|
|
|
return;
|
|
|
|
|
2017-03-08 17:14:01 +01:00
|
|
|
sock_blocking = p_blocking;
|
|
|
|
unsigned long par = sock_blocking ? 0 : 1;
|
2014-11-13 04:53:12 +01:00
|
|
|
if (ioctlsocket(sockfd, FIONBIO, &par)) {
|
|
|
|
perror("setting non-block mode");
|
|
|
|
//close();
|
|
|
|
//return -1;
|
|
|
|
};
|
|
|
|
}
|
|
|
|
|
2017-08-12 13:04:30 +02:00
|
|
|
Error PacketPeerUDPWinsock::listen(int p_port, const IP_Address &p_bind_address, int p_recv_buffer_size) {
|
2017-01-18 10:24:26 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(sockfd != -1, ERR_ALREADY_IN_USE);
|
|
|
|
ERR_FAIL_COND_V(!p_bind_address.is_valid() && !p_bind_address.is_wildcard(), ERR_INVALID_PARAMETER);
|
2017-01-18 10:24:26 +01:00
|
|
|
|
2017-01-18 12:47:12 +01:00
|
|
|
sock_type = IP::TYPE_ANY;
|
2017-01-18 10:24:26 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (p_bind_address.is_valid())
|
2017-01-18 10:24:26 +01:00
|
|
|
sock_type = p_bind_address.is_ipv4() ? IP::TYPE_IPV4 : IP::TYPE_IPV6;
|
2014-11-12 15:23:23 +01:00
|
|
|
|
2016-11-30 20:45:19 +01:00
|
|
|
int sock = _get_socket();
|
2017-03-05 16:44:50 +01:00
|
|
|
if (sock == -1)
|
2014-11-12 15:23:23 +01:00
|
|
|
return ERR_CANT_CREATE;
|
2016-10-20 12:04:10 +02:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
struct sockaddr_storage addr = { 0 };
|
2017-01-18 10:24:26 +01:00
|
|
|
size_t addr_size = _set_listen_sockaddr(&addr, p_port, sock_type, IP_Address());
|
2016-10-20 12:04:10 +02:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (bind(sock, (struct sockaddr *)&addr, addr_size) == -1) {
|
2014-11-12 15:23:23 +01:00
|
|
|
close();
|
|
|
|
return ERR_UNAVAILABLE;
|
|
|
|
}
|
2014-11-13 04:53:12 +01:00
|
|
|
|
2014-11-12 15:23:23 +01:00
|
|
|
printf("UDP Connection listening on port %i\n", p_port);
|
2014-11-13 04:53:12 +01:00
|
|
|
rb.resize(nearest_shift(p_recv_buffer_size));
|
2014-11-12 15:23:23 +01:00
|
|
|
return OK;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
void PacketPeerUDPWinsock::close() {
|
2014-11-12 15:23:23 +01:00
|
|
|
|
|
|
|
if (sockfd != -1)
|
|
|
|
::closesocket(sockfd);
|
2017-03-05 16:44:50 +01:00
|
|
|
sockfd = -1;
|
2017-01-18 10:24:26 +01:00
|
|
|
sock_type = IP::TYPE_NONE;
|
2017-01-19 13:33:10 +01:00
|
|
|
rb.resize(16);
|
2017-03-05 16:44:50 +01:00
|
|
|
queue_count = 0;
|
2014-11-12 15:23:23 +01:00
|
|
|
}
|
|
|
|
|
2014-11-13 04:53:12 +01:00
|
|
|
Error PacketPeerUDPWinsock::wait() {
|
|
|
|
|
|
|
|
return _poll(true);
|
|
|
|
}
|
|
|
|
Error PacketPeerUDPWinsock::_poll(bool p_wait) {
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (sockfd == -1) {
|
2017-01-18 10:48:50 +01:00
|
|
|
return FAILED;
|
|
|
|
}
|
2014-11-13 04:53:12 +01:00
|
|
|
|
2017-03-08 17:14:01 +01:00
|
|
|
_set_sock_blocking(p_wait);
|
2014-11-13 04:53:12 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
struct sockaddr_storage from = { 0 };
|
2016-10-20 12:04:10 +02:00
|
|
|
int len = sizeof(struct sockaddr_storage);
|
2014-11-12 15:23:23 +01:00
|
|
|
int ret;
|
2017-03-05 16:44:50 +01:00
|
|
|
while ((ret = recvfrom(sockfd, (char *)recv_buffer, MIN((int)sizeof(recv_buffer), MAX(rb.space_left() - 24, 0)), 0, (struct sockaddr *)&from, &len)) > 0) {
|
2016-10-20 12:04:10 +02:00
|
|
|
|
|
|
|
uint32_t port = 0;
|
|
|
|
|
|
|
|
if (from.ss_family == AF_INET) {
|
2016-12-05 16:32:38 +01:00
|
|
|
uint8_t type = (uint8_t)IP::TYPE_IPV4;
|
2016-10-20 12:04:10 +02:00
|
|
|
rb.write(&type, 1);
|
2017-03-05 16:44:50 +01:00
|
|
|
struct sockaddr_in *sin_from = (struct sockaddr_in *)&from;
|
|
|
|
rb.write((uint8_t *)&sin_from->sin_addr, 4);
|
2016-10-26 18:27:01 +02:00
|
|
|
port = ntohs(sin_from->sin_port);
|
2016-10-20 12:04:10 +02:00
|
|
|
|
|
|
|
} else if (from.ss_family == AF_INET6) {
|
|
|
|
|
2016-12-05 16:32:38 +01:00
|
|
|
uint8_t type = (uint8_t)IP::TYPE_IPV6;
|
2016-10-20 12:04:10 +02:00
|
|
|
rb.write(&type, 1);
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
struct sockaddr_in6 *s6_from = (struct sockaddr_in6 *)&from;
|
|
|
|
rb.write((uint8_t *)&s6_from->sin6_addr, 16);
|
2016-10-20 12:04:10 +02:00
|
|
|
|
2016-10-26 18:27:01 +02:00
|
|
|
port = ntohs(s6_from->sin6_port);
|
2016-10-20 12:04:10 +02:00
|
|
|
|
|
|
|
} else {
|
|
|
|
// WARN_PRINT("Ignoring packet with unknown address family");
|
2016-12-05 16:32:38 +01:00
|
|
|
uint8_t type = (uint8_t)IP::TYPE_NONE;
|
2016-10-20 12:04:10 +02:00
|
|
|
rb.write(&type, 1);
|
|
|
|
};
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
rb.write((uint8_t *)&port, 4);
|
|
|
|
rb.write((uint8_t *)&ret, 4);
|
2014-11-12 15:23:23 +01:00
|
|
|
rb.write(recv_buffer, ret);
|
|
|
|
|
2016-10-20 12:04:10 +02:00
|
|
|
len = sizeof(struct sockaddr_storage);
|
2014-11-12 15:23:23 +01:00
|
|
|
++queue_count;
|
2017-05-05 17:41:11 +02:00
|
|
|
if (p_wait)
|
|
|
|
break;
|
2014-11-12 15:23:23 +01:00
|
|
|
};
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (ret == SOCKET_ERROR) {
|
2015-11-09 01:33:16 +01:00
|
|
|
int error = WSAGetLastError();
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
if (error == WSAEWOULDBLOCK) {
|
2015-11-09 01:33:16 +01:00
|
|
|
// Expected when doing non-blocking sockets, retry later.
|
2017-03-05 16:44:50 +01:00
|
|
|
} else if (error == WSAECONNRESET) {
|
2015-11-09 01:33:16 +01:00
|
|
|
// If the remote target does not accept messages, this error may occur, but is harmless.
|
|
|
|
// Once the remote target gets available, this message will disappear for new messages.
|
2017-03-05 16:44:50 +01:00
|
|
|
} else {
|
2015-11-09 01:33:16 +01:00
|
|
|
close();
|
|
|
|
return FAILED;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (ret == 0) {
|
2014-11-12 15:23:23 +01:00
|
|
|
close();
|
|
|
|
return FAILED;
|
|
|
|
};
|
|
|
|
|
|
|
|
return OK;
|
|
|
|
}
|
2014-11-13 04:53:12 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
bool PacketPeerUDPWinsock::is_listening() const {
|
2014-11-12 15:23:23 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
return sockfd != -1;
|
2014-11-12 15:23:23 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
IP_Address PacketPeerUDPWinsock::get_packet_address() const {
|
|
|
|
|
|
|
|
return packet_ip;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
int PacketPeerUDPWinsock::get_packet_port() const {
|
2014-11-12 15:23:23 +01:00
|
|
|
|
|
|
|
return packet_port;
|
|
|
|
}
|
|
|
|
|
2016-11-30 20:45:19 +01:00
|
|
|
int PacketPeerUDPWinsock::_get_socket() {
|
2014-11-12 15:23:23 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
ERR_FAIL_COND_V(sock_type == IP::TYPE_NONE, -1);
|
2017-01-18 10:24:26 +01:00
|
|
|
|
2014-11-12 15:23:23 +01:00
|
|
|
if (sockfd != -1)
|
|
|
|
return sockfd;
|
|
|
|
|
2017-01-18 10:24:26 +01:00
|
|
|
sockfd = _socket_create(sock_type, SOCK_DGRAM, IPPROTO_UDP);
|
2014-11-12 15:23:23 +01:00
|
|
|
|
2017-03-08 17:14:01 +01:00
|
|
|
if (sockfd != -1)
|
|
|
|
_set_sock_blocking(false);
|
|
|
|
|
2014-11-12 15:23:23 +01:00
|
|
|
return sockfd;
|
|
|
|
}
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
void PacketPeerUDPWinsock::set_dest_address(const IP_Address &p_address, int p_port) {
|
2014-11-12 15:23:23 +01:00
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
peer_addr = p_address;
|
|
|
|
peer_port = p_port;
|
2014-11-12 15:23:23 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
void PacketPeerUDPWinsock::make_default() {
|
|
|
|
|
|
|
|
PacketPeerUDP::_create = PacketPeerUDPWinsock::_create;
|
|
|
|
};
|
|
|
|
|
2017-03-05 16:44:50 +01:00
|
|
|
PacketPeerUDP *PacketPeerUDPWinsock::_create() {
|
2014-11-12 15:23:23 +01:00
|
|
|
|
|
|
|
return memnew(PacketPeerUDPWinsock);
|
|
|
|
};
|
|
|
|
|
|
|
|
PacketPeerUDPWinsock::PacketPeerUDPWinsock() {
|
|
|
|
|
2017-03-08 17:14:01 +01:00
|
|
|
blocking = true;
|
|
|
|
sock_blocking = true;
|
2017-03-05 16:44:50 +01:00
|
|
|
sockfd = -1;
|
|
|
|
packet_port = 0;
|
|
|
|
queue_count = 0;
|
|
|
|
peer_port = 0;
|
2017-01-18 10:24:26 +01:00
|
|
|
sock_type = IP::TYPE_NONE;
|
2017-01-19 13:33:10 +01:00
|
|
|
rb.resize(16);
|
2014-11-12 15:23:23 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
PacketPeerUDPWinsock::~PacketPeerUDPWinsock() {
|
|
|
|
|
|
|
|
close();
|
|
|
|
}
|