1f25ce65dSSergey Makeev // The MIT License (MIT) 2f25ce65dSSergey Makeev // 3f25ce65dSSergey Makeev // Copyright (c) 2015 Sergey Makeev, Vadim Slyusarev 4f25ce65dSSergey Makeev // 5f25ce65dSSergey Makeev // Permission is hereby granted, free of charge, to any person obtaining a copy 6f25ce65dSSergey Makeev // of this software and associated documentation files (the "Software"), to deal 7f25ce65dSSergey Makeev // in the Software without restriction, including without limitation the rights 8f25ce65dSSergey Makeev // to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 9f25ce65dSSergey Makeev // copies of the Software, and to permit persons to whom the Software is 10f25ce65dSSergey Makeev // furnished to do so, subject to the following conditions: 11f25ce65dSSergey Makeev // 12f25ce65dSSergey Makeev // The above copyright notice and this permission notice shall be included in 13f25ce65dSSergey Makeev // all copies or substantial portions of the Software. 14f25ce65dSSergey Makeev // 15f25ce65dSSergey Makeev // THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 16f25ce65dSSergey Makeev // IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 17f25ce65dSSergey Makeev // FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE 18f25ce65dSSergey Makeev // AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 19f25ce65dSSergey Makeev // LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 20f25ce65dSSergey Makeev // OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 21f25ce65dSSergey Makeev // THE SOFTWARE. 22f25ce65dSSergey Makeev 2358964d0bSSergey Makeev #include <MTScheduler.h> 24c73d1551SSergey Makeev #include <string.h> // for memset 2558964d0bSSergey Makeev 2658964d0bSSergey Makeev namespace MT 2758964d0bSSergey Makeev { 2858964d0bSSergey Makeev 290727c1f9SSergey Makeev #ifdef MT_INSTRUMENTED_BUILD 30*b23bdf5aSs.makeev_local TaskScheduler::TaskScheduler(uint32 workerThreadsCount, WorkerThreadParams* workerParameters, IProfilerEventListener* listener, TaskStealingMode::Type stealMode) 310727c1f9SSergey Makeev #else 32*b23bdf5aSs.makeev_local TaskScheduler::TaskScheduler(uint32 workerThreadsCount, WorkerThreadParams* workerParameters, TaskStealingMode::Type stealMode) 330727c1f9SSergey Makeev #endif 3458964d0bSSergey Makeev : roundRobinThreadIndex(0) 3543c41d5cSSergey Makeev , startedThreadsCount(0) 36*b23bdf5aSs.makeev_local , taskStealingDisabled(stealMode == TaskStealingMode::DISABLED) 3758964d0bSSergey Makeev { 3851901c6bSSergey Makeev 39ff5c86b0SSergey Makeev #ifdef MT_INSTRUMENTED_BUILD 400727c1f9SSergey Makeev profilerEventListener = listener; 41ff5c86b0SSergey Makeev #endif 42ff5c86b0SSergey Makeev 4334a394c3SSergey Makeev if (workerThreadsCount != 0) 4434a394c3SSergey Makeev { 45a23fd933SSergey Makeev threadsCount.StoreRelaxed( MT::Clamp(workerThreadsCount, (uint32)1, (uint32)MT_MAX_THREAD_COUNT) ); 4634a394c3SSergey Makeev } else 4734a394c3SSergey Makeev { 4834a394c3SSergey Makeev //query number of processor 49d7cf17b1Ss.makeev_local threadsCount.StoreRelaxed( (uint32)MT::Clamp(Thread::GetNumberOfHardwareThreads() - 1, 1, (int)MT_MAX_THREAD_COUNT) ); 5034a394c3SSergey Makeev } 5134a394c3SSergey Makeev 52f4db079dSs.makeev // create fiber pool (fibers with standard stack size) 53f4db079dSs.makeev for (uint32 i = 0; i < MT_MAX_STANDART_FIBERS_COUNT; i++) 5458964d0bSSergey Makeev { 55f4db079dSs.makeev FiberContext& context = standartFiberContexts[i]; 56f4db079dSs.makeev context.fiber.Create(MT_STANDART_FIBER_STACK_SIZE, FiberMain, &context); 5760ac17fbSs.makeev_local bool res = standartFibersAvailable.TryPush( &context ); 5860ac17fbSs.makeev_local MT_USED_IN_ASSERT(res); 5960ac17fbSs.makeev_local MT_ASSERT(res == true, "Can't add fiber to storage"); 6058964d0bSSergey Makeev } 6158964d0bSSergey Makeev 62f4db079dSs.makeev // create fiber pool (fibers with extended stack size) 63f4db079dSs.makeev for (uint32 i = 0; i < MT_MAX_EXTENDED_FIBERS_COUNT; i++) 64f4db079dSs.makeev { 65f4db079dSs.makeev FiberContext& context = extendedFiberContexts[i]; 66f4db079dSs.makeev context.fiber.Create(MT_EXTENDED_FIBER_STACK_SIZE, FiberMain, &context); 6760ac17fbSs.makeev_local bool res = extendedFibersAvailable.TryPush( &context ); 6860ac17fbSs.makeev_local MT_USED_IN_ASSERT(res); 6960ac17fbSs.makeev_local MT_ASSERT(res == true, "Can't add fiber to storage"); 70f4db079dSs.makeev } 71f4db079dSs.makeev 72f4db079dSs.makeev 732e846c40SSergey Makeev for (int16 i = 0; i < TaskGroup::MT_MAX_GROUPS_COUNT; i++) 74806ef292SSergey Makeev { 75754cb997SSergey Makeev if (i != TaskGroup::DEFAULT) 76806ef292SSergey Makeev { 7760ac17fbSs.makeev_local bool res = availableGroups.TryPush( TaskGroup(i) ); 7860ac17fbSs.makeev_local MT_USED_IN_ASSERT(res); 7960ac17fbSs.makeev_local MT_ASSERT(res == true, "Can't add group to storage"); 80806ef292SSergey Makeev } 81806ef292SSergey Makeev } 82806ef292SSergey Makeev 839d94a278Ss.makeev_local #if MT_GROUP_DEBUG 842e846c40SSergey Makeev groupStats[TaskGroup::DEFAULT].SetDebugIsFree(false); 859d94a278Ss.makeev_local #endif 86806ef292SSergey Makeev 8758964d0bSSergey Makeev // create worker thread pool 88a23fd933SSergey Makeev int32 totalThreadsCount = GetWorkersCount(); 89a23fd933SSergey Makeev for (int32 i = 0; i < totalThreadsCount; i++) 9058964d0bSSergey Makeev { 912b4df162SSergey Makeev threadContext[i].SetThreadIndex(i); 9258964d0bSSergey Makeev threadContext[i].taskScheduler = this; 93d7cf17b1Ss.makeev_local 94d7cf17b1Ss.makeev_local uint32 threadCore = i; 95d7cf17b1Ss.makeev_local ThreadPriority::Type priority = ThreadPriority::DEFAULT; 96d7cf17b1Ss.makeev_local if (workerParameters != nullptr) 97d7cf17b1Ss.makeev_local { 98d7cf17b1Ss.makeev_local const WorkerThreadParams& params = workerParameters[i]; 99d7cf17b1Ss.makeev_local 100d7cf17b1Ss.makeev_local threadCore = params.core; 101d7cf17b1Ss.makeev_local priority = params.priority; 102d7cf17b1Ss.makeev_local } 103d7cf17b1Ss.makeev_local 104d7cf17b1Ss.makeev_local threadContext[i].thread.Start( MT_SCHEDULER_STACK_SIZE, WorkerThreadMain, &threadContext[i], threadCore, priority); 10558964d0bSSergey Makeev } 10658964d0bSSergey Makeev } 10758964d0bSSergey Makeev 108d7cf17b1Ss.makeev_local 10958964d0bSSergey Makeev TaskScheduler::~TaskScheduler() 11058964d0bSSergey Makeev { 111a23fd933SSergey Makeev int32 totalThreadsCount = GetWorkersCount(); 112a23fd933SSergey Makeev for (int32 i = 0; i < totalThreadsCount; i++) 11358964d0bSSergey Makeev { 11481ec7369SSergey Makeev threadContext[i].state.Store(internal::ThreadState::EXIT); 11558964d0bSSergey Makeev threadContext[i].hasNewTasksEvent.Signal(); 11658964d0bSSergey Makeev } 11758964d0bSSergey Makeev 118a23fd933SSergey Makeev for (int32 i = 0; i < totalThreadsCount; i++) 11958964d0bSSergey Makeev { 120c7362320Ss.makeev_local threadContext[i].thread.Join(); 12158964d0bSSergey Makeev } 12258964d0bSSergey Makeev } 12358964d0bSSergey Makeev 1244965e494Ss.makeev_local FiberContext* TaskScheduler::RequestFiberContext(internal::GroupedTask& task) 125f4db079dSs.makeev { 1264965e494Ss.makeev_local FiberContext *fiberContext = task.awaitingFiber; 1274965e494Ss.makeev_local if (fiberContext) 1284965e494Ss.makeev_local { 1294965e494Ss.makeev_local task.awaitingFiber = nullptr; 1304965e494Ss.makeev_local return fiberContext; 1314965e494Ss.makeev_local } 13260ac17fbSs.makeev_local 1334965e494Ss.makeev_local MT::StackRequirements::Type stackRequirements = task.desc.stackRequirements; 1344965e494Ss.makeev_local 1354965e494Ss.makeev_local fiberContext = nullptr; 13660ac17fbSs.makeev_local bool res = false; 13760ac17fbSs.makeev_local MT_USED_IN_ASSERT(res); 138f4db079dSs.makeev switch(stackRequirements) 139f4db079dSs.makeev { 140f4db079dSs.makeev case MT::StackRequirements::STANDARD: 14160ac17fbSs.makeev_local res = standartFibersAvailable.TryPop(fiberContext); 14260ac17fbSs.makeev_local MT_ASSERT(res, "Can't get more standard fibers!"); 143f4db079dSs.makeev break; 144f4db079dSs.makeev case MT::StackRequirements::EXTENDED: 14560ac17fbSs.makeev_local res = extendedFibersAvailable.TryPop(fiberContext); 14660ac17fbSs.makeev_local MT_ASSERT(res, "Can't get more extended fibers!"); 147f4db079dSs.makeev break; 148f4db079dSs.makeev default: 149f4db079dSs.makeev MT_REPORT_ASSERT("Unknown stack requrements"); 150f4db079dSs.makeev } 151f4db079dSs.makeev 15260ac17fbSs.makeev_local MT_ASSERT(fiberContext != nullptr, "Can't get more fibers. Too many tasks in flight simultaneously?"); 15358964d0bSSergey Makeev 15458964d0bSSergey Makeev fiberContext->currentTask = task.desc; 15558964d0bSSergey Makeev fiberContext->currentGroup = task.group; 15658964d0bSSergey Makeev fiberContext->parentFiber = task.parentFiber; 157f4db079dSs.makeev fiberContext->stackRequirements = stackRequirements; 15858964d0bSSergey Makeev return fiberContext; 15958964d0bSSergey Makeev } 16058964d0bSSergey Makeev 16160ac17fbSs.makeev_local void TaskScheduler::ReleaseFiberContext(FiberContext*&& fiberContext) 16258964d0bSSergey Makeev { 163721f8c0bSs.makeev_local MT_ASSERT(fiberContext, "Can't release nullptr Fiber. fiberContext is nullptr"); 164f4db079dSs.makeev 165f4db079dSs.makeev MT::StackRequirements::Type stackRequirements = fiberContext->stackRequirements; 16658964d0bSSergey Makeev fiberContext->Reset(); 167f4db079dSs.makeev 1684965e494Ss.makeev_local MT_ASSERT(fiberContext != nullptr, "Fiber context can't be nullptr"); 1694965e494Ss.makeev_local 1704965e494Ss.makeev_local bool res = false; 1714965e494Ss.makeev_local MT_USED_IN_ASSERT(res); 1724965e494Ss.makeev_local switch(stackRequirements) 1734965e494Ss.makeev_local { 1744965e494Ss.makeev_local case MT::StackRequirements::STANDARD: 1754965e494Ss.makeev_local res = standartFibersAvailable.TryPush(std::move(fiberContext)); 1764965e494Ss.makeev_local break; 1774965e494Ss.makeev_local case MT::StackRequirements::EXTENDED: 1784965e494Ss.makeev_local res = extendedFibersAvailable.TryPush(std::move(fiberContext)); 1794965e494Ss.makeev_local break; 1804965e494Ss.makeev_local default: 1814965e494Ss.makeev_local MT_REPORT_ASSERT("Unknown stack requrements"); 1824965e494Ss.makeev_local } 1834965e494Ss.makeev_local 18460ac17fbSs.makeev_local MT_USED_IN_ASSERT(res); 18560ac17fbSs.makeev_local MT_ASSERT(res != false, "Can't return fiber to storage"); 18658964d0bSSergey Makeev } 18758964d0bSSergey Makeev 18858964d0bSSergey Makeev FiberContext* TaskScheduler::ExecuteTask(internal::ThreadContext& threadContext, FiberContext* fiberContext) 18958964d0bSSergey Makeev { 19034a394c3SSergey Makeev MT_ASSERT(threadContext.thread.IsCurrentThread(), "Thread context sanity check failed"); 19158964d0bSSergey Makeev 19234a394c3SSergey Makeev MT_ASSERT(fiberContext, "Invalid fiber context"); 19334a394c3SSergey Makeev MT_ASSERT(fiberContext->currentTask.IsValid(), "Invalid task"); 19458964d0bSSergey Makeev 19558964d0bSSergey Makeev // Set actual thread context to fiber 19658964d0bSSergey Makeev fiberContext->SetThreadContext(&threadContext); 19758964d0bSSergey Makeev 19858964d0bSSergey Makeev // Update task status 19958964d0bSSergey Makeev fiberContext->SetStatus(FiberTaskStatus::RUNNED); 20058964d0bSSergey Makeev 20134a394c3SSergey Makeev MT_ASSERT(fiberContext->GetThreadContext()->thread.IsCurrentThread(), "Thread context sanity check failed"); 20258964d0bSSergey Makeev 203f4db079dSs.makeev const void* poolUserData = fiberContext->currentTask.userData; 20411d67161SSergey Makeev TPoolTaskDestroy poolDestroyFunc = fiberContext->currentTask.poolDestroyFunc; 20511d67161SSergey Makeev 20660ac17fbSs.makeev_local #ifdef MT_INSTRUMENTED_BUILD 2076e90b535Ss.makeev_local //threadContext.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::SUSPEND); 2086e90b535Ss.makeev_local threadContext.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::STOP); 20960ac17fbSs.makeev_local #endif 21060ac17fbSs.makeev_local 21158964d0bSSergey Makeev // Run current task code 21258964d0bSSergey Makeev Fiber::SwitchTo(threadContext.schedulerFiber, fiberContext->fiber); 21358964d0bSSergey Makeev 21460ac17fbSs.makeev_local #ifdef MT_INSTRUMENTED_BUILD 2156e90b535Ss.makeev_local //threadContext.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::RESUME); 2166e90b535Ss.makeev_local threadContext.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::START); 21760ac17fbSs.makeev_local #endif 21860ac17fbSs.makeev_local 21958964d0bSSergey Makeev // If task was done 22058964d0bSSergey Makeev FiberTaskStatus::Type taskStatus = fiberContext->GetStatus(); 22158964d0bSSergey Makeev if (taskStatus == FiberTaskStatus::FINISHED) 22258964d0bSSergey Makeev { 22311d67161SSergey Makeev //destroy task (call dtor) for "fire and forget" type of task from TaskPool 22411d67161SSergey Makeev if (poolDestroyFunc != nullptr) 22511d67161SSergey Makeev { 22611d67161SSergey Makeev poolDestroyFunc(poolUserData); 22711d67161SSergey Makeev } 22811d67161SSergey Makeev 229806ef292SSergey Makeev TaskGroup taskGroup = fiberContext->currentGroup; 23031bebe6fSSergey Makeev 231806ef292SSergey Makeev TaskScheduler::TaskGroupDescription & groupDesc = threadContext.taskScheduler->GetGroupDesc(taskGroup); 23258964d0bSSergey Makeev 23358964d0bSSergey Makeev // Update group status 234806ef292SSergey Makeev int groupTaskCount = groupDesc.Dec(); 23534a394c3SSergey Makeev MT_ASSERT(groupTaskCount >= 0, "Sanity check failed!"); 23658964d0bSSergey Makeev if (groupTaskCount == 0) 23758964d0bSSergey Makeev { 238806ef292SSergey Makeev // Signal pending threads that group work is finished. Group can be destroyed after this call. 239806ef292SSergey Makeev groupDesc.Signal(); 240806ef292SSergey Makeev 241754cb997SSergey Makeev fiberContext->currentGroup = TaskGroup::INVALID; 24258964d0bSSergey Makeev } 24358964d0bSSergey Makeev 24458964d0bSSergey Makeev // Update total task count 245806ef292SSergey Makeev int allGroupTaskCount = threadContext.taskScheduler->allGroups.Dec(); 246806ef292SSergey Makeev MT_ASSERT(allGroupTaskCount >= 0, "Sanity check failed!"); 247806ef292SSergey Makeev if (allGroupTaskCount == 0) 24858964d0bSSergey Makeev { 24958964d0bSSergey Makeev // Notify all tasks in all group finished 2502a2464ccSSergey Makeev threadContext.taskScheduler->allGroups.Signal(); 25158964d0bSSergey Makeev } 25258964d0bSSergey Makeev 25358964d0bSSergey Makeev FiberContext* parentFiberContext = fiberContext->parentFiber; 25458964d0bSSergey Makeev if (parentFiberContext != nullptr) 25558964d0bSSergey Makeev { 25681ec7369SSergey Makeev int childrenFibersCount = parentFiberContext->childrenFibersCount.DecFetch(); 25734a394c3SSergey Makeev MT_ASSERT(childrenFibersCount >= 0, "Sanity check failed!"); 25858964d0bSSergey Makeev 25958964d0bSSergey Makeev if (childrenFibersCount == 0) 26058964d0bSSergey Makeev { 26158964d0bSSergey Makeev // This is a last subtask. Restore parent task 26234a394c3SSergey Makeev MT_ASSERT(threadContext.thread.IsCurrentThread(), "Thread context sanity check failed"); 26334a394c3SSergey Makeev MT_ASSERT(parentFiberContext->GetThreadContext() == nullptr, "Inactive parent should not have a valid thread context"); 26458964d0bSSergey Makeev 26558964d0bSSergey Makeev // WARNING!! Thread context can changed here! Set actual current thread context. 26658964d0bSSergey Makeev parentFiberContext->SetThreadContext(&threadContext); 26758964d0bSSergey Makeev 26834a394c3SSergey Makeev MT_ASSERT(parentFiberContext->GetThreadContext()->thread.IsCurrentThread(), "Thread context sanity check failed"); 26958964d0bSSergey Makeev 27058964d0bSSergey Makeev // All subtasks is done. 27158964d0bSSergey Makeev // Exiting and return parent fiber to scheduler 27258964d0bSSergey Makeev return parentFiberContext; 27358964d0bSSergey Makeev } else 27458964d0bSSergey Makeev { 27558964d0bSSergey Makeev // Other subtasks still exist 27658964d0bSSergey Makeev // Exiting 27758964d0bSSergey Makeev return nullptr; 27858964d0bSSergey Makeev } 27958964d0bSSergey Makeev } else 28058964d0bSSergey Makeev { 28158964d0bSSergey Makeev // Task is finished and no parent task 28258964d0bSSergey Makeev // Exiting 28358964d0bSSergey Makeev return nullptr; 28458964d0bSSergey Makeev } 28558964d0bSSergey Makeev } 28658964d0bSSergey Makeev 28734a394c3SSergey Makeev MT_ASSERT(taskStatus != FiberTaskStatus::RUNNED, "Incorrect task status") 28858964d0bSSergey Makeev return nullptr; 28958964d0bSSergey Makeev } 29058964d0bSSergey Makeev 29158964d0bSSergey Makeev 29258964d0bSSergey Makeev void TaskScheduler::FiberMain(void* userData) 29358964d0bSSergey Makeev { 29458964d0bSSergey Makeev FiberContext& fiberContext = *(FiberContext*)(userData); 29558964d0bSSergey Makeev for(;;) 29658964d0bSSergey Makeev { 29734a394c3SSergey Makeev MT_ASSERT(fiberContext.currentTask.IsValid(), "Invalid task in fiber context"); 29834a394c3SSergey Makeev MT_ASSERT(fiberContext.GetThreadContext(), "Invalid thread context"); 29934a394c3SSergey Makeev MT_ASSERT(fiberContext.GetThreadContext()->thread.IsCurrentThread(), "Thread context sanity check failed"); 30058964d0bSSergey Makeev 30160ac17fbSs.makeev_local #ifdef MT_INSTRUMENTED_BUILD 30260ac17fbSs.makeev_local fiberContext.fiber.SetName( MT_SYSTEM_TASK_FIBER_NAME ); 3036e90b535Ss.makeev_local fiberContext.GetThreadContext()->NotifyTaskExecuteStateChanged( fiberContext.currentTask.debugColor, fiberContext.currentTask.debugID, TaskExecuteState::START ); 30460ac17fbSs.makeev_local #endif 30558964d0bSSergey Makeev 30660ac17fbSs.makeev_local fiberContext.currentTask.taskFunc( fiberContext, fiberContext.currentTask.userData ); 30758964d0bSSergey Makeev fiberContext.SetStatus(FiberTaskStatus::FINISHED); 30858964d0bSSergey Makeev 3098112dedfSSergey Makeev #ifdef MT_INSTRUMENTED_BUILD 31060ac17fbSs.makeev_local fiberContext.fiber.SetName( MT_SYSTEM_TASK_FIBER_NAME ); 3116e90b535Ss.makeev_local fiberContext.GetThreadContext()->NotifyTaskExecuteStateChanged( fiberContext.currentTask.debugColor, fiberContext.currentTask.debugID, TaskExecuteState::STOP ); 3128112dedfSSergey Makeev #endif 3138112dedfSSergey Makeev 31458964d0bSSergey Makeev Fiber::SwitchTo(fiberContext.fiber, fiberContext.GetThreadContext()->schedulerFiber); 31558964d0bSSergey Makeev } 31658964d0bSSergey Makeev 31758964d0bSSergey Makeev } 31858964d0bSSergey Makeev 31958964d0bSSergey Makeev 320*b23bdf5aSs.makeev_local bool TaskScheduler::TryStealTask(internal::ThreadContext& threadContext, internal::GroupedTask & task, uint32 workersCount, bool taskStealingDisabled) 3212b4df162SSergey Makeev { 322*b23bdf5aSs.makeev_local if (workersCount <= 1 || taskStealingDisabled ) 3232b4df162SSergey Makeev { 3242b4df162SSergey Makeev return false; 3252b4df162SSergey Makeev } 3262b4df162SSergey Makeev 327a1626843SSergey Makeev uint32 victimIndex = threadContext.random.Get(); 328a1626843SSergey Makeev 329a1626843SSergey Makeev for (uint32 attempt = 0; attempt < workersCount; attempt++) 3302b4df162SSergey Makeev { 331a1626843SSergey Makeev uint32 index = victimIndex % workersCount; 332a1626843SSergey Makeev if (index == threadContext.workerIndex) 333a1626843SSergey Makeev { 334a1626843SSergey Makeev victimIndex++; 335a1626843SSergey Makeev index = victimIndex % workersCount; 3362b4df162SSergey Makeev } 3372b4df162SSergey Makeev 338a1626843SSergey Makeev internal::ThreadContext& victimContext = threadContext.taskScheduler->threadContext[index]; 339d7cf17b1Ss.makeev_local if (victimContext.queue.TryPopNewest(task)) 340a1626843SSergey Makeev { 341a1626843SSergey Makeev return true; 342a1626843SSergey Makeev } 343a1626843SSergey Makeev 344a1626843SSergey Makeev victimIndex++; 345a1626843SSergey Makeev } 346a1626843SSergey Makeev return false; 3472b4df162SSergey Makeev } 3482b4df162SSergey Makeev 34902d170cfSs.makeev_local 350c88507a8Ss.makeev_local void TaskScheduler::WorkerThreadMain( void* userData ) 35158964d0bSSergey Makeev { 35258964d0bSSergey Makeev internal::ThreadContext& context = *(internal::ThreadContext*)(userData); 35334a394c3SSergey Makeev MT_ASSERT(context.taskScheduler, "Task scheduler must be not null!"); 354c88507a8Ss.makeev_local 355d7cf17b1Ss.makeev_local #ifdef MT_INSTRUMENTED_BUILD 356c88507a8Ss.makeev_local const char* threadNames[] = {"worker0","worker1","worker2","worker3","worker4","worker5","worker6","worker7","worker8","worker9","worker10","worker11","worker12"}; 357c88507a8Ss.makeev_local if (context.workerIndex < MT_ARRAY_SIZE(threadNames)) 358c88507a8Ss.makeev_local { 359d7cf17b1Ss.makeev_local Thread::SetThreadName(threadNames[context.workerIndex]); 360c88507a8Ss.makeev_local } else 361c88507a8Ss.makeev_local { 362d7cf17b1Ss.makeev_local Thread::SetThreadName("worker_thread"); 363c88507a8Ss.makeev_local } 364d7cf17b1Ss.makeev_local #endif 365c88507a8Ss.makeev_local 366ae5bbefbSs.makeev_local context.schedulerFiber.CreateFromCurrentThreadAndRun(SchedulerFiberMain, userData); 36702d170cfSs.makeev_local } 36802d170cfSs.makeev_local 36902d170cfSs.makeev_local 37071198a5eSs.makeev_local void TaskScheduler::SchedulerFiberMain( void* userData ) 37102d170cfSs.makeev_local { 37202d170cfSs.makeev_local internal::ThreadContext& context = *(internal::ThreadContext*)(userData); 37302d170cfSs.makeev_local MT_ASSERT(context.taskScheduler, "Task scheduler must be not null!"); 3740727c1f9SSergey Makeev 3750727c1f9SSergey Makeev #ifdef MT_INSTRUMENTED_BUILD 3760727c1f9SSergey Makeev context.NotifyThreadCreate(context.workerIndex); 3770727c1f9SSergey Makeev #endif 3780727c1f9SSergey Makeev 379*b23bdf5aSs.makeev_local bool taskStealingDisabled = context.taskScheduler->IsTaskStealingDisabled(); 380a23fd933SSergey Makeev uint32 workersCount = context.taskScheduler->GetWorkersCount(); 381a23fd933SSergey Makeev int32 totalThreadsCount = context.taskScheduler->threadsCount.LoadRelaxed(); 382a1626843SSergey Makeev 38381ec7369SSergey Makeev context.taskScheduler->startedThreadsCount.IncFetch(); 38443c41d5cSSergey Makeev 385a23fd933SSergey Makeev //Simple spinlock until all threads is started and initialized 3866bbc0262SSergey Makeev for(;;) 38743c41d5cSSergey Makeev { 388a23fd933SSergey Makeev int32 initializedThreadsCount = context.taskScheduler->startedThreadsCount.Load(); 389a23fd933SSergey Makeev if (initializedThreadsCount == totalThreadsCount) 39043c41d5cSSergey Makeev { 39143c41d5cSSergey Makeev break; 39243c41d5cSSergey Makeev } 393d7cf17b1Ss.makeev_local 394d7cf17b1Ss.makeev_local // sleep some time until all other thread initialized 39543c41d5cSSergey Makeev Thread::Sleep(1); 39643c41d5cSSergey Makeev } 39743c41d5cSSergey Makeev 398f4db079dSs.makeev HardwareFullMemoryBarrier(); 399f4db079dSs.makeev 4000727c1f9SSergey Makeev #ifdef MT_INSTRUMENTED_BUILD 4010727c1f9SSergey Makeev context.NotifyThreadStart(context.workerIndex); 4026e90b535Ss.makeev_local context.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::START); 4030727c1f9SSergey Makeev #endif 4040727c1f9SSergey Makeev 40581ec7369SSergey Makeev while(context.state.Load() != internal::ThreadState::EXIT) 40658964d0bSSergey Makeev { 40758964d0bSSergey Makeev internal::GroupedTask task; 408*b23bdf5aSs.makeev_local if (context.queue.TryPopOldest(task) || TryStealTask(context, task, workersCount, taskStealingDisabled) ) 40958964d0bSSergey Makeev { 41060ac17fbSs.makeev_local #ifdef MT_INSTRUMENTED_BUILD 41160ac17fbSs.makeev_local bool isNewTask = (task.awaitingFiber == nullptr); 41260ac17fbSs.makeev_local #endif 41360ac17fbSs.makeev_local 41458964d0bSSergey Makeev // There is a new task 41558964d0bSSergey Makeev FiberContext* fiberContext = context.taskScheduler->RequestFiberContext(task); 41634a394c3SSergey Makeev MT_ASSERT(fiberContext, "Can't get execution context from pool"); 41734a394c3SSergey Makeev MT_ASSERT(fiberContext->currentTask.IsValid(), "Sanity check failed"); 418f4db079dSs.makeev MT_ASSERT(fiberContext->stackRequirements == task.desc.stackRequirements, "Sanity check failed"); 41958964d0bSSergey Makeev 42058964d0bSSergey Makeev while(fiberContext) 42158964d0bSSergey Makeev { 4228112dedfSSergey Makeev #ifdef MT_INSTRUMENTED_BUILD 42360ac17fbSs.makeev_local if (isNewTask) 42460ac17fbSs.makeev_local { 42560ac17fbSs.makeev_local //TODO: 42660ac17fbSs.makeev_local isNewTask = false; 42760ac17fbSs.makeev_local } 4288112dedfSSergey Makeev #endif 42958964d0bSSergey Makeev // prevent invalid fiber resume from child tasks, before ExecuteTask is done 43081ec7369SSergey Makeev fiberContext->childrenFibersCount.IncFetch(); 43158964d0bSSergey Makeev 43258964d0bSSergey Makeev FiberContext* parentFiber = ExecuteTask(context, fiberContext); 43358964d0bSSergey Makeev 43458964d0bSSergey Makeev FiberTaskStatus::Type taskStatus = fiberContext->GetStatus(); 43558964d0bSSergey Makeev 43658964d0bSSergey Makeev //release guard 43781ec7369SSergey Makeev int childrenFibersCount = fiberContext->childrenFibersCount.DecFetch(); 43858964d0bSSergey Makeev 43958964d0bSSergey Makeev // Can drop fiber context - task is finished 44058964d0bSSergey Makeev if (taskStatus == FiberTaskStatus::FINISHED) 44158964d0bSSergey Makeev { 44234a394c3SSergey Makeev MT_ASSERT( childrenFibersCount == 0, "Sanity check failed"); 44360ac17fbSs.makeev_local context.taskScheduler->ReleaseFiberContext(std::move(fiberContext)); 44458964d0bSSergey Makeev 44558964d0bSSergey Makeev // If parent fiber is exist transfer flow control to parent fiber, if parent fiber is null, exit 44658964d0bSSergey Makeev fiberContext = parentFiber; 44758964d0bSSergey Makeev } else 44858964d0bSSergey Makeev { 44934a394c3SSergey Makeev MT_ASSERT( childrenFibersCount >= 0, "Sanity check failed"); 45058964d0bSSergey Makeev 45158964d0bSSergey Makeev // No subtasks here and status is not finished, this mean all subtasks already finished before parent return from ExecuteTask 45258964d0bSSergey Makeev if (childrenFibersCount == 0) 45358964d0bSSergey Makeev { 45434a394c3SSergey Makeev MT_ASSERT(parentFiber == nullptr, "Sanity check failed"); 45558964d0bSSergey Makeev } else 45658964d0bSSergey Makeev { 45758964d0bSSergey Makeev // If subtasks still exist, drop current task execution. task will be resumed when last subtask finished 45858964d0bSSergey Makeev break; 45958964d0bSSergey Makeev } 46058964d0bSSergey Makeev 46158964d0bSSergey Makeev // If task is in await state drop execution. task will be resumed when RestoreAwaitingTasks called 46258964d0bSSergey Makeev if (taskStatus == FiberTaskStatus::AWAITING_GROUP) 46358964d0bSSergey Makeev { 46458964d0bSSergey Makeev break; 46558964d0bSSergey Makeev } 46658964d0bSSergey Makeev } 46758964d0bSSergey Makeev } //while(fiberContext) 46858964d0bSSergey Makeev 46958964d0bSSergey Makeev } else 47058964d0bSSergey Makeev { 471a1626843SSergey Makeev #ifdef MT_INSTRUMENTED_BUILD 4724a90b4a6SSergey Makeev context.NotifyThreadIdleBegin(context.workerIndex); 473a1626843SSergey Makeev #endif 474a1626843SSergey Makeev 47560ac17fbSs.makeev_local // Queue if empty and stealing attempt failed 47660ac17fbSs.makeev_local // Wait for new events 47758964d0bSSergey Makeev context.hasNewTasksEvent.Wait(2000); 478a1626843SSergey Makeev 479a1626843SSergey Makeev #ifdef MT_INSTRUMENTED_BUILD 4804a90b4a6SSergey Makeev context.NotifyThreadIdleEnd(context.workerIndex); 481a1626843SSergey Makeev #endif 482a1626843SSergey Makeev 48358964d0bSSergey Makeev } 48458964d0bSSergey Makeev 48558964d0bSSergey Makeev } // main thread loop 4860727c1f9SSergey Makeev 4870727c1f9SSergey Makeev #ifdef MT_INSTRUMENTED_BUILD 4886e90b535Ss.makeev_local context.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::STOP); 4890727c1f9SSergey Makeev context.NotifyThreadStop(context.workerIndex); 4900727c1f9SSergey Makeev #endif 4910727c1f9SSergey Makeev 49258964d0bSSergey Makeev } 49358964d0bSSergey Makeev 49456aa031bSSergey Makeev void TaskScheduler::RunTasksImpl(ArrayView<internal::TaskBucket>& buckets, FiberContext * parentFiber, bool restoredFromAwaitState) 49558964d0bSSergey Makeev { 496806ef292SSergey Makeev // This storage is necessary to calculate how many tasks we add to different groups 497754cb997SSergey Makeev int newTaskCountInGroup[TaskGroup::MT_MAX_GROUPS_COUNT]; 498806ef292SSergey Makeev 499806ef292SSergey Makeev // Default value is 0 500806ef292SSergey Makeev memset(&newTaskCountInGroup[0], 0, sizeof(newTaskCountInGroup)); 501806ef292SSergey Makeev 50258964d0bSSergey Makeev // Set parent fiber pointer 50358964d0bSSergey Makeev // Calculate the number of tasks per group 50458964d0bSSergey Makeev // Calculate total number of tasks 50558964d0bSSergey Makeev size_t count = 0; 506a101e543SSergey Makeev for (size_t i = 0; i < buckets.Size(); ++i) 50758964d0bSSergey Makeev { 50858964d0bSSergey Makeev internal::TaskBucket& bucket = buckets[i]; 50958964d0bSSergey Makeev for (size_t taskIndex = 0; taskIndex < bucket.count; taskIndex++) 51058964d0bSSergey Makeev { 51158964d0bSSergey Makeev internal::GroupedTask & task = bucket.tasks[taskIndex]; 51258964d0bSSergey Makeev 51358964d0bSSergey Makeev task.parentFiber = parentFiber; 514754cb997SSergey Makeev 515754cb997SSergey Makeev int idx = task.group.GetValidIndex(); 516754cb997SSergey Makeev MT_ASSERT(idx >= 0 && idx < TaskGroup::MT_MAX_GROUPS_COUNT, "Invalid index"); 517754cb997SSergey Makeev newTaskCountInGroup[idx]++; 51831bebe6fSSergey Makeev } 51931bebe6fSSergey Makeev 52058964d0bSSergey Makeev count += bucket.count; 52158964d0bSSergey Makeev } 52258964d0bSSergey Makeev 52358964d0bSSergey Makeev // Increments child fibers count on parent fiber 52458964d0bSSergey Makeev if (parentFiber) 52558964d0bSSergey Makeev { 52681ec7369SSergey Makeev parentFiber->childrenFibersCount.AddFetch((int)count); 52758964d0bSSergey Makeev } 52858964d0bSSergey Makeev 52958964d0bSSergey Makeev if (restoredFromAwaitState == false) 53058964d0bSSergey Makeev { 531806ef292SSergey Makeev // Increase the number of active tasks in the group using data from temporary storage 532754cb997SSergey Makeev for (size_t i = 0; i < TaskGroup::MT_MAX_GROUPS_COUNT; i++) 533806ef292SSergey Makeev { 534806ef292SSergey Makeev int groupNewTaskCount = newTaskCountInGroup[i]; 535806ef292SSergey Makeev if (groupNewTaskCount > 0) 536806ef292SSergey Makeev { 537806ef292SSergey Makeev groupStats[i].Reset(); 538806ef292SSergey Makeev groupStats[i].Add((uint32)groupNewTaskCount); 539806ef292SSergey Makeev } 540806ef292SSergey Makeev } 541806ef292SSergey Makeev 54258964d0bSSergey Makeev // Increments all task in progress counter 5432a2464ccSSergey Makeev allGroups.Reset(); 5442a2464ccSSergey Makeev allGroups.Add((uint32)count); 54558964d0bSSergey Makeev } else 54658964d0bSSergey Makeev { 54758964d0bSSergey Makeev // If task's restored from await state, counters already in correct state 54858964d0bSSergey Makeev } 54958964d0bSSergey Makeev 55058964d0bSSergey Makeev // Add to thread queue 551a101e543SSergey Makeev for (size_t i = 0; i < buckets.Size(); ++i) 55258964d0bSSergey Makeev { 553a23fd933SSergey Makeev int bucketIndex = roundRobinThreadIndex.IncFetch() % threadsCount.LoadRelaxed(); 55458964d0bSSergey Makeev internal::ThreadContext & context = threadContext[bucketIndex]; 55558964d0bSSergey Makeev 55658964d0bSSergey Makeev internal::TaskBucket& bucket = buckets[i]; 55758964d0bSSergey Makeev 558d7cf17b1Ss.makeev_local for(;;) 559d7cf17b1Ss.makeev_local { 560d7cf17b1Ss.makeev_local bool res = context.queue.Add(bucket.tasks, bucket.count); 561d7cf17b1Ss.makeev_local if (res == true) 562d7cf17b1Ss.makeev_local { 563d7cf17b1Ss.makeev_local break; 564d7cf17b1Ss.makeev_local } 565d7cf17b1Ss.makeev_local 566d7cf17b1Ss.makeev_local //Can't add new tasks onto the queue. Look like the job system is overloaded. Wait some time and try again. 567d7cf17b1Ss.makeev_local //TODO: implement waiting until workers done using events. 568d7cf17b1Ss.makeev_local Thread::Sleep(10); 569d7cf17b1Ss.makeev_local } 570d7cf17b1Ss.makeev_local 57158964d0bSSergey Makeev context.hasNewTasksEvent.Signal(); 57258964d0bSSergey Makeev } 57358964d0bSSergey Makeev } 57458964d0bSSergey Makeev 575f4db079dSs.makeev void TaskScheduler::RunAsync(TaskGroup group, const TaskHandle* taskHandleArray, uint32 taskHandleCount) 57658d12dadSSergey Makeev { 57758d12dadSSergey Makeev MT_ASSERT(!IsWorkerThread(), "Can't use RunAsync inside Task. Use FiberContext.RunAsync() instead."); 57858d12dadSSergey Makeev 57958d12dadSSergey Makeev ArrayView<internal::GroupedTask> buffer(MT_ALLOCATE_ON_STACK(sizeof(internal::GroupedTask) * taskHandleCount), taskHandleCount); 58058d12dadSSergey Makeev 581a23fd933SSergey Makeev uint32 bucketCount = MT::Min((uint32)GetWorkersCount(), taskHandleCount); 58258d12dadSSergey Makeev ArrayView<internal::TaskBucket> buckets(MT_ALLOCATE_ON_STACK(sizeof(internal::TaskBucket) * bucketCount), bucketCount); 58358d12dadSSergey Makeev 58458d12dadSSergey Makeev internal::DistibuteDescriptions(group, taskHandleArray, buffer, buckets); 58558d12dadSSergey Makeev RunTasksImpl(buckets, nullptr, false); 58658d12dadSSergey Makeev } 58758d12dadSSergey Makeev 588806ef292SSergey Makeev bool TaskScheduler::WaitGroup(TaskGroup group, uint32 milliseconds) 58958964d0bSSergey Makeev { 59034a394c3SSergey Makeev MT_VERIFY(IsWorkerThread() == false, "Can't use WaitGroup inside Task. Use FiberContext.WaitGroupAndYield() instead.", return false); 59158964d0bSSergey Makeev 592806ef292SSergey Makeev TaskScheduler::TaskGroupDescription & groupDesc = GetGroupDesc(group); 5932f083884Ss.makeev_local 594806ef292SSergey Makeev return groupDesc.Wait(milliseconds); 59558964d0bSSergey Makeev } 59658964d0bSSergey Makeev 59758964d0bSSergey Makeev bool TaskScheduler::WaitAll(uint32 milliseconds) 59858964d0bSSergey Makeev { 59934a394c3SSergey Makeev MT_VERIFY(IsWorkerThread() == false, "Can't use WaitAll inside Task.", return false); 60058964d0bSSergey Makeev 6012a2464ccSSergey Makeev return allGroups.Wait(milliseconds); 60258964d0bSSergey Makeev } 60358964d0bSSergey Makeev 604*b23bdf5aSs.makeev_local bool TaskScheduler::IsTaskStealingDisabled() const 60558964d0bSSergey Makeev { 606*b23bdf5aSs.makeev_local return taskStealingDisabled; 60758964d0bSSergey Makeev } 60858964d0bSSergey Makeev 609a23fd933SSergey Makeev int32 TaskScheduler::GetWorkersCount() const 61058964d0bSSergey Makeev { 611a23fd933SSergey Makeev return threadsCount.LoadRelaxed(); 61258964d0bSSergey Makeev } 61358964d0bSSergey Makeev 61458964d0bSSergey Makeev bool TaskScheduler::IsWorkerThread() const 61558964d0bSSergey Makeev { 61658964d0bSSergey Makeev for (uint32 i = 0; i < MT_MAX_THREAD_COUNT; i++) 61758964d0bSSergey Makeev { 61858964d0bSSergey Makeev if (threadContext[i].thread.IsCurrentThread()) 61958964d0bSSergey Makeev { 62058964d0bSSergey Makeev return true; 62158964d0bSSergey Makeev } 62258964d0bSSergey Makeev } 62358964d0bSSergey Makeev return false; 62458964d0bSSergey Makeev } 62558964d0bSSergey Makeev 626806ef292SSergey Makeev TaskGroup TaskScheduler::CreateGroup() 627806ef292SSergey Makeev { 628806ef292SSergey Makeev MT_ASSERT(IsWorkerThread() == false, "Can't use CreateGroup inside Task."); 629806ef292SSergey Makeev 630754cb997SSergey Makeev TaskGroup group; 63160ac17fbSs.makeev_local if (!availableGroups.TryPop(group)) 632806ef292SSergey Makeev { 6336bbc0262SSergey Makeev MT_REPORT_ASSERT("Group pool is empty"); 634806ef292SSergey Makeev } 635806ef292SSergey Makeev 636754cb997SSergey Makeev int idx = group.GetValidIndex(); 6374965e494Ss.makeev_local MT_USED_IN_ASSERT(idx); 6382e846c40SSergey Makeev MT_ASSERT(groupStats[idx].GetDebugIsFree() == true, "Bad logic!"); 6399d94a278Ss.makeev_local #if MT_GROUP_DEBUG 6402e846c40SSergey Makeev groupStats[idx].SetDebugIsFree(false); 6419d94a278Ss.makeev_local #endif 642806ef292SSergey Makeev 643806ef292SSergey Makeev return group; 644806ef292SSergey Makeev } 645806ef292SSergey Makeev 646806ef292SSergey Makeev void TaskScheduler::ReleaseGroup(TaskGroup group) 647806ef292SSergey Makeev { 648806ef292SSergey Makeev MT_ASSERT(IsWorkerThread() == false, "Can't use ReleaseGroup inside Task."); 649754cb997SSergey Makeev MT_ASSERT(group.IsValid(), "Invalid group ID"); 650806ef292SSergey Makeev 651754cb997SSergey Makeev int idx = group.GetValidIndex(); 6524965e494Ss.makeev_local MT_USED_IN_ASSERT(idx); 6532e846c40SSergey Makeev MT_ASSERT(groupStats[idx].GetDebugIsFree() == false, "Group already released"); 6549d94a278Ss.makeev_local #if MT_GROUP_DEBUG 6552e846c40SSergey Makeev groupStats[idx].SetDebugIsFree(true); 6569d94a278Ss.makeev_local #endif 657806ef292SSergey Makeev 65860ac17fbSs.makeev_local bool res = availableGroups.TryPush(std::move(group)); 65960ac17fbSs.makeev_local MT_USED_IN_ASSERT(res); 66060ac17fbSs.makeev_local MT_ASSERT(res, "Can't return group to pool"); 661806ef292SSergey Makeev } 662806ef292SSergey Makeev 663806ef292SSergey Makeev TaskScheduler::TaskGroupDescription & TaskScheduler::GetGroupDesc(TaskGroup group) 664806ef292SSergey Makeev { 665754cb997SSergey Makeev MT_ASSERT(group.IsValid(), "Invalid group ID"); 666806ef292SSergey Makeev 667754cb997SSergey Makeev int idx = group.GetValidIndex(); 668754cb997SSergey Makeev TaskScheduler::TaskGroupDescription & groupDesc = groupStats[idx]; 669806ef292SSergey Makeev 6702e846c40SSergey Makeev MT_ASSERT(groupDesc.GetDebugIsFree() == false, "Invalid group"); 671806ef292SSergey Makeev return groupDesc; 672806ef292SSergey Makeev } 67358964d0bSSergey Makeev } 67402d170cfSs.makeev_local 67502d170cfSs.makeev_local 676