MeshAgent/microstack/ILibIPAddressMonitor.c

/*
Copyright 2006 - 2022 Intel Corporation

Licensed under the Apache License, Version 2.0 (the "License");
you may not use this file except in compliance with the License.
You may obtain a copy of the License at

	http://www.apache.org/licenses/LICENSE-2.0

Unless required by applicable law or agreed to in writing, software
distributed under the License is distributed on an "AS IS" BASIS,
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
See the License for the specific language governing permissions and
limitations under the License.
*/

#ifdef WIN32
	#include <winsock2.h>
	#include <ws2tcpip.h>
	#include <iphlpapi.h>
	#include <Dbghelp.h>
#endif

#if defined(WIN32) && !defined(_WIN32_WCE)
#define _CRTDBG_MAP_ALLOC
#include <crtdbg.h>
#endif

#include "ILibParsers.h"

#if defined(_POSIX) && !defined(__APPLE__) && !defined(NO_IPADDR_MONITOR) && !defined(_FREEBSD)
#include <netinet/in.h>
#include <linux/netlink.h>
#include <linux/rtnetlink.h>
#include <net/if.h>
#endif

typedef void* ILibIPAddressMonitor;
typedef void(*ILibIPAddressMonitor_Handler)(ILibIPAddressMonitor sender, void *user);
typedef struct _ILibIPAddressMonitor
{
	ILibChain_Link chainLink;
	ILibIPAddressMonitor_Handler onUpdate;
	void *user;
#ifndef NO_IPADDR_MONITOR
	#ifdef WIN32
		SOCKET mSocket;
		DWORD bytesReturned;
		OVERLAPPED *reserved;
	#elif defined (_POSIX) && !defined(__APPLE__) && !defined(_FREEBSD)
		int mSocket;
		struct sockaddr_nl addr;
	#endif
#endif
}_ILibIPAddressMonitor;
int ILibMemory_IPAddressMonitor_CONTAINER_SIZE = sizeof(_ILibIPAddressMonitor);
void ILibIPAddressMonitor_MicrostackThreadDispatch(void *chain, void *user);

#if defined(WIN32) && !defined(NO_IPADDR_MONITOR)
void CALLBACK ILibIPAddressMonitor_dispatch(
	IN DWORD dwError,
	IN DWORD cbTransferred,
	IN LPWSAOVERLAPPED lpOverlapped,
	IN DWORD dwFlags
)
{
	if (ILibMemory_CanaryOK(lpOverlapped))
	{
		if (dwError == 0 && lpOverlapped->hEvent != NULL)
		{
			_ILibIPAddressMonitor *obj = (_ILibIPAddressMonitor*)lpOverlapped->hEvent;
			ILibChain_RunOnMicrostackThread(obj->chainLink.ParentChain, ILibIPAddressMonitor_MicrostackThreadDispatch, obj);
		}
		else if (lpOverlapped->hEvent == NULL)
		{
			ILibMemory_Free(lpOverlapped);
		}
	}
}
void ILibIPAddressMonitor_MicrostackThreadDispatch(void *chain, void *user)
{
	_ILibIPAddressMonitor *obj = (_ILibIPAddressMonitor*)user;
	if (obj->onUpdate != NULL) { obj->onUpdate(obj, obj->user); }
	WSAIoctl(obj->mSocket, SIO_ADDRESS_LIST_CHANGE, NULL, 0, NULL, 0, &(obj->bytesReturned), obj->reserved, ILibIPAddressMonitor_dispatch);
}
#endif

#ifndef NO_IPADDR_MONITOR
void ILibIPAddressMonitor_Destroy(void *object)
{
#ifndef __APPLE__
	_ILibIPAddressMonitor *obj = (_ILibIPAddressMonitor*)object;
#endif

#ifdef WIN32
	obj->reserved->hEvent = NULL;
	closesocket(obj->mSocket);
	obj->mSocket = INVALID_SOCKET;
#elif defined(_POSIX) && !defined(__APPLE__) && !defined(_FREEBSD)
	close(obj->mSocket);
	obj->mSocket = -1;
#endif
}

