12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186 |
- /*
- * wepoll - epoll for Windows
- * https://github.com/piscisaureus/wepoll
- *
- * Copyright 2012-2018, Bert Belder <bertbelder@gmail.com>
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions are
- * met:
- *
- * * Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- *
- * * Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
- * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
- * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
- * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
- * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
- * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
- * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
- * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
- * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
- * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
- * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- */
- #ifndef WEPOLL_EXPORT
- #define WEPOLL_EXPORT
- #endif
- #include <stdint.h>
- /* clang-format off */
- enum EPOLL_EVENTS {
- EPOLLIN = (int) (1U << 0),
- EPOLLPRI = (int) (1U << 1),
- EPOLLOUT = (int) (1U << 2),
- EPOLLERR = (int) (1U << 3),
- EPOLLHUP = (int) (1U << 4),
- EPOLLRDNORM = (int) (1U << 6),
- EPOLLRDBAND = (int) (1U << 7),
- EPOLLWRNORM = (int) (1U << 8),
- EPOLLWRBAND = (int) (1U << 9),
- EPOLLMSG = (int) (1U << 10), /* Never reported. */
- EPOLLRDHUP = (int) (1U << 13),
- EPOLLONESHOT = (int) (1U << 31)
- };
- #define EPOLLIN (1U << 0)
- #define EPOLLPRI (1U << 1)
- #define EPOLLOUT (1U << 2)
- #define EPOLLERR (1U << 3)
- #define EPOLLHUP (1U << 4)
- #define EPOLLRDNORM (1U << 6)
- #define EPOLLRDBAND (1U << 7)
- #define EPOLLWRNORM (1U << 8)
- #define EPOLLWRBAND (1U << 9)
- #define EPOLLMSG (1U << 10)
- #define EPOLLRDHUP (1U << 13)
- #define EPOLLONESHOT (1U << 31)
- #define EPOLL_CTL_ADD 1
- #define EPOLL_CTL_MOD 2
- #define EPOLL_CTL_DEL 3
- /* clang-format on */
- typedef void* HANDLE;
- typedef uintptr_t SOCKET;
- typedef union epoll_data {
- void* ptr;
- int fd;
- uint32_t u32;
- uint64_t u64;
- SOCKET sock; /* Windows specific */
- HANDLE hnd; /* Windows specific */
- } epoll_data_t;
- struct epoll_event {
- uint32_t events; /* Epoll events and flags */
- epoll_data_t data; /* User data variable */
- };
- #ifdef __cplusplus
- extern "C" {
- #endif
- WEPOLL_EXPORT HANDLE epoll_create(int size);
- WEPOLL_EXPORT HANDLE epoll_create1(int flags);
- WEPOLL_EXPORT int epoll_close(HANDLE ephnd);
- WEPOLL_EXPORT int epoll_ctl(HANDLE ephnd,
- int op,
- SOCKET sock,
- struct epoll_event* event);
- WEPOLL_EXPORT int epoll_wait(HANDLE ephnd,
- struct epoll_event* events,
- int maxevents,
- int timeout);
- #ifdef __cplusplus
- } /* extern "C" */
- #endif
- #include <malloc.h>
- #include <stdlib.h>
- #define WEPOLL_INTERNAL static
- #define WEPOLL_INTERNAL_VAR static
- #ifndef WIN32_LEAN_AND_MEAN
- #define WIN32_LEAN_AND_MEAN
- #endif
- #ifdef __clang__
- #pragma clang diagnostic push
- #pragma clang diagnostic ignored "-Wreserved-id-macro"
- #endif
- #ifdef _WIN32_WINNT
- #undef _WIN32_WINNT
- #endif
- #define _WIN32_WINNT 0x0600
- #ifdef __clang__
- #pragma clang diagnostic pop
- #endif
- #ifndef __GNUC__
- #pragma warning(push, 1)
- #endif
- #include <WS2tcpip.h>
- #include <WinSock2.h>
- #include <Windows.h>
- #ifndef __GNUC__
- #pragma warning(pop)
- #endif
- WEPOLL_INTERNAL int nt_global_init(void);
- typedef LONG NTSTATUS;
- typedef NTSTATUS* PNTSTATUS;
- #ifndef NT_SUCCESS
- #define NT_SUCCESS(status) (((NTSTATUS)(status)) >= 0)
- #endif
- #ifndef STATUS_SUCCESS
- #define STATUS_SUCCESS ((NTSTATUS) 0x00000000L)
- #endif
- #ifndef STATUS_PENDING
- #define STATUS_PENDING ((NTSTATUS) 0x00000103L)
- #endif
- #ifndef STATUS_CANCELLED
- #define STATUS_CANCELLED ((NTSTATUS) 0xC0000120L)
- #endif
- typedef struct _IO_STATUS_BLOCK {
- NTSTATUS Status;
- ULONG_PTR Information;
- } IO_STATUS_BLOCK, *PIO_STATUS_BLOCK;
- typedef VOID(NTAPI* PIO_APC_ROUTINE)(PVOID ApcContext,
- PIO_STATUS_BLOCK IoStatusBlock,
- ULONG Reserved);
- typedef struct _LSA_UNICODE_STRING {
- USHORT Length;
- USHORT MaximumLength;
- PWSTR Buffer;
- } LSA_UNICODE_STRING, *PLSA_UNICODE_STRING, UNICODE_STRING, *PUNICODE_STRING;
- #define RTL_CONSTANT_STRING(s) \
- { sizeof(s) - sizeof((s)[0]), sizeof(s), s }
- typedef struct _OBJECT_ATTRIBUTES {
- ULONG Length;
- HANDLE RootDirectory;
- PUNICODE_STRING ObjectName;
- ULONG Attributes;
- PVOID SecurityDescriptor;
- PVOID SecurityQualityOfService;
- } OBJECT_ATTRIBUTES, *POBJECT_ATTRIBUTES;
- #define RTL_CONSTANT_OBJECT_ATTRIBUTES(ObjectName, Attributes) \
- { sizeof(OBJECT_ATTRIBUTES), NULL, ObjectName, Attributes, NULL, NULL }
- #ifndef FILE_OPEN
- #define FILE_OPEN 0x00000001UL
- #endif
- #define NT_NTDLL_IMPORT_LIST(X) \
- X(NTSTATUS, \
- NTAPI, \
- NtCreateFile, \
- (PHANDLE FileHandle, \
- ACCESS_MASK DesiredAccess, \
- POBJECT_ATTRIBUTES ObjectAttributes, \
- PIO_STATUS_BLOCK IoStatusBlock, \
- PLARGE_INTEGER AllocationSize, \
- ULONG FileAttributes, \
- ULONG ShareAccess, \
- ULONG CreateDisposition, \
- ULONG CreateOptions, \
- PVOID EaBuffer, \
- ULONG EaLength)) \
- \
- X(NTSTATUS, \
- NTAPI, \
- NtDeviceIoControlFile, \
- (HANDLE FileHandle, \
- HANDLE Event, \
- PIO_APC_ROUTINE ApcRoutine, \
- PVOID ApcContext, \
- PIO_STATUS_BLOCK IoStatusBlock, \
- ULONG IoControlCode, \
- PVOID InputBuffer, \
- ULONG InputBufferLength, \
- PVOID OutputBuffer, \
- ULONG OutputBufferLength)) \
- \
- X(ULONG, WINAPI, RtlNtStatusToDosError, (NTSTATUS Status)) \
- \
- X(NTSTATUS, \
- NTAPI, \
- NtCreateKeyedEvent, \
- (PHANDLE handle, \
- ACCESS_MASK access, \
- POBJECT_ATTRIBUTES attr, \
- ULONG flags)) \
- \
- X(NTSTATUS, \
- NTAPI, \
- NtWaitForKeyedEvent, \
- (HANDLE handle, PVOID key, BOOLEAN alertable, PLARGE_INTEGER mstimeout)) \
- \
- X(NTSTATUS, \
- NTAPI, \
- NtReleaseKeyedEvent, \
- (HANDLE handle, PVOID key, BOOLEAN alertable, PLARGE_INTEGER mstimeout))
- #define X(return_type, attributes, name, parameters) \
- WEPOLL_INTERNAL_VAR return_type(attributes* name) parameters;
- NT_NTDLL_IMPORT_LIST(X)
- #undef X
- #include <assert.h>
- #include <stddef.h>
- #ifndef _SSIZE_T_DEFINED
- typedef intptr_t ssize_t;
- #endif
- #define array_count(a) (sizeof(a) / (sizeof((a)[0])))
- /* clang-format off */
- #define container_of(ptr, type, member) \
- ((type*) ((uintptr_t) (ptr) - offsetof(type, member)))
- /* clang-format on */
- #define unused_var(v) ((void) (v))
- /* Polyfill `inline` for older versions of msvc (up to Visual Studio 2013) */
- #if defined(_MSC_VER) && _MSC_VER < 1900
- #define inline __inline
- #endif
- /* clang-format off */
- #define AFD_POLL_RECEIVE 0x0001
- #define AFD_POLL_RECEIVE_EXPEDITED 0x0002
- #define AFD_POLL_SEND 0x0004
- #define AFD_POLL_DISCONNECT 0x0008
- #define AFD_POLL_ABORT 0x0010
- #define AFD_POLL_LOCAL_CLOSE 0x0020
- #define AFD_POLL_ACCEPT 0x0080
- #define AFD_POLL_CONNECT_FAIL 0x0100
- /* clang-format on */
- typedef struct _AFD_POLL_HANDLE_INFO {
- HANDLE Handle;
- ULONG Events;
- NTSTATUS Status;
- } AFD_POLL_HANDLE_INFO, *PAFD_POLL_HANDLE_INFO;
- typedef struct _AFD_POLL_INFO {
- LARGE_INTEGER Timeout;
- ULONG NumberOfHandles;
- ULONG Exclusive;
- AFD_POLL_HANDLE_INFO Handles[1];
- } AFD_POLL_INFO, *PAFD_POLL_INFO;
- WEPOLL_INTERNAL int afd_create_helper_handle(HANDLE iocp,
- HANDLE* afd_helper_handle_out);
- WEPOLL_INTERNAL int afd_poll(HANDLE afd_helper_handle,
- AFD_POLL_INFO* poll_info,
- OVERLAPPED* overlapped);
- #define return_map_error(value) \
- do { \
- err_map_win_error(); \
- return (value); \
- } while (0)
- #define return_set_error(value, error) \
- do { \
- err_set_win_error(error); \
- return (value); \
- } while (0)
- WEPOLL_INTERNAL void err_map_win_error(void);
- WEPOLL_INTERNAL void err_set_win_error(DWORD error);
- WEPOLL_INTERNAL int err_check_handle(HANDLE handle);
- WEPOLL_INTERNAL int ws_global_init(void);
- WEPOLL_INTERNAL SOCKET ws_get_base_socket(SOCKET socket);
- #define IOCTL_AFD_POLL 0x00012024
- static UNICODE_STRING afd__helper_name =
- RTL_CONSTANT_STRING(L"\\Device\\Afd\\Wepoll");
- static OBJECT_ATTRIBUTES afd__helper_attributes =
- RTL_CONSTANT_OBJECT_ATTRIBUTES(&afd__helper_name, 0);
- int afd_create_helper_handle(HANDLE iocp, HANDLE* afd_helper_handle_out) {
- HANDLE afd_helper_handle;
- IO_STATUS_BLOCK iosb;
- NTSTATUS status;
- /* By opening \Device\Afd without specifying any extended attributes, we'll
- * get a handle that lets us talk to the AFD driver, but that doesn't have an
- * associated endpoint (so it's not a socket). */
- status = NtCreateFile(&afd_helper_handle,
- SYNCHRONIZE,
- &afd__helper_attributes,
- &iosb,
- NULL,
- 0,
- FILE_SHARE_READ | FILE_SHARE_WRITE,
- FILE_OPEN,
- 0,
- NULL,
- 0);
- if (status != STATUS_SUCCESS)
- return_set_error(-1, RtlNtStatusToDosError(status));
- if (CreateIoCompletionPort(afd_helper_handle, iocp, 0, 0) == NULL)
- goto error;
- if (!SetFileCompletionNotificationModes(afd_helper_handle,
- FILE_SKIP_SET_EVENT_ON_HANDLE))
- goto error;
- *afd_helper_handle_out = afd_helper_handle;
- return 0;
- error:
- CloseHandle(afd_helper_handle);
- return_map_error(-1);
- }
- int afd_poll(HANDLE afd_helper_handle,
- AFD_POLL_INFO* poll_info,
- OVERLAPPED* overlapped) {
- IO_STATUS_BLOCK* iosb;
- HANDLE event;
- void* apc_context;
- NTSTATUS status;
- /* Blocking operation is not supported. */
- assert(overlapped != NULL);
- iosb = (IO_STATUS_BLOCK*) &overlapped->Internal;
- event = overlapped->hEvent;
- /* Do what other windows APIs would do: if hEvent has it's lowest bit set,
- * don't post a completion to the completion port. */
- if ((uintptr_t) event & 1) {
- event = (HANDLE)((uintptr_t) event & ~(uintptr_t) 1);
- apc_context = NULL;
- } else {
- apc_context = overlapped;
- }
- iosb->Status = STATUS_PENDING;
- status = NtDeviceIoControlFile(afd_helper_handle,
- event,
- NULL,
- apc_context,
- iosb,
- IOCTL_AFD_POLL,
- poll_info,
- sizeof *poll_info,
- poll_info,
- sizeof *poll_info);
- if (status == STATUS_SUCCESS)
- return 0;
- else if (status == STATUS_PENDING)
- return_set_error(-1, ERROR_IO_PENDING);
- else
- return_set_error(-1, RtlNtStatusToDosError(status));
- }
- WEPOLL_INTERNAL int epoll_global_init(void);
- WEPOLL_INTERNAL int init(void);
- #include <stdbool.h>
- typedef struct queue_node queue_node_t;
- typedef struct queue_node {
- queue_node_t* prev;
- queue_node_t* next;
- } queue_node_t;
- typedef struct queue {
- queue_node_t head;
- } queue_t;
- WEPOLL_INTERNAL void queue_init(queue_t* queue);
- WEPOLL_INTERNAL void queue_node_init(queue_node_t* node);
- WEPOLL_INTERNAL queue_node_t* queue_first(const queue_t* queue);
- WEPOLL_INTERNAL queue_node_t* queue_last(const queue_t* queue);
- WEPOLL_INTERNAL void queue_prepend(queue_t* queue, queue_node_t* node);
- WEPOLL_INTERNAL void queue_append(queue_t* queue, queue_node_t* node);
- WEPOLL_INTERNAL void queue_move_first(queue_t* queue, queue_node_t* node);
- WEPOLL_INTERNAL void queue_move_last(queue_t* queue, queue_node_t* node);
- WEPOLL_INTERNAL void queue_remove(queue_node_t* node);
- WEPOLL_INTERNAL bool queue_empty(const queue_t* queue);
- WEPOLL_INTERNAL bool queue_enqueued(const queue_node_t* node);
- typedef struct port_state port_state_t;
- typedef struct poll_group poll_group_t;
- WEPOLL_INTERNAL poll_group_t* poll_group_acquire(port_state_t* port);
- WEPOLL_INTERNAL void poll_group_release(poll_group_t* poll_group);
- WEPOLL_INTERNAL void poll_group_delete(poll_group_t* poll_group);
- WEPOLL_INTERNAL poll_group_t* poll_group_from_queue_node(
- queue_node_t* queue_node);
- WEPOLL_INTERNAL HANDLE
- poll_group_get_afd_helper_handle(poll_group_t* poll_group);
- /* N.b.: the tree functions do not set errno or LastError when they fail. Each
- * of the API functions has at most one failure mode. It is up to the caller to
- * set an appropriate error code when necessary. */
- typedef struct tree tree_t;
- typedef struct tree_node tree_node_t;
- typedef struct tree {
- tree_node_t* root;
- } tree_t;
- typedef struct tree_node {
- tree_node_t* left;
- tree_node_t* right;
- tree_node_t* parent;
- uintptr_t key;
- bool red;
- } tree_node_t;
- WEPOLL_INTERNAL void tree_init(tree_t* tree);
- WEPOLL_INTERNAL void tree_node_init(tree_node_t* node);
- WEPOLL_INTERNAL int tree_add(tree_t* tree, tree_node_t* node, uintptr_t key);
- WEPOLL_INTERNAL void tree_del(tree_t* tree, tree_node_t* node);
- WEPOLL_INTERNAL tree_node_t* tree_find(const tree_t* tree, uintptr_t key);
- WEPOLL_INTERNAL tree_node_t* tree_root(const tree_t* tree);
- typedef struct port_state port_state_t;
- typedef struct sock_state sock_state_t;
- WEPOLL_INTERNAL sock_state_t* sock_new(port_state_t* port_state,
- SOCKET socket);
- WEPOLL_INTERNAL void sock_delete(port_state_t* port_state,
- sock_state_t* sock_state);
- WEPOLL_INTERNAL void sock_force_delete(port_state_t* port_state,
- sock_state_t* sock_state);
- WEPOLL_INTERNAL int sock_set_event(port_state_t* port_state,
- sock_state_t* sock_state,
- const struct epoll_event* ev);
- WEPOLL_INTERNAL int sock_update(port_state_t* port_state,
- sock_state_t* sock_state);
- WEPOLL_INTERNAL int sock_feed_event(port_state_t* port_state,
- OVERLAPPED* overlapped,
- struct epoll_event* ev);
- WEPOLL_INTERNAL sock_state_t* sock_state_from_queue_node(
- queue_node_t* queue_node);
- WEPOLL_INTERNAL queue_node_t* sock_state_to_queue_node(
- sock_state_t* sock_state);
- WEPOLL_INTERNAL sock_state_t* sock_state_from_tree_node(
- tree_node_t* tree_node);
- WEPOLL_INTERNAL tree_node_t* sock_state_to_tree_node(sock_state_t* sock_state);
- /* The reflock is a special kind of lock that normally prevents a chunk of
- * memory from being freed, but does allow the chunk of memory to eventually be
- * released in a coordinated fashion.
- *
- * Under normal operation, threads increase and decrease the reference count,
- * which are wait-free operations.
- *
- * Exactly once during the reflock's lifecycle, a thread holding a reference to
- * the lock may "destroy" the lock; this operation blocks until all other
- * threads holding a reference to the lock have dereferenced it. After
- * "destroy" returns, the calling thread may assume that no other threads have
- * a reference to the lock.
- *
- * Attemmpting to lock or destroy a lock after reflock_unref_and_destroy() has
- * been called is invalid and results in undefined behavior. Therefore the user
- * should use another lock to guarantee that this can't happen.
- */
- typedef struct reflock {
- volatile long state; /* 32-bit Interlocked APIs operate on `long` values. */
- } reflock_t;
- WEPOLL_INTERNAL int reflock_global_init(void);
- WEPOLL_INTERNAL void reflock_init(reflock_t* reflock);
- WEPOLL_INTERNAL void reflock_ref(reflock_t* reflock);
- WEPOLL_INTERNAL void reflock_unref(reflock_t* reflock);
- WEPOLL_INTERNAL void reflock_unref_and_destroy(reflock_t* reflock);
- typedef struct ts_tree {
- tree_t tree;
- SRWLOCK lock;
- } ts_tree_t;
- typedef struct ts_tree_node {
- tree_node_t tree_node;
- reflock_t reflock;
- } ts_tree_node_t;
- WEPOLL_INTERNAL void ts_tree_init(ts_tree_t* rtl);
- WEPOLL_INTERNAL void ts_tree_node_init(ts_tree_node_t* node);
- WEPOLL_INTERNAL int ts_tree_add(ts_tree_t* ts_tree,
- ts_tree_node_t* node,
- uintptr_t key);
- WEPOLL_INTERNAL ts_tree_node_t* ts_tree_del_and_ref(ts_tree_t* ts_tree,
- uintptr_t key);
- WEPOLL_INTERNAL ts_tree_node_t* ts_tree_find_and_ref(ts_tree_t* ts_tree,
- uintptr_t key);
- WEPOLL_INTERNAL void ts_tree_node_unref(ts_tree_node_t* node);
- WEPOLL_INTERNAL void ts_tree_node_unref_and_destroy(ts_tree_node_t* node);
- typedef struct port_state port_state_t;
- typedef struct sock_state sock_state_t;
- typedef struct port_state {
- HANDLE iocp;
- tree_t sock_tree;
- queue_t sock_update_queue;
- queue_t sock_deleted_queue;
- queue_t poll_group_queue;
- ts_tree_node_t handle_tree_node;
- CRITICAL_SECTION lock;
- size_t active_poll_count;
- } port_state_t;
- WEPOLL_INTERNAL port_state_t* port_new(HANDLE* iocp_out);
- WEPOLL_INTERNAL int port_close(port_state_t* port_state);
- WEPOLL_INTERNAL int port_delete(port_state_t* port_state);
- WEPOLL_INTERNAL int port_wait(port_state_t* port_state,
- struct epoll_event* events,
- int maxevents,
- int timeout);
- WEPOLL_INTERNAL int port_ctl(port_state_t* port_state,
- int op,
- SOCKET sock,
- struct epoll_event* ev);
- WEPOLL_INTERNAL int port_register_socket_handle(port_state_t* port_state,
- sock_state_t* sock_state,
- SOCKET socket);
- WEPOLL_INTERNAL void port_unregister_socket_handle(port_state_t* port_state,
- sock_state_t* sock_state);
- WEPOLL_INTERNAL sock_state_t* port_find_socket(port_state_t* port_state,
- SOCKET socket);
- WEPOLL_INTERNAL void port_request_socket_update(port_state_t* port_state,
- sock_state_t* sock_state);
- WEPOLL_INTERNAL void port_cancel_socket_update(port_state_t* port_state,
- sock_state_t* sock_state);
- WEPOLL_INTERNAL void port_add_deleted_socket(port_state_t* port_state,
- sock_state_t* sock_state);
- WEPOLL_INTERNAL void port_remove_deleted_socket(port_state_t* port_state,
- sock_state_t* sock_state);
- static ts_tree_t epoll__handle_tree;
- static inline port_state_t* epoll__handle_tree_node_to_port(
- ts_tree_node_t* tree_node) {
- return container_of(tree_node, port_state_t, handle_tree_node);
- }
- int epoll_global_init(void) {
- ts_tree_init(&epoll__handle_tree);
- return 0;
- }
- static HANDLE epoll__create(void) {
- port_state_t* port_state;
- HANDLE ephnd;
- if (init() < 0)
- return NULL;
- port_state = port_new(&ephnd);
- if (port_state == NULL)
- return NULL;
- if (ts_tree_add(&epoll__handle_tree,
- &port_state->handle_tree_node,
- (uintptr_t) ephnd) < 0) {
- /* This should never happen. */
- port_delete(port_state);
- return_set_error(NULL, ERROR_ALREADY_EXISTS);
- }
- return ephnd;
- }
- HANDLE epoll_create(int size) {
- if (size <= 0)
- return_set_error(NULL, ERROR_INVALID_PARAMETER);
- return epoll__create();
- }
- HANDLE epoll_create1(int flags) {
- if (flags != 0)
- return_set_error(NULL, ERROR_INVALID_PARAMETER);
- return epoll__create();
- }
- int epoll_close(HANDLE ephnd) {
- ts_tree_node_t* tree_node;
- port_state_t* port_state;
- if (init() < 0)
- return -1;
- tree_node = ts_tree_del_and_ref(&epoll__handle_tree, (uintptr_t) ephnd);
- if (tree_node == NULL) {
- err_set_win_error(ERROR_INVALID_PARAMETER);
- goto err;
- }
- port_state = epoll__handle_tree_node_to_port(tree_node);
- port_close(port_state);
- ts_tree_node_unref_and_destroy(tree_node);
- return port_delete(port_state);
- err:
- err_check_handle(ephnd);
- return -1;
- }
- int epoll_ctl(HANDLE ephnd, int op, SOCKET sock, struct epoll_event* ev) {
- ts_tree_node_t* tree_node;
- port_state_t* port_state;
- int r;
- if (init() < 0)
- return -1;
- tree_node = ts_tree_find_and_ref(&epoll__handle_tree, (uintptr_t) ephnd);
- if (tree_node == NULL) {
- err_set_win_error(ERROR_INVALID_PARAMETER);
- goto err;
- }
- port_state = epoll__handle_tree_node_to_port(tree_node);
- r = port_ctl(port_state, op, sock, ev);
- ts_tree_node_unref(tree_node);
- if (r < 0)
- goto err;
- return 0;
- err:
- /* On Linux, in the case of epoll_ctl_mod(), EBADF takes priority over other
- * errors. Wepoll mimics this behavior. */
- err_check_handle(ephnd);
- err_check_handle((HANDLE) sock);
- return -1;
- }
- int epoll_wait(HANDLE ephnd,
- struct epoll_event* events,
- int maxevents,
- int timeout) {
- ts_tree_node_t* tree_node;
- port_state_t* port_state;
- int num_events;
- if (maxevents <= 0)
- return_set_error(-1, ERROR_INVALID_PARAMETER);
- if (init() < 0)
- return -1;
- tree_node = ts_tree_find_and_ref(&epoll__handle_tree, (uintptr_t) ephnd);
- if (tree_node == NULL) {
- err_set_win_error(ERROR_INVALID_PARAMETER);
- goto err;
- }
- port_state = epoll__handle_tree_node_to_port(tree_node);
- num_events = port_wait(port_state, events, maxevents, timeout);
- ts_tree_node_unref(tree_node);
- if (num_events < 0)
- goto err;
- return num_events;
- err:
- err_check_handle(ephnd);
- return -1;
- }
- #include <errno.h>
- #define ERR__ERRNO_MAPPINGS(X) \
- X(ERROR_ACCESS_DENIED, EACCES) \
- X(ERROR_ALREADY_EXISTS, EEXIST) \
- X(ERROR_BAD_COMMAND, EACCES) \
- X(ERROR_BAD_EXE_FORMAT, ENOEXEC) \
- X(ERROR_BAD_LENGTH, EACCES) \
- X(ERROR_BAD_NETPATH, ENOENT) \
- X(ERROR_BAD_NET_NAME, ENOENT) \
- X(ERROR_BAD_NET_RESP, ENETDOWN) \
- X(ERROR_BAD_PATHNAME, ENOENT) \
- X(ERROR_BROKEN_PIPE, EPIPE) \
- X(ERROR_CANNOT_MAKE, EACCES) \
- X(ERROR_COMMITMENT_LIMIT, ENOMEM) \
- X(ERROR_CONNECTION_ABORTED, ECONNABORTED) \
- X(ERROR_CONNECTION_ACTIVE, EISCONN) \
- X(ERROR_CONNECTION_REFUSED, ECONNREFUSED) \
- X(ERROR_CRC, EACCES) \
- X(ERROR_DIR_NOT_EMPTY, ENOTEMPTY) \
- X(ERROR_DISK_FULL, ENOSPC) \
- X(ERROR_DUP_NAME, EADDRINUSE) \
- X(ERROR_FILENAME_EXCED_RANGE, ENOENT) \
- X(ERROR_FILE_NOT_FOUND, ENOENT) \
- X(ERROR_GEN_FAILURE, EACCES) \
- X(ERROR_GRACEFUL_DISCONNECT, EPIPE) \
- X(ERROR_HOST_DOWN, EHOSTUNREACH) \
- X(ERROR_HOST_UNREACHABLE, EHOSTUNREACH) \
- X(ERROR_INSUFFICIENT_BUFFER, EFAULT) \
- X(ERROR_INVALID_ADDRESS, EADDRNOTAVAIL) \
- X(ERROR_INVALID_FUNCTION, EINVAL) \
- X(ERROR_INVALID_HANDLE, EBADF) \
- X(ERROR_INVALID_NETNAME, EADDRNOTAVAIL) \
- X(ERROR_INVALID_PARAMETER, EINVAL) \
- X(ERROR_INVALID_USER_BUFFER, EMSGSIZE) \
- X(ERROR_IO_PENDING, EINPROGRESS) \
- X(ERROR_LOCK_VIOLATION, EACCES) \
- X(ERROR_MORE_DATA, EMSGSIZE) \
- X(ERROR_NETNAME_DELETED, ECONNABORTED) \
- X(ERROR_NETWORK_ACCESS_DENIED, EACCES) \
- X(ERROR_NETWORK_BUSY, ENETDOWN) \
- X(ERROR_NETWORK_UNREACHABLE, ENETUNREACH) \
- X(ERROR_NOACCESS, EFAULT) \
- X(ERROR_NONPAGED_SYSTEM_RESOURCES, ENOMEM) \
- X(ERROR_NOT_ENOUGH_MEMORY, ENOMEM) \
- X(ERROR_NOT_ENOUGH_QUOTA, ENOMEM) \
- X(ERROR_NOT_FOUND, ENOENT) \
- X(ERROR_NOT_LOCKED, EACCES) \
- X(ERROR_NOT_READY, EACCES) \
- X(ERROR_NOT_SAME_DEVICE, EXDEV) \
- X(ERROR_NOT_SUPPORTED, ENOTSUP) \
- X(ERROR_NO_MORE_FILES, ENOENT) \
- X(ERROR_NO_SYSTEM_RESOURCES, ENOMEM) \
- X(ERROR_OPERATION_ABORTED, EINTR) \
- X(ERROR_OUT_OF_PAPER, EACCES) \
- X(ERROR_PAGED_SYSTEM_RESOURCES, ENOMEM) \
- X(ERROR_PAGEFILE_QUOTA, ENOMEM) \
- X(ERROR_PATH_NOT_FOUND, ENOENT) \
- X(ERROR_PIPE_NOT_CONNECTED, EPIPE) \
- X(ERROR_PORT_UNREACHABLE, ECONNRESET) \
- X(ERROR_PROTOCOL_UNREACHABLE, ENETUNREACH) \
- X(ERROR_REM_NOT_LIST, ECONNREFUSED) \
- X(ERROR_REQUEST_ABORTED, EINTR) \
- X(ERROR_REQ_NOT_ACCEP, EWOULDBLOCK) \
- X(ERROR_SECTOR_NOT_FOUND, EACCES) \
- X(ERROR_SEM_TIMEOUT, ETIMEDOUT) \
- X(ERROR_SHARING_VIOLATION, EACCES) \
- X(ERROR_TOO_MANY_NAMES, ENOMEM) \
- X(ERROR_TOO_MANY_OPEN_FILES, EMFILE) \
- X(ERROR_UNEXP_NET_ERR, ECONNABORTED) \
- X(ERROR_WAIT_NO_CHILDREN, ECHILD) \
- X(ERROR_WORKING_SET_QUOTA, ENOMEM) \
- X(ERROR_WRITE_PROTECT, EACCES) \
- X(ERROR_WRONG_DISK, EACCES) \
- X(WSAEACCES, EACCES) \
- X(WSAEADDRINUSE, EADDRINUSE) \
- X(WSAEADDRNOTAVAIL, EADDRNOTAVAIL) \
- X(WSAEAFNOSUPPORT, EAFNOSUPPORT) \
- X(WSAECONNABORTED, ECONNABORTED) \
- X(WSAECONNREFUSED, ECONNREFUSED) \
- X(WSAECONNRESET, ECONNRESET) \
- X(WSAEDISCON, EPIPE) \
- X(WSAEFAULT, EFAULT) \
- X(WSAEHOSTDOWN, EHOSTUNREACH) \
- X(WSAEHOSTUNREACH, EHOSTUNREACH) \
- X(WSAEINPROGRESS, EBUSY) \
- X(WSAEINTR, EINTR) \
- X(WSAEINVAL, EINVAL) \
- X(WSAEISCONN, EISCONN) \
- X(WSAEMSGSIZE, EMSGSIZE) \
- X(WSAENETDOWN, ENETDOWN) \
- X(WSAENETRESET, EHOSTUNREACH) \
- X(WSAENETUNREACH, ENETUNREACH) \
- X(WSAENOBUFS, ENOMEM) \
- X(WSAENOTCONN, ENOTCONN) \
- X(WSAENOTSOCK, ENOTSOCK) \
- X(WSAEOPNOTSUPP, EOPNOTSUPP) \
- X(WSAEPROCLIM, ENOMEM) \
- X(WSAESHUTDOWN, EPIPE) \
- X(WSAETIMEDOUT, ETIMEDOUT) \
- X(WSAEWOULDBLOCK, EWOULDBLOCK) \
- X(WSANOTINITIALISED, ENETDOWN) \
- X(WSASYSNOTREADY, ENETDOWN) \
- X(WSAVERNOTSUPPORTED, ENOSYS)
- static errno_t err__map_win_error_to_errno(DWORD error) {
- switch (error) {
- #define X(error_sym, errno_sym) \
- case error_sym: \
- return errno_sym;
- ERR__ERRNO_MAPPINGS(X)
- #undef X
- }
- return EINVAL;
- }
- void err_map_win_error(void) {
- errno = err__map_win_error_to_errno(GetLastError());
- }
- void err_set_win_error(DWORD error) {
- SetLastError(error);
- errno = err__map_win_error_to_errno(error);
- }
- int err_check_handle(HANDLE handle) {
- DWORD flags;
- /* GetHandleInformation() succeeds when passed INVALID_HANDLE_VALUE, so check
- * for this condition explicitly. */
- if (handle == INVALID_HANDLE_VALUE)
- return_set_error(-1, ERROR_INVALID_HANDLE);
- if (!GetHandleInformation(handle, &flags))
- return_map_error(-1);
- return 0;
- }
- static bool init__done = false;
- static INIT_ONCE init__once = INIT_ONCE_STATIC_INIT;
- static BOOL CALLBACK init__once_callback(INIT_ONCE* once,
- void* parameter,
- void** context) {
- unused_var(once);
- unused_var(parameter);
- unused_var(context);
- /* N.b. that initialization order matters here. */
- if (ws_global_init() < 0 || nt_global_init() < 0 ||
- reflock_global_init() < 0 || epoll_global_init() < 0)
- return FALSE;
- init__done = true;
- return TRUE;
- }
- int init(void) {
- if (!init__done &&
- !InitOnceExecuteOnce(&init__once, init__once_callback, NULL, NULL))
- return -1; /* LastError and errno aren't touched InitOnceExecuteOnce. */
- return 0;
- }
- /* Set up a workaround for the following problem:
- * FARPROC addr = GetProcAddress(...);
- * MY_FUNC func = (MY_FUNC) addr; <-- GCC 8 warning/error.
- * MY_FUNC func = (MY_FUNC) (void*) addr; <-- MSVC warning/error.
- * To compile cleanly with either compiler, do casts with this "bridge" type:
- * MY_FUNC func = (MY_FUNC) (nt__fn_ptr_cast_t) addr; */
- #ifdef __GNUC__
- typedef void* nt__fn_ptr_cast_t;
- #else
- typedef FARPROC nt__fn_ptr_cast_t;
- #endif
- #define X(return_type, attributes, name, parameters) \
- WEPOLL_INTERNAL return_type(attributes* name) parameters = NULL;
- NT_NTDLL_IMPORT_LIST(X)
- #undef X
- int nt_global_init(void) {
- HMODULE ntdll;
- FARPROC fn_ptr;
- ntdll = GetModuleHandleW(L"ntdll.dll");
- if (ntdll == NULL)
- return -1;
- #define X(return_type, attributes, name, parameters) \
- fn_ptr = GetProcAddress(ntdll, #name); \
- if (fn_ptr == NULL) \
- return -1; \
- name = (return_type(attributes*) parameters)(nt__fn_ptr_cast_t) fn_ptr;
- NT_NTDLL_IMPORT_LIST(X)
- #undef X
- return 0;
- }
- #include <string.h>
- static const size_t POLL_GROUP__MAX_GROUP_SIZE = 32;
- typedef struct poll_group {
- port_state_t* port_state;
- queue_node_t queue_node;
- HANDLE afd_helper_handle;
- size_t group_size;
- } poll_group_t;
- static poll_group_t* poll_group__new(port_state_t* port_state) {
- poll_group_t* poll_group = malloc(sizeof *poll_group);
- if (poll_group == NULL)
- return_set_error(NULL, ERROR_NOT_ENOUGH_MEMORY);
- memset(poll_group, 0, sizeof *poll_group);
- queue_node_init(&poll_group->queue_node);
- poll_group->port_state = port_state;
- if (afd_create_helper_handle(port_state->iocp,
- &poll_group->afd_helper_handle) < 0) {
- free(poll_group);
- return NULL;
- }
- queue_append(&port_state->poll_group_queue, &poll_group->queue_node);
- return poll_group;
- }
- void poll_group_delete(poll_group_t* poll_group) {
- assert(poll_group->group_size == 0);
- CloseHandle(poll_group->afd_helper_handle);
- queue_remove(&poll_group->queue_node);
- free(poll_group);
- }
- poll_group_t* poll_group_from_queue_node(queue_node_t* queue_node) {
- return container_of(queue_node, poll_group_t, queue_node);
- }
- HANDLE poll_group_get_afd_helper_handle(poll_group_t* poll_group) {
- return poll_group->afd_helper_handle;
- }
- poll_group_t* poll_group_acquire(port_state_t* port_state) {
- queue_t* queue = &port_state->poll_group_queue;
- poll_group_t* poll_group =
- !queue_empty(queue)
- ? container_of(queue_last(queue), poll_group_t, queue_node)
- : NULL;
- if (poll_group == NULL ||
- poll_group->group_size >= POLL_GROUP__MAX_GROUP_SIZE)
- poll_group = poll_group__new(port_state);
- if (poll_group == NULL)
- return NULL;
- if (++poll_group->group_size == POLL_GROUP__MAX_GROUP_SIZE)
- queue_move_first(&port_state->poll_group_queue, &poll_group->queue_node);
- return poll_group;
- }
- void poll_group_release(poll_group_t* poll_group) {
- port_state_t* port_state = poll_group->port_state;
- poll_group->group_size--;
- assert(poll_group->group_size < POLL_GROUP__MAX_GROUP_SIZE);
- queue_move_last(&port_state->poll_group_queue, &poll_group->queue_node);
- /* Poll groups are currently only freed when the epoll port is closed. */
- }
- #define PORT__MAX_ON_STACK_COMPLETIONS 256
- static port_state_t* port__alloc(void) {
- port_state_t* port_state = malloc(sizeof *port_state);
- if (port_state == NULL)
- return_set_error(NULL, ERROR_NOT_ENOUGH_MEMORY);
- return port_state;
- }
- static void port__free(port_state_t* port) {
- assert(port != NULL);
- free(port);
- }
- static HANDLE port__create_iocp(void) {
- HANDLE iocp = CreateIoCompletionPort(INVALID_HANDLE_VALUE, NULL, 0, 0);
- if (iocp == NULL)
- return_map_error(NULL);
- return iocp;
- }
- port_state_t* port_new(HANDLE* iocp_out) {
- port_state_t* port_state;
- HANDLE iocp;
- port_state = port__alloc();
- if (port_state == NULL)
- goto err1;
- iocp = port__create_iocp();
- if (iocp == NULL)
- goto err2;
- memset(port_state, 0, sizeof *port_state);
- port_state->iocp = iocp;
- tree_init(&port_state->sock_tree);
- queue_init(&port_state->sock_update_queue);
- queue_init(&port_state->sock_deleted_queue);
- queue_init(&port_state->poll_group_queue);
- ts_tree_node_init(&port_state->handle_tree_node);
- InitializeCriticalSection(&port_state->lock);
- *iocp_out = iocp;
- return port_state;
- err2:
- port__free(port_state);
- err1:
- return NULL;
- }
- static int port__close_iocp(port_state_t* port_state) {
- HANDLE iocp = port_state->iocp;
- port_state->iocp = NULL;
- if (!CloseHandle(iocp))
- return_map_error(-1);
- return 0;
- }
- int port_close(port_state_t* port_state) {
- int result;
- EnterCriticalSection(&port_state->lock);
- result = port__close_iocp(port_state);
- LeaveCriticalSection(&port_state->lock);
- return result;
- }
- int port_delete(port_state_t* port_state) {
- tree_node_t* tree_node;
- queue_node_t* queue_node;
- /* At this point the IOCP port should have been closed. */
- assert(port_state->iocp == NULL);
- while ((tree_node = tree_root(&port_state->sock_tree)) != NULL) {
- sock_state_t* sock_state = sock_state_from_tree_node(tree_node);
- sock_force_delete(port_state, sock_state);
- }
- while ((queue_node = queue_first(&port_state->sock_deleted_queue)) != NULL) {
- sock_state_t* sock_state = sock_state_from_queue_node(queue_node);
- sock_force_delete(port_state, sock_state);
- }
- while ((queue_node = queue_first(&port_state->poll_group_queue)) != NULL) {
- poll_group_t* poll_group = poll_group_from_queue_node(queue_node);
- poll_group_delete(poll_group);
- }
- assert(queue_empty(&port_state->sock_update_queue));
- DeleteCriticalSection(&port_state->lock);
- port__free(port_state);
- return 0;
- }
- static int port__update_events(port_state_t* port_state) {
- queue_t* sock_update_queue = &port_state->sock_update_queue;
- /* Walk the queue, submitting new poll requests for every socket that needs
- * it. */
- while (!queue_empty(sock_update_queue)) {
- queue_node_t* queue_node = queue_first(sock_update_queue);
- sock_state_t* sock_state = sock_state_from_queue_node(queue_node);
- if (sock_update(port_state, sock_state) < 0)
- return -1;
- /* sock_update() removes the socket from the update queue. */
- }
- return 0;
- }
- static void port__update_events_if_polling(port_state_t* port_state) {
- if (port_state->active_poll_count > 0)
- port__update_events(port_state);
- }
- static int port__feed_events(port_state_t* port_state,
- struct epoll_event* epoll_events,
- OVERLAPPED_ENTRY* iocp_events,
- DWORD iocp_event_count) {
- int epoll_event_count = 0;
- DWORD i;
- for (i = 0; i < iocp_event_count; i++) {
- OVERLAPPED* overlapped = iocp_events[i].lpOverlapped;
- struct epoll_event* ev = &epoll_events[epoll_event_count];
- epoll_event_count += sock_feed_event(port_state, overlapped, ev);
- }
- return epoll_event_count;
- }
- static int port__poll(port_state_t* port_state,
- struct epoll_event* epoll_events,
- OVERLAPPED_ENTRY* iocp_events,
- DWORD maxevents,
- DWORD timeout) {
- DWORD completion_count;
- if (port__update_events(port_state) < 0)
- return -1;
- port_state->active_poll_count++;
- LeaveCriticalSection(&port_state->lock);
- BOOL r = GetQueuedCompletionStatusEx(port_state->iocp,
- iocp_events,
- maxevents,
- &completion_count,
- timeout,
- FALSE);
- EnterCriticalSection(&port_state->lock);
- port_state->active_poll_count--;
- if (!r)
- return_map_error(-1);
- return port__feed_events(
- port_state, epoll_events, iocp_events, completion_count);
- }
- int port_wait(port_state_t* port_state,
- struct epoll_event* events,
- int maxevents,
- int timeout) {
- OVERLAPPED_ENTRY stack_iocp_events[PORT__MAX_ON_STACK_COMPLETIONS];
- OVERLAPPED_ENTRY* iocp_events;
- uint64_t due = 0;
- DWORD gqcs_timeout;
- int result;
- /* Check whether `maxevents` is in range. */
- if (maxevents <= 0)
- return_set_error(-1, ERROR_INVALID_PARAMETER);
- /* Decide whether the IOCP completion list can live on the stack, or allocate
- * memory for it on the heap. */
- if ((size_t) maxevents <= array_count(stack_iocp_events)) {
- iocp_events = stack_iocp_events;
- } else if ((iocp_events =
- malloc((size_t) maxevents * sizeof *iocp_events)) == NULL) {
- iocp_events = stack_iocp_events;
- maxevents = array_count(stack_iocp_events);
- }
- /* Compute the timeout for GetQueuedCompletionStatus, and the wait end
- * time, if the user specified a timeout other than zero or infinite. */
- if (timeout > 0) {
- due = GetTickCount64() + (uint64_t) timeout;
- gqcs_timeout = (DWORD) timeout;
- } else if (timeout == 0) {
- gqcs_timeout = 0;
- } else {
- gqcs_timeout = INFINITE;
- }
- EnterCriticalSection(&port_state->lock);
- /* Dequeue completion packets until either at least one interesting event
- * has been discovered, or the timeout is reached. */
- for (;;) {
- uint64_t now;
- result = port__poll(
- port_state, events, iocp_events, (DWORD) maxevents, gqcs_timeout);
- if (result < 0 || result > 0)
- break; /* Result, error, or time-out. */
- if (timeout < 0)
- continue; /* When timeout is negative, never time out. */
- /* Update time. */
- now = GetTickCount64();
- /* Do not allow the due time to be in the past. */
- if (now >= due) {
- SetLastError(WAIT_TIMEOUT);
- break;
- }
- /* Recompute time-out argument for GetQueuedCompletionStatus. */
- gqcs_timeout = (DWORD)(due - now);
- }
- port__update_events_if_polling(port_state);
- LeaveCriticalSection(&port_state->lock);
- if (iocp_events != stack_iocp_events)
- free(iocp_events);
- if (result >= 0)
- return result;
- else if (GetLastError() == WAIT_TIMEOUT)
- return 0;
- else
- return -1;
- }
- static int port__ctl_add(port_state_t* port_state,
- SOCKET sock,
- struct epoll_event* ev) {
- sock_state_t* sock_state = sock_new(port_state, sock);
- if (sock_state == NULL)
- return -1;
- if (sock_set_event(port_state, sock_state, ev) < 0) {
- sock_delete(port_state, sock_state);
- return -1;
- }
- port__update_events_if_polling(port_state);
- return 0;
- }
- static int port__ctl_mod(port_state_t* port_state,
- SOCKET sock,
- struct epoll_event* ev) {
- sock_state_t* sock_state = port_find_socket(port_state, sock);
- if (sock_state == NULL)
- return -1;
- if (sock_set_event(port_state, sock_state, ev) < 0)
- return -1;
- port__update_events_if_polling(port_state);
- return 0;
- }
- static int port__ctl_del(port_state_t* port_state, SOCKET sock) {
- sock_state_t* sock_state = port_find_socket(port_state, sock);
- if (sock_state == NULL)
- return -1;
- sock_delete(port_state, sock_state);
- return 0;
- }
- static int port__ctl_op(port_state_t* port_state,
- int op,
- SOCKET sock,
- struct epoll_event* ev) {
- switch (op) {
- case EPOLL_CTL_ADD:
- return port__ctl_add(port_state, sock, ev);
- case EPOLL_CTL_MOD:
- return port__ctl_mod(port_state, sock, ev);
- case EPOLL_CTL_DEL:
- return port__ctl_del(port_state, sock);
- default:
- return_set_error(-1, ERROR_INVALID_PARAMETER);
- }
- }
- int port_ctl(port_state_t* port_state,
- int op,
- SOCKET sock,
- struct epoll_event* ev) {
- int result;
- EnterCriticalSection(&port_state->lock);
- result = port__ctl_op(port_state, op, sock, ev);
- LeaveCriticalSection(&port_state->lock);
- return result;
- }
- int port_register_socket_handle(port_state_t* port_state,
- sock_state_t* sock_state,
- SOCKET socket) {
- if (tree_add(&port_state->sock_tree,
- sock_state_to_tree_node(sock_state),
- socket) < 0)
- return_set_error(-1, ERROR_ALREADY_EXISTS);
- return 0;
- }
- void port_unregister_socket_handle(port_state_t* port_state,
- sock_state_t* sock_state) {
- tree_del(&port_state->sock_tree, sock_state_to_tree_node(sock_state));
- }
- sock_state_t* port_find_socket(port_state_t* port_state, SOCKET socket) {
- tree_node_t* tree_node = tree_find(&port_state->sock_tree, socket);
- if (tree_node == NULL)
- return_set_error(NULL, ERROR_NOT_FOUND);
- return sock_state_from_tree_node(tree_node);
- }
- void port_request_socket_update(port_state_t* port_state,
- sock_state_t* sock_state) {
- if (queue_enqueued(sock_state_to_queue_node(sock_state)))
- return;
- queue_append(&port_state->sock_update_queue,
- sock_state_to_queue_node(sock_state));
- }
- void port_cancel_socket_update(port_state_t* port_state,
- sock_state_t* sock_state) {
- unused_var(port_state);
- if (!queue_enqueued(sock_state_to_queue_node(sock_state)))
- return;
- queue_remove(sock_state_to_queue_node(sock_state));
- }
- void port_add_deleted_socket(port_state_t* port_state,
- sock_state_t* sock_state) {
- if (queue_enqueued(sock_state_to_queue_node(sock_state)))
- return;
- queue_append(&port_state->sock_deleted_queue,
- sock_state_to_queue_node(sock_state));
- }
- void port_remove_deleted_socket(port_state_t* port_state,
- sock_state_t* sock_state) {
- unused_var(port_state);
- if (!queue_enqueued(sock_state_to_queue_node(sock_state)))
- return;
- queue_remove(sock_state_to_queue_node(sock_state));
- }
- void queue_init(queue_t* queue) {
- queue_node_init(&queue->head);
- }
- void queue_node_init(queue_node_t* node) {
- node->prev = node;
- node->next = node;
- }
- static inline void queue__detach_node(queue_node_t* node) {
- node->prev->next = node->next;
- node->next->prev = node->prev;
- }
- queue_node_t* queue_first(const queue_t* queue) {
- return !queue_empty(queue) ? queue->head.next : NULL;
- }
- queue_node_t* queue_last(const queue_t* queue) {
- return !queue_empty(queue) ? queue->head.prev : NULL;
- }
- void queue_prepend(queue_t* queue, queue_node_t* node) {
- node->next = queue->head.next;
- node->prev = &queue->head;
- node->next->prev = node;
- queue->head.next = node;
- }
- void queue_append(queue_t* queue, queue_node_t* node) {
- node->next = &queue->head;
- node->prev = queue->head.prev;
- node->prev->next = node;
- queue->head.prev = node;
- }
- void queue_move_first(queue_t* queue, queue_node_t* node) {
- queue__detach_node(node);
- queue_prepend(queue, node);
- }
- void queue_move_last(queue_t* queue, queue_node_t* node) {
- queue__detach_node(node);
- queue_append(queue, node);
- }
- void queue_remove(queue_node_t* node) {
- queue__detach_node(node);
- queue_node_init(node);
- }
- bool queue_empty(const queue_t* queue) {
- return !queue_enqueued(&queue->head);
- }
- bool queue_enqueued(const queue_node_t* node) {
- return node->prev != node;
- }
- /* clang-format off */
- static const long REFLOCK__REF = (long) 0x00000001;
- static const long REFLOCK__REF_MASK = (long) 0x0fffffff;
- static const long REFLOCK__DESTROY = (long) 0x10000000;
- static const long REFLOCK__DESTROY_MASK = (long) 0xf0000000;
- static const long REFLOCK__POISON = (long) 0x300DEAD0;
- /* clang-format on */
- static HANDLE reflock__keyed_event = NULL;
- int reflock_global_init(void) {
- NTSTATUS status =
- NtCreateKeyedEvent(&reflock__keyed_event, ~(ACCESS_MASK) 0, NULL, 0);
- if (status != STATUS_SUCCESS)
- return_set_error(-1, RtlNtStatusToDosError(status));
- return 0;
- }
- void reflock_init(reflock_t* reflock) {
- reflock->state = 0;
- }
- static void reflock__signal_event(void* address) {
- NTSTATUS status =
- NtReleaseKeyedEvent(reflock__keyed_event, address, FALSE, NULL);
- if (status != STATUS_SUCCESS)
- abort();
- }
- static void reflock__await_event(void* address) {
- NTSTATUS status =
- NtWaitForKeyedEvent(reflock__keyed_event, address, FALSE, NULL);
- if (status != STATUS_SUCCESS)
- abort();
- }
- void reflock_ref(reflock_t* reflock) {
- long state = InterlockedAdd(&reflock->state, REFLOCK__REF);
- unused_var(state);
- assert((state & REFLOCK__DESTROY_MASK) == 0); /* Overflow or destroyed. */
- }
- void reflock_unref(reflock_t* reflock) {
- long state = InterlockedAdd(&reflock->state, -REFLOCK__REF);
- long ref_count = state & REFLOCK__REF_MASK;
- long destroy = state & REFLOCK__DESTROY_MASK;
- unused_var(ref_count);
- unused_var(destroy);
- if (state == REFLOCK__DESTROY)
- reflock__signal_event(reflock);
- else
- assert(destroy == 0 || ref_count > 0);
- }
- void reflock_unref_and_destroy(reflock_t* reflock) {
- long state =
- InterlockedAdd(&reflock->state, REFLOCK__DESTROY - REFLOCK__REF);
- long ref_count = state & REFLOCK__REF_MASK;
- assert((state & REFLOCK__DESTROY_MASK) ==
- REFLOCK__DESTROY); /* Underflow or already destroyed. */
- if (ref_count != 0)
- reflock__await_event(reflock);
- state = InterlockedExchange(&reflock->state, REFLOCK__POISON);
- assert(state == REFLOCK__DESTROY);
- }
- static const uint32_t SOCK__KNOWN_EPOLL_EVENTS =
- EPOLLIN | EPOLLPRI | EPOLLOUT | EPOLLERR | EPOLLHUP | EPOLLRDNORM |
- EPOLLRDBAND | EPOLLWRNORM | EPOLLWRBAND | EPOLLMSG | EPOLLRDHUP;
- typedef enum sock__poll_status {
- SOCK__POLL_IDLE = 0,
- SOCK__POLL_PENDING,
- SOCK__POLL_CANCELLED
- } sock__poll_status_t;
- typedef struct sock_state {
- OVERLAPPED overlapped;
- AFD_POLL_INFO poll_info;
- queue_node_t queue_node;
- tree_node_t tree_node;
- poll_group_t* poll_group;
- SOCKET base_socket;
- epoll_data_t user_data;
- uint32_t user_events;
- uint32_t pending_events;
- sock__poll_status_t poll_status;
- bool delete_pending;
- } sock_state_t;
- static inline sock_state_t* sock__alloc(void) {
- sock_state_t* sock_state = malloc(sizeof *sock_state);
- if (sock_state == NULL)
- return_set_error(NULL, ERROR_NOT_ENOUGH_MEMORY);
- return sock_state;
- }
- static inline void sock__free(sock_state_t* sock_state) {
- free(sock_state);
- }
- static int sock__cancel_poll(sock_state_t* sock_state) {
- HANDLE afd_helper_handle =
- poll_group_get_afd_helper_handle(sock_state->poll_group);
- assert(sock_state->poll_status == SOCK__POLL_PENDING);
- /* CancelIoEx() may fail with ERROR_NOT_FOUND if the overlapped operation has
- * already completed. This is not a problem and we proceed normally. */
- if (!HasOverlappedIoCompleted(&sock_state->overlapped) &&
- !CancelIoEx(afd_helper_handle, &sock_state->overlapped) &&
- GetLastError() != ERROR_NOT_FOUND)
- return_map_error(-1);
- sock_state->poll_status = SOCK__POLL_CANCELLED;
- sock_state->pending_events = 0;
- return 0;
- }
- sock_state_t* sock_new(port_state_t* port_state, SOCKET socket) {
- SOCKET base_socket;
- poll_group_t* poll_group;
- sock_state_t* sock_state;
- if (socket == 0 || socket == INVALID_SOCKET)
- return_set_error(NULL, ERROR_INVALID_HANDLE);
- base_socket = ws_get_base_socket(socket);
- if (base_socket == INVALID_SOCKET)
- return NULL;
- poll_group = poll_group_acquire(port_state);
- if (poll_group == NULL)
- return NULL;
- sock_state = sock__alloc();
- if (sock_state == NULL)
- goto err1;
- memset(sock_state, 0, sizeof *sock_state);
- sock_state->base_socket = base_socket;
- sock_state->poll_group = poll_group;
- tree_node_init(&sock_state->tree_node);
- queue_node_init(&sock_state->queue_node);
- if (port_register_socket_handle(port_state, sock_state, socket) < 0)
- goto err2;
- return sock_state;
- err2:
- sock__free(sock_state);
- err1:
- poll_group_release(poll_group);
- return NULL;
- }
- static int sock__delete(port_state_t* port_state,
- sock_state_t* sock_state,
- bool force) {
- if (!sock_state->delete_pending) {
- if (sock_state->poll_status == SOCK__POLL_PENDING)
- sock__cancel_poll(sock_state);
- port_cancel_socket_update(port_state, sock_state);
- port_unregister_socket_handle(port_state, sock_state);
- sock_state->delete_pending = true;
- }
- /* If the poll request still needs to complete, the sock_state object can't
- * be free()d yet. `sock_feed_event()` or `port_close()` will take care
- * of this later. */
- if (force || sock_state->poll_status == SOCK__POLL_IDLE) {
- /* Free the sock_state now. */
- port_remove_deleted_socket(port_state, sock_state);
- poll_group_release(sock_state->poll_group);
- sock__free(sock_state);
- } else {
- /* Free the socket later. */
- port_add_deleted_socket(port_state, sock_state);
- }
- return 0;
- }
- void sock_delete(port_state_t* port_state, sock_state_t* sock_state) {
- sock__delete(port_state, sock_state, false);
- }
- void sock_force_delete(port_state_t* port_state, sock_state_t* sock_state) {
- sock__delete(port_state, sock_state, true);
- }
- int sock_set_event(port_state_t* port_state,
- sock_state_t* sock_state,
- const struct epoll_event* ev) {
- /* EPOLLERR and EPOLLHUP are always reported, even when not requested by the
- * caller. However they are disabled after a event has been reported for a
- * socket for which the EPOLLONESHOT flag as set. */
- uint32_t events = ev->events | EPOLLERR | EPOLLHUP;
- sock_state->user_events = events;
- sock_state->user_data = ev->data;
- if ((events & SOCK__KNOWN_EPOLL_EVENTS & ~sock_state->pending_events) != 0)
- port_request_socket_update(port_state, sock_state);
- return 0;
- }
- static inline DWORD sock__epoll_events_to_afd_events(uint32_t epoll_events) {
- /* Always monitor for AFD_POLL_LOCAL_CLOSE, which is triggered when the
- * socket is closed with closesocket() or CloseHandle(). */
- DWORD afd_events = AFD_POLL_LOCAL_CLOSE;
- if (epoll_events & (EPOLLIN | EPOLLRDNORM))
- afd_events |= AFD_POLL_RECEIVE | AFD_POLL_ACCEPT;
- if (epoll_events & (EPOLLPRI | EPOLLRDBAND))
- afd_events |= AFD_POLL_RECEIVE_EXPEDITED;
- if (epoll_events & (EPOLLOUT | EPOLLWRNORM | EPOLLWRBAND))
- afd_events |= AFD_POLL_SEND;
- if (epoll_events & (EPOLLIN | EPOLLRDNORM | EPOLLRDHUP))
- afd_events |= AFD_POLL_DISCONNECT;
- if (epoll_events & EPOLLHUP)
- afd_events |= AFD_POLL_ABORT;
- if (epoll_events & EPOLLERR)
- afd_events |= AFD_POLL_CONNECT_FAIL;
- return afd_events;
- }
- static inline uint32_t sock__afd_events_to_epoll_events(DWORD afd_events) {
- uint32_t epoll_events = 0;
- if (afd_events & (AFD_POLL_RECEIVE | AFD_POLL_ACCEPT))
- epoll_events |= EPOLLIN | EPOLLRDNORM;
- if (afd_events & AFD_POLL_RECEIVE_EXPEDITED)
- epoll_events |= EPOLLPRI | EPOLLRDBAND;
- if (afd_events & AFD_POLL_SEND)
- epoll_events |= EPOLLOUT | EPOLLWRNORM | EPOLLWRBAND;
- if (afd_events & AFD_POLL_DISCONNECT)
- epoll_events |= EPOLLIN | EPOLLRDNORM | EPOLLRDHUP;
- if (afd_events & AFD_POLL_ABORT)
- epoll_events |= EPOLLHUP;
- if (afd_events & AFD_POLL_CONNECT_FAIL)
- /* Linux reports all these events after connect() has failed. */
- epoll_events |=
- EPOLLIN | EPOLLOUT | EPOLLERR | EPOLLRDNORM | EPOLLWRNORM | EPOLLRDHUP;
- return epoll_events;
- }
- int sock_update(port_state_t* port_state, sock_state_t* sock_state) {
- assert(!sock_state->delete_pending);
- if ((sock_state->poll_status == SOCK__POLL_PENDING) &&
- (sock_state->user_events & SOCK__KNOWN_EPOLL_EVENTS &
- ~sock_state->pending_events) == 0) {
- /* All the events the user is interested in are already being monitored by
- * the pending poll operation. It might spuriously complete because of an
- * event that we're no longer interested in; when that happens we'll submit
- * a new poll operation with the updated event mask. */
- } else if (sock_state->poll_status == SOCK__POLL_PENDING) {
- /* A poll operation is already pending, but it's not monitoring for all the
- * events that the user is interested in. Therefore, cancel the pending
- * poll operation; when we receive it's completion package, a new poll
- * operation will be submitted with the correct event mask. */
- if (sock__cancel_poll(sock_state) < 0)
- return -1;
- } else if (sock_state->poll_status == SOCK__POLL_CANCELLED) {
- /* The poll operation has already been cancelled, we're still waiting for
- * it to return. For now, there's nothing that needs to be done. */
- } else if (sock_state->poll_status == SOCK__POLL_IDLE) {
- /* No poll operation is pending; start one. */
- sock_state->poll_info.Exclusive = FALSE;
- sock_state->poll_info.NumberOfHandles = 1;
- sock_state->poll_info.Timeout.QuadPart = INT64_MAX;
- sock_state->poll_info.Handles[0].Handle = (HANDLE) sock_state->base_socket;
- sock_state->poll_info.Handles[0].Status = 0;
- sock_state->poll_info.Handles[0].Events =
- sock__epoll_events_to_afd_events(sock_state->user_events);
- memset(&sock_state->overlapped, 0, sizeof sock_state->overlapped);
- if (afd_poll(poll_group_get_afd_helper_handle(sock_state->poll_group),
- &sock_state->poll_info,
- &sock_state->overlapped) < 0) {
- switch (GetLastError()) {
- case ERROR_IO_PENDING:
- /* Overlapped poll operation in progress; this is expected. */
- break;
- case ERROR_INVALID_HANDLE:
- /* Socket closed; it'll be dropped from the epoll set. */
- return sock__delete(port_state, sock_state, false);
- default:
- /* Other errors are propagated to the caller. */
- return_map_error(-1);
- }
- }
- /* The poll request was successfully submitted. */
- sock_state->poll_status = SOCK__POLL_PENDING;
- sock_state->pending_events = sock_state->user_events;
- } else {
- /* Unreachable. */
- assert(false);
- }
- port_cancel_socket_update(port_state, sock_state);
- return 0;
- }
- int sock_feed_event(port_state_t* port_state,
- OVERLAPPED* overlapped,
- struct epoll_event* ev) {
- sock_state_t* sock_state =
- container_of(overlapped, sock_state_t, overlapped);
- AFD_POLL_INFO* poll_info = &sock_state->poll_info;
- uint32_t epoll_events = 0;
- sock_state->poll_status = SOCK__POLL_IDLE;
- sock_state->pending_events = 0;
- if (sock_state->delete_pending) {
- /* Socket has been deleted earlier and can now be freed. */
- return sock__delete(port_state, sock_state, false);
- } else if ((NTSTATUS) overlapped->Internal == STATUS_CANCELLED) {
- /* The poll request was cancelled by CancelIoEx. */
- } else if (!NT_SUCCESS(overlapped->Internal)) {
- /* The overlapped request itself failed in an unexpected way. */
- epoll_events = EPOLLERR;
- } else if (poll_info->NumberOfHandles < 1) {
- /* This poll operation succeeded but didn't report any socket events. */
- } else if (poll_info->Handles[0].Events & AFD_POLL_LOCAL_CLOSE) {
- /* The poll operation reported that the socket was closed. */
- return sock__delete(port_state, sock_state, false);
- } else {
- /* Events related to our socket were reported. */
- epoll_events =
- sock__afd_events_to_epoll_events(poll_info->Handles[0].Events);
- }
- /* Requeue the socket so a new poll request will be submitted. */
- port_request_socket_update(port_state, sock_state);
- /* Filter out events that the user didn't ask for. */
- epoll_events &= sock_state->user_events;
- /* Return if there are no epoll events to report. */
- if (epoll_events == 0)
- return 0;
- /* If the the socket has the EPOLLONESHOT flag set, unmonitor all events,
- * even EPOLLERR and EPOLLHUP. But always keep looking for closed sockets. */
- if (sock_state->user_events & EPOLLONESHOT)
- sock_state->user_events = 0;
- ev->data = sock_state->user_data;
- ev->events = epoll_events;
- return 1;
- }
- queue_node_t* sock_state_to_queue_node(sock_state_t* sock_state) {
- return &sock_state->queue_node;
- }
- sock_state_t* sock_state_from_tree_node(tree_node_t* tree_node) {
- return container_of(tree_node, sock_state_t, tree_node);
- }
- tree_node_t* sock_state_to_tree_node(sock_state_t* sock_state) {
- return &sock_state->tree_node;
- }
- sock_state_t* sock_state_from_queue_node(queue_node_t* queue_node) {
- return container_of(queue_node, sock_state_t, queue_node);
- }
- void ts_tree_init(ts_tree_t* ts_tree) {
- tree_init(&ts_tree->tree);
- InitializeSRWLock(&ts_tree->lock);
- }
- void ts_tree_node_init(ts_tree_node_t* node) {
- tree_node_init(&node->tree_node);
- reflock_init(&node->reflock);
- }
- int ts_tree_add(ts_tree_t* ts_tree, ts_tree_node_t* node, uintptr_t key) {
- int r;
- AcquireSRWLockExclusive(&ts_tree->lock);
- r = tree_add(&ts_tree->tree, &node->tree_node, key);
- ReleaseSRWLockExclusive(&ts_tree->lock);
- return r;
- }
- static inline ts_tree_node_t* ts_tree__find_node(ts_tree_t* ts_tree,
- uintptr_t key) {
- tree_node_t* tree_node = tree_find(&ts_tree->tree, key);
- if (tree_node == NULL)
- return NULL;
- return container_of(tree_node, ts_tree_node_t, tree_node);
- }
- ts_tree_node_t* ts_tree_del_and_ref(ts_tree_t* ts_tree, uintptr_t key) {
- ts_tree_node_t* ts_tree_node;
- AcquireSRWLockExclusive(&ts_tree->lock);
- ts_tree_node = ts_tree__find_node(ts_tree, key);
- if (ts_tree_node != NULL) {
- tree_del(&ts_tree->tree, &ts_tree_node->tree_node);
- reflock_ref(&ts_tree_node->reflock);
- }
- ReleaseSRWLockExclusive(&ts_tree->lock);
- return ts_tree_node;
- }
- ts_tree_node_t* ts_tree_find_and_ref(ts_tree_t* ts_tree, uintptr_t key) {
- ts_tree_node_t* ts_tree_node;
- AcquireSRWLockShared(&ts_tree->lock);
- ts_tree_node = ts_tree__find_node(ts_tree, key);
- if (ts_tree_node != NULL)
- reflock_ref(&ts_tree_node->reflock);
- ReleaseSRWLockShared(&ts_tree->lock);
- return ts_tree_node;
- }
- void ts_tree_node_unref(ts_tree_node_t* node) {
- reflock_unref(&node->reflock);
- }
- void ts_tree_node_unref_and_destroy(ts_tree_node_t* node) {
- reflock_unref_and_destroy(&node->reflock);
- }
- void tree_init(tree_t* tree) {
- memset(tree, 0, sizeof *tree);
- }
- void tree_node_init(tree_node_t* node) {
- memset(node, 0, sizeof *node);
- }
- #define TREE__ROTATE(cis, trans) \
- tree_node_t* p = node; \
- tree_node_t* q = node->trans; \
- tree_node_t* parent = p->parent; \
- \
- if (parent) { \
- if (parent->left == p) \
- parent->left = q; \
- else \
- parent->right = q; \
- } else { \
- tree->root = q; \
- } \
- \
- q->parent = parent; \
- p->parent = q; \
- p->trans = q->cis; \
- if (p->trans) \
- p->trans->parent = p; \
- q->cis = p;
- static inline void tree__rotate_left(tree_t* tree, tree_node_t* node) {
- TREE__ROTATE(left, right)
- }
- static inline void tree__rotate_right(tree_t* tree, tree_node_t* node) {
- TREE__ROTATE(right, left)
- }
- #define TREE__INSERT_OR_DESCEND(side) \
- if (parent->side) { \
- parent = parent->side; \
- } else { \
- parent->side = node; \
- break; \
- }
- #define TREE__FIXUP_AFTER_INSERT(cis, trans) \
- tree_node_t* grandparent = parent->parent; \
- tree_node_t* uncle = grandparent->trans; \
- \
- if (uncle && uncle->red) { \
- parent->red = uncle->red = false; \
- grandparent->red = true; \
- node = grandparent; \
- } else { \
- if (node == parent->trans) { \
- tree__rotate_##cis(tree, parent); \
- node = parent; \
- parent = node->parent; \
- } \
- parent->red = false; \
- grandparent->red = true; \
- tree__rotate_##trans(tree, grandparent); \
- }
- int tree_add(tree_t* tree, tree_node_t* node, uintptr_t key) {
- tree_node_t* parent;
- parent = tree->root;
- if (parent) {
- for (;;) {
- if (key < parent->key) {
- TREE__INSERT_OR_DESCEND(left)
- } else if (key > parent->key) {
- TREE__INSERT_OR_DESCEND(right)
- } else {
- return -1;
- }
- }
- } else {
- tree->root = node;
- }
- node->key = key;
- node->left = node->right = NULL;
- node->parent = parent;
- node->red = true;
- for (; parent && parent->red; parent = node->parent) {
- if (parent == parent->parent->left) {
- TREE__FIXUP_AFTER_INSERT(left, right)
- } else {
- TREE__FIXUP_AFTER_INSERT(right, left)
- }
- }
- tree->root->red = false;
- return 0;
- }
- #define TREE__FIXUP_AFTER_REMOVE(cis, trans) \
- tree_node_t* sibling = parent->trans; \
- \
- if (sibling->red) { \
- sibling->red = false; \
- parent->red = true; \
- tree__rotate_##cis(tree, parent); \
- sibling = parent->trans; \
- } \
- if ((sibling->left && sibling->left->red) || \
- (sibling->right && sibling->right->red)) { \
- if (!sibling->trans || !sibling->trans->red) { \
- sibling->cis->red = false; \
- sibling->red = true; \
- tree__rotate_##trans(tree, sibling); \
- sibling = parent->trans; \
- } \
- sibling->red = parent->red; \
- parent->red = sibling->trans->red = false; \
- tree__rotate_##cis(tree, parent); \
- node = tree->root; \
- break; \
- } \
- sibling->red = true;
- void tree_del(tree_t* tree, tree_node_t* node) {
- tree_node_t* parent = node->parent;
- tree_node_t* left = node->left;
- tree_node_t* right = node->right;
- tree_node_t* next;
- bool red;
- if (!left) {
- next = right;
- } else if (!right) {
- next = left;
- } else {
- next = right;
- while (next->left)
- next = next->left;
- }
- if (parent) {
- if (parent->left == node)
- parent->left = next;
- else
- parent->right = next;
- } else {
- tree->root = next;
- }
- if (left && right) {
- red = next->red;
- next->red = node->red;
- next->left = left;
- left->parent = next;
- if (next != right) {
- parent = next->parent;
- next->parent = node->parent;
- node = next->right;
- parent->left = node;
- next->right = right;
- right->parent = next;
- } else {
- next->parent = parent;
- parent = next;
- node = next->right;
- }
- } else {
- red = node->red;
- node = next;
- }
- if (node)
- node->parent = parent;
- if (red)
- return;
- if (node && node->red) {
- node->red = false;
- return;
- }
- do {
- if (node == tree->root)
- break;
- if (node == parent->left) {
- TREE__FIXUP_AFTER_REMOVE(left, right)
- } else {
- TREE__FIXUP_AFTER_REMOVE(right, left)
- }
- node = parent;
- parent = parent->parent;
- } while (!node->red);
- if (node)
- node->red = false;
- }
- tree_node_t* tree_find(const tree_t* tree, uintptr_t key) {
- tree_node_t* node = tree->root;
- while (node) {
- if (key < node->key)
- node = node->left;
- else if (key > node->key)
- node = node->right;
- else
- return node;
- }
- return NULL;
- }
- tree_node_t* tree_root(const tree_t* tree) {
- return tree->root;
- }
- #ifndef SIO_BASE_HANDLE
- #define SIO_BASE_HANDLE 0x48000022
- #endif
- int ws_global_init(void) {
- int r;
- WSADATA wsa_data;
- r = WSAStartup(MAKEWORD(2, 2), &wsa_data);
- if (r != 0)
- return_set_error(-1, (DWORD) r);
- return 0;
- }
- SOCKET ws_get_base_socket(SOCKET socket) {
- SOCKET base_socket;
- DWORD bytes;
- if (WSAIoctl(socket,
- SIO_BASE_HANDLE,
- NULL,
- 0,
- &base_socket,
- sizeof base_socket,
- &bytes,
- NULL,
- NULL) == SOCKET_ERROR)
- return_map_error(INVALID_SOCKET);
- return base_socket;
- }
|