Something went wrong. Try again.
Reactos
Something went wrong. Try again.
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513/* * PROJECT: ReactOS System Libraries * LICENSE: GPL-2.0+ (https://spdx.org/licenses/GPL-2.0+) * PURPOSE: Fiber Implementation * COPYRIGHT: Copyright 2005-2011 Alex Ionescu (alex@relsoft.net) * Copyright 2003-2008 KJK::Hyperion (noog@libero.it) * Copyright 2018 Mark Jansen (mark.jansen@reactos.org) */
#include <k32.h>#include <ndk/rtltypes.h>
#define NDEBUG#include <debug.h>
#ifdef _M_IX86C_ASSERT(FIELD_OFFSET(FIBER, ExceptionList) == 0x04);C_ASSERT(FIELD_OFFSET(FIBER, StackBase) == 0x08);C_ASSERT(FIELD_OFFSET(FIBER, StackLimit) == 0x0C);C_ASSERT(FIELD_OFFSET(FIBER, DeallocationStack) == 0x10);C_ASSERT(FIELD_OFFSET(FIBER, FiberContext) == 0x14);C_ASSERT(FIELD_OFFSET(FIBER, GuaranteedStackBytes) == 0x2E0);C_ASSERT(FIELD_OFFSET(FIBER, FlsData) == 0x2E4);C_ASSERT(FIELD_OFFSET(FIBER, ActivationContextStackPointer) == 0x2E8);C_ASSERT(RTL_FLS_MAXIMUM_AVAILABLE == FLS_MAXIMUM_AVAILABLE);#endif // _M_IX86
/* PRIVATE FUNCTIONS **********************************************************/
VOIDWINAPIBaseRundownFls(_In_ PVOID FlsData){ ULONG n, FlsHighIndex; PRTL_FLS_DATA pFlsData; PFLS_CALLBACK_FUNCTION lpCallback;
pFlsData = FlsData;
RtlAcquirePebLock(); FlsHighIndex = NtCurrentPeb()->FlsHighIndex; RemoveEntryList(&pFlsData->ListEntry); RtlReleasePebLock();
for (n = 1; n <= FlsHighIndex; ++n) { lpCallback = NtCurrentPeb()->FlsCallback[n]; if (lpCallback && pFlsData->Data[n]) { lpCallback(pFlsData->Data[n]); } }
RtlFreeHeap(RtlGetProcessHeap(), 0, FlsData);}
/* PUBLIC FUNCTIONS ***********************************************************/
/* * @implemented */BOOLWINAPIConvertFiberToThread(VOID){ PTEB Teb; PFIBER FiberData; DPRINT1("Converting Fiber to Thread\n");
/* Check if the thread is already not a fiber */ Teb = NtCurrentTeb(); if (!Teb->HasFiberData) { /* Fail */ SetLastError(ERROR_ALREADY_THREAD); return FALSE; }
/* This thread won't run a fiber anymore */ Teb->HasFiberData = FALSE; FiberData = Teb->NtTib.FiberData; Teb->NtTib.FiberData = NULL;
/* Free the fiber */ ASSERT(FiberData != NULL); RtlFreeHeap(RtlGetProcessHeap(), 0, FiberData);
/* Success */ return TRUE;}
/* * @implemented */LPVOIDWINAPIConvertThreadToFiberEx(_In_opt_ LPVOID lpParameter, _In_ DWORD dwFlags){ PTEB Teb; PFIBER Fiber; DPRINT1("Converting Thread to Fiber\n");
/* Check for invalid flags */ if (dwFlags & ~FIBER_FLAG_FLOAT_SWITCH) { /* Fail */ SetLastError(ERROR_INVALID_PARAMETER); return NULL; }
/* Are we already a fiber? */ Teb = NtCurrentTeb(); if (Teb->HasFiberData) { /* Fail */ SetLastError(ERROR_ALREADY_FIBER); return NULL; }
/* Allocate the fiber */ Fiber = RtlAllocateHeap(RtlGetProcessHeap(), 0, sizeof(FIBER)); if (!Fiber) { /* Fail */ SetLastError(ERROR_NOT_ENOUGH_MEMORY); return NULL; }
/* Copy some contextual data from the thread to the fiber */ Fiber->FiberData = lpParameter; Fiber->ExceptionList = Teb->NtTib.ExceptionList; Fiber->StackBase = Teb->NtTib.StackBase; Fiber->StackLimit = Teb->NtTib.StackLimit; Fiber->DeallocationStack = Teb->DeallocationStack; Fiber->FlsData = Teb->FlsData; Fiber->GuaranteedStackBytes = Teb->GuaranteedStackBytes; Fiber->ActivationContextStackPointer = Teb->ActivationContextStackPointer;
/* Save FPU State if requested, otherwise just the basic registers */ Fiber->FiberContext.ContextFlags = (dwFlags & FIBER_FLAG_FLOAT_SWITCH) ? (CONTEXT_FULL | CONTEXT_FLOATING_POINT) : CONTEXT_FULL;
/* Associate the fiber to the current thread */ Teb->NtTib.FiberData = Fiber; Teb->HasFiberData = TRUE;
/* Return opaque fiber data */ return (LPVOID)Fiber;}
/* * @implemented */LPVOIDWINAPIConvertThreadToFiber(_In_opt_ LPVOID lpParameter){ /* Call the newer function */ return ConvertThreadToFiberEx(lpParameter, 0);}
/* * @implemented */LPVOIDWINAPICreateFiber(_In_ SIZE_T dwStackSize, _In_ LPFIBER_START_ROUTINE lpStartAddress, _In_opt_ LPVOID lpParameter){ /* Call the Newer Function */ return CreateFiberEx(dwStackSize, 0, 0, lpStartAddress, lpParameter);}
/* * @implemented */LPVOIDWINAPICreateFiberEx(_In_ SIZE_T dwStackCommitSize, _In_ SIZE_T dwStackReserveSize, _In_ DWORD dwFlags, _In_ LPFIBER_START_ROUTINE lpStartAddress, _In_opt_ LPVOID lpParameter){ PFIBER Fiber; NTSTATUS Status; INITIAL_TEB InitialTeb; PACTIVATION_CONTEXT_STACK ActivationContextStackPointer; DPRINT("Creating Fiber\n");
/* Check for invalid flags */ if (dwFlags & ~FIBER_FLAG_FLOAT_SWITCH) { /* Fail */ SetLastError(ERROR_INVALID_PARAMETER); return NULL; }
/* Allocate the Activation Context Stack */ ActivationContextStackPointer = NULL; Status = RtlAllocateActivationContextStack(&ActivationContextStackPointer); if (!NT_SUCCESS(Status)) { /* Fail */ BaseSetLastNTError(Status); return NULL; }
/* Allocate the fiber */ Fiber = RtlAllocateHeap(RtlGetProcessHeap(), 0, sizeof(FIBER)); if (!Fiber) { /* Free the activation context stack */ RtlFreeActivationContextStack(ActivationContextStackPointer);
/* Fail */ SetLastError(ERROR_NOT_ENOUGH_MEMORY); return NULL; }
/* Create the stack for the fiber */ Status = BaseCreateStack(NtCurrentProcess(), dwStackCommitSize, dwStackReserveSize, &InitialTeb); if (!NT_SUCCESS(Status)) { /* Free the fiber */ RtlFreeHeap(GetProcessHeap(), 0, Fiber);
/* Free the activation context stack */ RtlFreeActivationContextStack(ActivationContextStackPointer);
/* Failure */ BaseSetLastNTError(Status); return NULL; }
/* Clear the context */ RtlZeroMemory(&Fiber->FiberContext, sizeof(CONTEXT));
/* Copy the data into the fiber */ Fiber->StackBase = InitialTeb.StackBase; Fiber->StackLimit = InitialTeb.StackLimit; Fiber->DeallocationStack = InitialTeb.AllocatedStackBase; Fiber->FiberData = lpParameter; Fiber->ExceptionList = EXCEPTION_CHAIN_END; Fiber->GuaranteedStackBytes = 0; Fiber->FlsData = NULL; Fiber->ActivationContextStackPointer = ActivationContextStackPointer;
/* Save FPU State if requested, otherwise just the basic registers */ Fiber->FiberContext.ContextFlags = (dwFlags & FIBER_FLAG_FLOAT_SWITCH) ? (CONTEXT_FULL | CONTEXT_FLOATING_POINT) : CONTEXT_FULL;
/* Initialize the context for the fiber */ BaseInitializeContext(&Fiber->FiberContext, lpParameter, lpStartAddress, InitialTeb.StackBase, 2);
/* Return the Fiber */ return Fiber;}
/* * @implemented */VOIDWINAPIDeleteFiber(_In_ LPVOID lpFiber){ SIZE_T Size; PFIBER Fiber; PTEB Teb;
/* Are we deleting ourselves? */ Teb = NtCurrentTeb(); Fiber = (PFIBER)lpFiber; if ((Teb->HasFiberData) && (Teb->NtTib.FiberData == Fiber)) { /* Just exit */ ExitThread(1); }
/* Not ourselves, de-allocate the stack */ Size = 0 ; NtFreeVirtualMemory(NtCurrentProcess(), &Fiber->DeallocationStack, &Size, MEM_RELEASE);
/* Get rid of FLS */ if (Fiber->FlsData) BaseRundownFls(Fiber->FlsData);
/* Get rid of the activation context stack */ RtlFreeActivationContextStack(Fiber->ActivationContextStackPointer);
/* Free the fiber data */ RtlFreeHeap(RtlGetProcessHeap(), 0, lpFiber);}
/* * @implemented */BOOLWINAPIIsThreadAFiber(VOID){ /* Return flag in the TEB */ return NtCurrentTeb()->HasFiberData;}
/* * @implemented */DWORDWINAPIFlsAlloc(PFLS_CALLBACK_FUNCTION lpCallback){ DWORD dwFlsIndex; PPEB Peb = NtCurrentPeb(); PRTL_FLS_DATA pFlsData;
RtlAcquirePebLock();
pFlsData = NtCurrentTeb()->FlsData;
if (!Peb->FlsCallback && !(Peb->FlsCallback = RtlAllocateHeap(RtlGetProcessHeap(), HEAP_ZERO_MEMORY, FLS_MAXIMUM_AVAILABLE * sizeof(PVOID)))) { SetLastError(ERROR_NOT_ENOUGH_MEMORY); dwFlsIndex = FLS_OUT_OF_INDEXES; } else { dwFlsIndex = RtlFindClearBitsAndSet(Peb->FlsBitmap, 1, 1); if (dwFlsIndex != FLS_OUT_OF_INDEXES) { if (!pFlsData && !(pFlsData = RtlAllocateHeap(RtlGetProcessHeap(), HEAP_ZERO_MEMORY, sizeof(RTL_FLS_DATA)))) { RtlClearBits(Peb->FlsBitmap, dwFlsIndex, 1); dwFlsIndex = FLS_OUT_OF_INDEXES; SetLastError(ERROR_NOT_ENOUGH_MEMORY); } else { if (!NtCurrentTeb()->FlsData) { NtCurrentTeb()->FlsData = pFlsData; InsertTailList(&Peb->FlsListHead, &pFlsData->ListEntry); }
pFlsData->Data[dwFlsIndex] = NULL; /* clear the value */ Peb->FlsCallback[dwFlsIndex] = lpCallback;
if (dwFlsIndex > Peb->FlsHighIndex) Peb->FlsHighIndex = dwFlsIndex; } } else { SetLastError(ERROR_NO_MORE_ITEMS); } } RtlReleasePebLock(); return dwFlsIndex;}
/* * @implemented */BOOLWINAPIFlsFree(DWORD dwFlsIndex){ BOOL ret; PPEB Peb = NtCurrentPeb();
if (dwFlsIndex >= FLS_MAXIMUM_AVAILABLE) { SetLastError(ERROR_INVALID_PARAMETER); return FALSE; }
RtlAcquirePebLock();
_SEH2_TRY { ret = RtlAreBitsSet(Peb->FlsBitmap, dwFlsIndex, 1); if (ret) { PLIST_ENTRY Entry; PFLS_CALLBACK_FUNCTION lpCallback;
RtlClearBits(Peb->FlsBitmap, dwFlsIndex, 1); lpCallback = Peb->FlsCallback[dwFlsIndex];
for (Entry = Peb->FlsListHead.Flink; Entry != &Peb->FlsListHead; Entry = Entry->Flink) { PRTL_FLS_DATA pFlsData;
pFlsData = CONTAINING_RECORD(Entry, RTL_FLS_DATA, ListEntry); if (pFlsData->Data[dwFlsIndex]) { if (lpCallback) { lpCallback(pFlsData->Data[dwFlsIndex]); } pFlsData->Data[dwFlsIndex] = NULL; } } Peb->FlsCallback[dwFlsIndex] = NULL; } else { SetLastError(ERROR_INVALID_PARAMETER); } } _SEH2_FINALLY { RtlReleasePebLock(); } _SEH2_END;
return ret;}
/* * @implemented */PVOIDWINAPIFlsGetValue(DWORD dwFlsIndex){ PRTL_FLS_DATA pFlsData;
pFlsData = NtCurrentTeb()->FlsData; if (!dwFlsIndex || dwFlsIndex >= FLS_MAXIMUM_AVAILABLE || !pFlsData) { SetLastError(ERROR_INVALID_PARAMETER); return NULL; }
SetLastError(ERROR_SUCCESS); return pFlsData->Data[dwFlsIndex];}
/* * @implemented */BOOLWINAPIFlsSetValue(DWORD dwFlsIndex, PVOID lpFlsData){ PRTL_FLS_DATA pFlsData;
if (!dwFlsIndex || dwFlsIndex >= FLS_MAXIMUM_AVAILABLE) { SetLastError(ERROR_INVALID_PARAMETER); return FALSE; }
pFlsData = NtCurrentTeb()->FlsData;
if (!NtCurrentTeb()->FlsData && !(NtCurrentTeb()->FlsData = RtlAllocateHeap(RtlGetProcessHeap(), HEAP_ZERO_MEMORY, sizeof(RTL_FLS_DATA)))) { SetLastError(ERROR_NOT_ENOUGH_MEMORY); return FALSE; } if (!pFlsData) { pFlsData = NtCurrentTeb()->FlsData; RtlAcquirePebLock(); InsertTailList(&NtCurrentPeb()->FlsListHead, &pFlsData->ListEntry); RtlReleasePebLock(); } pFlsData->Data[dwFlsIndex] = lpFlsData; return TRUE;}
/* EOF */