int32_t OsNetworkReceiveFrom(THandle aHandle, uint8_t* aBuffer, uint32_t aBytes, TIpAddress* aAddress, uint16_t* aPort)
{
OsNetworkHandle* handle = (OsNetworkHandle*)aHandle;
if (SocketInterrupted(handle)) {
return -1;
}
struct sockaddr_in addr;
sockaddrFromEndpoint(&addr, 0, 0);
socklen_t addrLen = sizeof(addr);
SetFdNonBlocking(handle->iSocket);
fd_set read;
FD_ZERO(&read);
FD_SET(handle->iPipe[0], &read);
FD_SET(handle->iSocket, &read);
fd_set error;
FD_ZERO(&error);
FD_SET(handle->iSocket, &error);
int32_t received = TEMP_FAILURE_RETRY_2(recvfrom(handle->iSocket, aBuffer, aBytes, MSG_NOSIGNAL, (struct sockaddr*)&addr, &addrLen), handle);
if (received==-1 && errno==EWOULDBLOCK) {
int32_t selectErr = TEMP_FAILURE_RETRY_2(select(nfds(handle), &read, NULL, &error, NULL), handle);
if (selectErr > 0 && FD_ISSET(handle->iSocket, &read)) {
received = TEMP_FAILURE_RETRY_2(recvfrom(handle->iSocket, aBuffer, aBytes, MSG_NOSIGNAL, (struct sockaddr*)&addr, &addrLen), handle);
}
}
SetFdBlocking(handle->iSocket);
*aAddress = addr.sin_addr.s_addr;
*aPort = ntohs(addr.sin_port);
return received;
}
int32_t OsNetworkReceive(THandle aHandle, uint8_t* aBuffer, uint32_t aBytes)
{
OsNetworkHandle* handle = (OsNetworkHandle*)aHandle;
if (SocketInterrupted(handle)) {
return -1;
}
SetFdNonBlocking(handle->iSocket);
fd_set read;
FD_ZERO(&read);
FD_SET(handle->iPipe[0], &read);
FD_SET(handle->iSocket, &read);
fd_set error;
FD_ZERO(&error);
FD_SET(handle->iSocket, &error);
int32_t received = TEMP_FAILURE_RETRY_2(recv(handle->iSocket, aBuffer, aBytes, MSG_NOSIGNAL), handle);
if (received==-1 && errno==EWOULDBLOCK) {
int32_t selectErr = TEMP_FAILURE_RETRY_2(select(nfds(handle), &read, NULL, &error, NULL), handle);
if (selectErr > 0 && FD_ISSET(handle->iSocket, &read)) {
received = TEMP_FAILURE_RETRY_2(recv(handle->iSocket, aBuffer, aBytes, MSG_NOSIGNAL), handle);
}
}
SetFdBlocking(handle->iSocket);
return received;
}
std::size_t select::wait()
{
return select_impl_( nfds( read_descriptors_.descriptors_.empty() ? 0 : *read_descriptors_.descriptors_.rbegin()
, write_descriptors_.descriptors_.empty() ? 0 : *write_descriptors_.descriptors_.rbegin()
, except_descriptors_.descriptors_.empty() ? 0 : *except_descriptors_.descriptors_.rbegin() )
, read_descriptors_.reset_fds_()
, write_descriptors_.reset_fds_()
, except_descriptors_.reset_fds_()
, NULL );
}
std::size_t select::wait( unsigned int timeout_seconds, unsigned int timeout_nanoseconds )
{
struct timeval t;
t.tv_sec = static_cast< int >( timeout_seconds );
t.tv_usec = static_cast< int >( timeout_nanoseconds / 1000 );
return select_impl_( nfds( read_descriptors_.descriptors_.empty() ? 0 : *read_descriptors_.descriptors_.rbegin()
, write_descriptors_.descriptors_.empty() ? 0 : *write_descriptors_.descriptors_.rbegin()
, except_descriptors_.descriptors_.empty() ? 0 : *except_descriptors_.descriptors_.rbegin() )
, read_descriptors_.reset_fds_()
, write_descriptors_.reset_fds_()
, except_descriptors_.reset_fds_()
, &t );
}
THandle OsNetworkAccept(THandle aHandle, TIpAddress* aClientAddress, uint32_t* aClientPort)
{
OsNetworkHandle* handle = (OsNetworkHandle*)aHandle;
*aClientAddress = 0;
*aClientPort = 0;
if (SocketInterrupted(handle)) {
return kHandleNull;
}
struct sockaddr_in addr;
sockaddrFromEndpoint(&addr, 0, 0);
socklen_t len = sizeof(addr);
SetFdNonBlocking(handle->iSocket);
fd_set read;
FD_ZERO(&read);
FD_SET(handle->iPipe[0], &read);
FD_SET(handle->iSocket, &read);
fd_set error;
FD_ZERO(&error);
FD_SET(handle->iSocket, &error);
int32_t h = TEMP_FAILURE_RETRY_2(accept(handle->iSocket, (struct sockaddr*)&addr, &len), handle);
if (h==-1 && errno==EWOULDBLOCK) {
int32_t selectErr = TEMP_FAILURE_RETRY_2(select(nfds(handle), &read, NULL, &error, NULL), handle);
if (selectErr > 0 && FD_ISSET(handle->iSocket, &read)) {
h = TEMP_FAILURE_RETRY_2(accept(handle->iSocket, (struct sockaddr*)&addr, &len), handle);
}
}
SetFdBlocking(handle->iSocket);
if (h == -1) {
return kHandleNull;
}
OsNetworkHandle* newHandle = CreateHandle(handle->iCtx, h);
if (newHandle == NULL) {
close(h);
return kHandleNull;
}
*aClientAddress = addr.sin_addr.s_addr;
*aClientPort = ntohs(addr.sin_port);
return (THandle)newHandle;
}
void adapterChangeObserverThread(void* aPtr)
{
InterfaceChangedObserver* observer = (InterfaceChangedObserver*) aPtr;
OsNetworkHandle *handle = observer->netHnd;
char buffer[4096];
struct nlmsghdr *nlh;
int32_t len, ret;
fd_set rfds,errfds;
while (1) {
if (SocketInterrupted(handle)) {
return;
}
FD_ZERO(&rfds);
FD_SET(handle->iPipe[0], &rfds);
FD_SET(handle->iSocket, &rfds);
FD_ZERO(&errfds);
FD_SET(handle->iSocket, &errfds);
ret = TEMP_FAILURE_RETRY_2(select(nfds(handle), &rfds, NULL, &errfds, NULL), handle);
if ((ret > 0) && FD_ISSET(handle->iSocket, &rfds)) {
nlh = (struct nlmsghdr *) buffer;
if ((len = recv(handle->iSocket, nlh, 4096, 0)) > 0) {
while (NLMSG_OK(nlh, len) && (nlh->nlmsg_type != NLMSG_DONE)) {
if (nlh->nlmsg_type == RTM_NEWADDR ||
nlh->nlmsg_type == RTM_DELADDR ||
nlh->nlmsg_type == RTM_NEWLINK) {
observer->iCallback(observer->iArg);
}
nlh = NLMSG_NEXT(nlh, len);
}
}
}
}
}
int32_t OsNetworkConnect(THandle aHandle, TIpAddress aAddress, uint16_t aPort, uint32_t aTimeoutMs)
{
OsNetworkHandle* handle = (OsNetworkHandle*)aHandle;
if (SocketInterrupted(handle)) {
return -1;
}
int32_t err = -1;
SetFdNonBlocking(handle->iSocket);
struct sockaddr_in addr;
sockaddrFromEndpoint(&addr, aAddress, aPort);
/* ignore err as we expect this to fail due to EINPROGRESS */
(void)connect(handle->iSocket, (struct sockaddr*)&addr, sizeof(addr));
fd_set read;
FD_ZERO(&read);
FD_SET(handle->iPipe[0], &read);
fd_set write;
FD_ZERO(&write);
FD_SET(handle->iSocket, &write);
fd_set error;
FD_ZERO(&error);
FD_SET(handle->iSocket, &error);
struct timeval tv;
tv.tv_sec = aTimeoutMs / 1000;
tv.tv_usec = (aTimeoutMs % 1000) * 1000;
int32_t selectErr = TEMP_FAILURE_RETRY_2(select(nfds(handle), &read, &write, &error, &tv), handle);
if (selectErr > 0 && FD_ISSET(handle->iSocket, &write)) {
err = 0;
}
SetFdBlocking(handle->iSocket);
return err;
}