#if defined(_POSIX) && !defined(__APPLE__) && !defined(_FREEBSD)
void ILibIPAddressMonitor_PreSelect(void* object, fd_set *readset, fd_set *writeset, fd_set *errorset, int* blocktime)
{
	_ILibIPAddressMonitor *obj = (_ILibIPAddressMonitor*)object;
	FD_SET(obj->mSocket, readset);
}
void ILibIPAddressMonitor_PostSelect(void* object, int slct, fd_set *readset, fd_set *writeset, fd_set *errorset)
{
	char buffer[4096];
	int len;
	int update = 0;
	struct nlmsghdr *nlh = (struct nlmsghdr *)buffer;

	_ILibIPAddressMonitor *obj = (_ILibIPAddressMonitor*)object;
	if (FD_ISSET(obj->mSocket, readset) != 0)
	{
		while ((len = recv(obj->mSocket, nlh, sizeof(buffer), 0)) > 0)
		{
			while ((NLMSG_OK(nlh, len)) && (nlh->nlmsg_type != NLMSG_DONE))
			{
				if (nlh->nlmsg_type == RTM_NEWADDR || nlh->nlmsg_type == RTM_DELADDR)
				{
					update = 1;
				}
				nlh = NLMSG_NEXT(nlh, len);
			}
		}

		if (update != 0 && obj->onUpdate != NULL) { obj->onUpdate(obj, obj->user); }
	}
}
#endif
#endif
ILibIPAddressMonitor ILibIPAddressMonitor_Create(void *chain, ILibIPAddressMonitor_Handler handler, void *user)
{
	_ILibIPAddressMonitor *obj = (_ILibIPAddressMonitor*)ILibChain_Link_Allocate(ILibMemory_IPAddressMonitor_CONTAINER_SIZE, 0);
	obj->chainLink.MetaData = ILibMemory_SmartAllocate_FromString("ILibIPAddressMonitor");
#ifndef NO_IPADDR_MONITOR

	obj->onUpdate = handler;
	obj->user = user;
#ifdef WIN32
	obj->reserved = (OVERLAPPED*)ILibMemory_SmartAllocate(sizeof(OVERLAPPED));  // This leaks due to a bug in Windows, where the WSAIoctl frequently doesn't event on shutdown. If we free try to free it manually, it will cause a crash, because windows will have an invalid overlapped object.
	obj->reserved->hEvent = (HANDLE)obj;
	obj->mSocket = socket(AF_INET, SOCK_DGRAM, 0);
	WSAIoctl(obj->mSocket, SIO_ADDRESS_LIST_CHANGE, NULL, 0, NULL, 0, &(obj->bytesReturned), obj->reserved, ILibIPAddressMonitor_dispatch);
#elif defined (_POSIX) && !defined(__APPLE__) && !defined(_FREEBSD)
	obj->mSocket = socket(AF_NETLINK, SOCK_DGRAM, NETLINK_ROUTE);
	int flags = fcntl(obj->mSocket, F_GETFL, 0);
	fcntl(obj->mSocket, F_SETFL, O_NONBLOCK | flags);

	memset(&(obj->addr), 0, sizeof(obj->addr));
	obj->addr.nl_family = AF_NETLINK;
	obj->addr.nl_groups = RTMGRP_IPV4_IFADDR;

	if (bind(obj->mSocket, (struct sockaddr *)&(obj->addr), sizeof(obj->addr)) == -1) 
	{
		close(obj->mSocket);
		free(obj);
		return(NULL);
	}

	obj->chainLink.PreSelectHandler = ILibIPAddressMonitor_PreSelect;
	obj->chainLink.PostSelectHandler = ILibIPAddressMonitor_PostSelect;
#endif

	obj->chainLink.DestroyHandler = ILibIPAddressMonitor_Destroy;
	ILibAddToChain(chain, obj);

#endif

	return((ILibIPAddressMonitor)obj);
}