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>
24b8503d38Ss.makeev_local #include <MTStaticVector.h>
25c73d1551SSergey Makeev #include <string.h> // for memset
2658964d0bSSergey Makeev 
273cb1fd8eSs.makeev_local 
283cb1fd8eSs.makeev_local //  Enable low latency experimental wait code path.
293cb1fd8eSs.makeev_local //  Look like low latency hybrid wait is work better for PS4/X1, but a little worse on PC
303cb1fd8eSs.makeev_local //#define MT_LOW_LATENCY_EXPERIMENTAL_WAIT (1)
313cb1fd8eSs.makeev_local 
323cb1fd8eSs.makeev_local 
3358964d0bSSergey Makeev namespace MT
3458964d0bSSergey Makeev {
350727c1f9SSergey Makeev #ifdef MT_INSTRUMENTED_BUILD
TaskScheduler(uint32 workerThreadsCount,WorkerThreadParams * workerParameters,IProfilerEventListener * listener,TaskStealingMode::Type stealMode)36b23bdf5aSs.makeev_local 	TaskScheduler::TaskScheduler(uint32 workerThreadsCount, WorkerThreadParams* workerParameters, IProfilerEventListener* listener, TaskStealingMode::Type stealMode)
370727c1f9SSergey Makeev #else
38b23bdf5aSs.makeev_local 	TaskScheduler::TaskScheduler(uint32 workerThreadsCount, WorkerThreadParams* workerParameters, TaskStealingMode::Type stealMode)
390727c1f9SSergey Makeev #endif
4058964d0bSSergey Makeev 		: roundRobinThreadIndex(0)
4143c41d5cSSergey Makeev 		, startedThreadsCount(0)
42b23bdf5aSs.makeev_local 		, taskStealingDisabled(stealMode == TaskStealingMode::DISABLED)
4358964d0bSSergey Makeev 	{
4451901c6bSSergey Makeev 
45ff5c86b0SSergey Makeev #ifdef MT_INSTRUMENTED_BUILD
460727c1f9SSergey Makeev 		profilerEventListener = listener;
47ff5c86b0SSergey Makeev #endif
48ff5c86b0SSergey Makeev 
4934a394c3SSergey Makeev 		if (workerThreadsCount != 0)
5034a394c3SSergey Makeev 		{
51a23fd933SSergey Makeev 			threadsCount.StoreRelaxed( MT::Clamp(workerThreadsCount, (uint32)1, (uint32)MT_MAX_THREAD_COUNT) );
5234a394c3SSergey Makeev 		} else
5334a394c3SSergey Makeev 		{
5434a394c3SSergey Makeev 			//query number of processor
55d7cf17b1Ss.makeev_local 			threadsCount.StoreRelaxed( (uint32)MT::Clamp(Thread::GetNumberOfHardwareThreads() - 1, 1, (int)MT_MAX_THREAD_COUNT) );
5634a394c3SSergey Makeev 		}
5734a394c3SSergey Makeev 
589c716f68Ss.makeev_local 		uint32 fiberIndex = 0;
599c716f68Ss.makeev_local 
60f4db079dSs.makeev 		// create fiber pool (fibers with standard stack size)
61f4db079dSs.makeev 		for (uint32 i = 0; i < MT_MAX_STANDART_FIBERS_COUNT; i++)
6258964d0bSSergey Makeev 		{
63f4db079dSs.makeev 			FiberContext& context = standartFiberContexts[i];
64f4db079dSs.makeev 			context.fiber.Create(MT_STANDART_FIBER_STACK_SIZE, FiberMain, &context);
659c716f68Ss.makeev_local 			context.fiberIndex = fiberIndex;
6660ac17fbSs.makeev_local 			bool res = standartFibersAvailable.TryPush( &context );
6760ac17fbSs.makeev_local 			MT_USED_IN_ASSERT(res);
6860ac17fbSs.makeev_local 			MT_ASSERT(res == true, "Can't add fiber to storage");
699c716f68Ss.makeev_local 			fiberIndex++;
7058964d0bSSergey Makeev 		}
7158964d0bSSergey Makeev 
72f4db079dSs.makeev 		// create fiber pool (fibers with extended stack size)
73f4db079dSs.makeev 		for (uint32 i = 0; i < MT_MAX_EXTENDED_FIBERS_COUNT; i++)
74f4db079dSs.makeev 		{
75f4db079dSs.makeev 			FiberContext& context = extendedFiberContexts[i];
76f4db079dSs.makeev 			context.fiber.Create(MT_EXTENDED_FIBER_STACK_SIZE, FiberMain, &context);
779c716f68Ss.makeev_local 			context.fiberIndex = fiberIndex;
7860ac17fbSs.makeev_local 			bool res = extendedFibersAvailable.TryPush( &context );
7960ac17fbSs.makeev_local 			MT_USED_IN_ASSERT(res);
8060ac17fbSs.makeev_local 			MT_ASSERT(res == true, "Can't add fiber to storage");
819c716f68Ss.makeev_local 			fiberIndex++;
82f4db079dSs.makeev 		}
83f4db079dSs.makeev 
849c716f68Ss.makeev_local #ifdef MT_INSTRUMENTED_BUILD
859c716f68Ss.makeev_local 		NotifyFibersCreated(MT_MAX_STANDART_FIBERS_COUNT + MT_MAX_EXTENDED_FIBERS_COUNT);
869c716f68Ss.makeev_local #endif
87f4db079dSs.makeev 
882e846c40SSergey Makeev 		for (int16 i = 0; i < TaskGroup::MT_MAX_GROUPS_COUNT; i++)
89806ef292SSergey Makeev 		{
90754cb997SSergey Makeev 			if (i != TaskGroup::DEFAULT)
91806ef292SSergey Makeev 			{
9260ac17fbSs.makeev_local 				bool res = availableGroups.TryPush( TaskGroup(i) );
9360ac17fbSs.makeev_local 				MT_USED_IN_ASSERT(res);
9460ac17fbSs.makeev_local 				MT_ASSERT(res == true, "Can't add group to storage");
95806ef292SSergey Makeev 			}
96806ef292SSergey Makeev 		}
97806ef292SSergey Makeev 
989d94a278Ss.makeev_local #if MT_GROUP_DEBUG
992e846c40SSergey Makeev 		groupStats[TaskGroup::DEFAULT].SetDebugIsFree(false);
1009d94a278Ss.makeev_local #endif
101806ef292SSergey Makeev 
10258964d0bSSergey Makeev 		// create worker thread pool
103a23fd933SSergey Makeev 		int32 totalThreadsCount = GetWorkersCount();
1049c716f68Ss.makeev_local 
1059c716f68Ss.makeev_local #ifdef MT_INSTRUMENTED_BUILD
1069c716f68Ss.makeev_local 		NotifyThreadsCreated(totalThreadsCount);
1079c716f68Ss.makeev_local #endif
1089c716f68Ss.makeev_local 
109a23fd933SSergey Makeev 		for (int32 i = 0; i < totalThreadsCount; i++)
11058964d0bSSergey Makeev 		{
1112b4df162SSergey Makeev 			threadContext[i].SetThreadIndex(i);
11258964d0bSSergey Makeev 			threadContext[i].taskScheduler = this;
113d7cf17b1Ss.makeev_local 
114d7cf17b1Ss.makeev_local 			uint32 threadCore = i;
115d7cf17b1Ss.makeev_local 			ThreadPriority::Type priority = ThreadPriority::DEFAULT;
116d7cf17b1Ss.makeev_local 			if (workerParameters != nullptr)
117d7cf17b1Ss.makeev_local 			{
118d7cf17b1Ss.makeev_local 				const WorkerThreadParams& params = workerParameters[i];
119d7cf17b1Ss.makeev_local 
120d7cf17b1Ss.makeev_local 				threadCore = params.core;
121d7cf17b1Ss.makeev_local 				priority = params.priority;
122d7cf17b1Ss.makeev_local 			}
123d7cf17b1Ss.makeev_local 
124d7cf17b1Ss.makeev_local 			threadContext[i].thread.Start( MT_SCHEDULER_STACK_SIZE, WorkerThreadMain, &threadContext[i], threadCore, priority);
12558964d0bSSergey Makeev 		}
12658964d0bSSergey Makeev 	}
12758964d0bSSergey Makeev 
JoinWorkerThreads()12801616bcfSs.makeev_local 	void TaskScheduler::JoinWorkerThreads()
12958964d0bSSergey Makeev 	{
130a23fd933SSergey Makeev 		int32 totalThreadsCount = GetWorkersCount();
131a23fd933SSergey Makeev 		for (int32 i = 0; i < totalThreadsCount; i++)
13258964d0bSSergey Makeev 		{
13381ec7369SSergey Makeev 			threadContext[i].state.Store(internal::ThreadState::EXIT);
13458964d0bSSergey Makeev 			threadContext[i].hasNewTasksEvent.Signal();
13558964d0bSSergey Makeev 		}
13658964d0bSSergey Makeev 
137a23fd933SSergey Makeev 		for (int32 i = 0; i < totalThreadsCount; i++)
13858964d0bSSergey Makeev 		{
139c7362320Ss.makeev_local 			threadContext[i].thread.Join();
14058964d0bSSergey Makeev 		}
14101616bcfSs.makeev_local 		threadsCount.Store(0);
14201616bcfSs.makeev_local 	}
14301616bcfSs.makeev_local 
~TaskScheduler()14401616bcfSs.makeev_local 	TaskScheduler::~TaskScheduler()
14501616bcfSs.makeev_local 	{
14601616bcfSs.makeev_local 		if (GetWorkersCount() > 0)
14701616bcfSs.makeev_local 		{
14801616bcfSs.makeev_local 			JoinWorkerThreads();
14901616bcfSs.makeev_local 		}
15058964d0bSSergey Makeev 	}
15158964d0bSSergey Makeev 
RequestFiberContext(internal::GroupedTask & task)1524965e494Ss.makeev_local 	FiberContext* TaskScheduler::RequestFiberContext(internal::GroupedTask& task)
153f4db079dSs.makeev 	{
1544965e494Ss.makeev_local 		FiberContext *fiberContext = task.awaitingFiber;
1554965e494Ss.makeev_local 		if (fiberContext)
1564965e494Ss.makeev_local 		{
1574965e494Ss.makeev_local 			task.awaitingFiber = nullptr;
1584965e494Ss.makeev_local 			return fiberContext;
1594965e494Ss.makeev_local 		}
16060ac17fbSs.makeev_local 
1614965e494Ss.makeev_local 		MT::StackRequirements::Type stackRequirements = task.desc.stackRequirements;
1624965e494Ss.makeev_local 
1634965e494Ss.makeev_local 		fiberContext = nullptr;
16460ac17fbSs.makeev_local 		bool res = false;
16560ac17fbSs.makeev_local 		MT_USED_IN_ASSERT(res);
166f4db079dSs.makeev 		switch(stackRequirements)
167f4db079dSs.makeev 		{
168f4db079dSs.makeev 		case MT::StackRequirements::STANDARD:
16960ac17fbSs.makeev_local 			res = standartFibersAvailable.TryPop(fiberContext);
170012b0cafSSergey Makeev             MT_USED_IN_ASSERT(res);
17160ac17fbSs.makeev_local 			MT_ASSERT(res, "Can't get more standard fibers!");
172f4db079dSs.makeev 			break;
173f4db079dSs.makeev 		case MT::StackRequirements::EXTENDED:
17460ac17fbSs.makeev_local 			res = extendedFibersAvailable.TryPop(fiberContext);
175012b0cafSSergey Makeev             MT_USED_IN_ASSERT(res);
17660ac17fbSs.makeev_local 			MT_ASSERT(res, "Can't get more extended fibers!");
177f4db079dSs.makeev 			break;
178f4db079dSs.makeev 		default:
179f4db079dSs.makeev 			MT_REPORT_ASSERT("Unknown stack requrements");
180f4db079dSs.makeev 		}
181f4db079dSs.makeev 
18260ac17fbSs.makeev_local 		MT_ASSERT(fiberContext != nullptr, "Can't get more fibers. Too many tasks in flight simultaneously?");
18358964d0bSSergey Makeev 
18458964d0bSSergey Makeev 		fiberContext->currentTask = task.desc;
18558964d0bSSergey Makeev 		fiberContext->currentGroup = task.group;
18658964d0bSSergey Makeev 		fiberContext->parentFiber = task.parentFiber;
187f4db079dSs.makeev 		fiberContext->stackRequirements = stackRequirements;
18858964d0bSSergey Makeev 		return fiberContext;
18958964d0bSSergey Makeev 	}
19058964d0bSSergey Makeev 
ReleaseFiberContext(FiberContext * && fiberContext)19160ac17fbSs.makeev_local 	void TaskScheduler::ReleaseFiberContext(FiberContext*&& fiberContext)
19258964d0bSSergey Makeev 	{
193721f8c0bSs.makeev_local 		MT_ASSERT(fiberContext, "Can't release nullptr Fiber. fiberContext is nullptr");
194f4db079dSs.makeev 
195f4db079dSs.makeev 		MT::StackRequirements::Type stackRequirements = fiberContext->stackRequirements;
19658964d0bSSergey Makeev 		fiberContext->Reset();
197f4db079dSs.makeev 
1984965e494Ss.makeev_local 		MT_ASSERT(fiberContext != nullptr, "Fiber context can't be nullptr");
1994965e494Ss.makeev_local 
2004965e494Ss.makeev_local 		bool res = false;
2014965e494Ss.makeev_local 		MT_USED_IN_ASSERT(res);
2024965e494Ss.makeev_local 		switch(stackRequirements)
2034965e494Ss.makeev_local 		{
2044965e494Ss.makeev_local 		case MT::StackRequirements::STANDARD:
2054965e494Ss.makeev_local 			res = standartFibersAvailable.TryPush(std::move(fiberContext));
2064965e494Ss.makeev_local 			break;
2074965e494Ss.makeev_local 		case MT::StackRequirements::EXTENDED:
2084965e494Ss.makeev_local 			res = extendedFibersAvailable.TryPush(std::move(fiberContext));
2094965e494Ss.makeev_local 			break;
2104965e494Ss.makeev_local 		default:
2114965e494Ss.makeev_local 			MT_REPORT_ASSERT("Unknown stack requrements");
2124965e494Ss.makeev_local 		}
2134965e494Ss.makeev_local 
21460ac17fbSs.makeev_local 		MT_USED_IN_ASSERT(res);
21560ac17fbSs.makeev_local 		MT_ASSERT(res != false, "Can't return fiber to storage");
21658964d0bSSergey Makeev 	}
21758964d0bSSergey Makeev 
ExecuteTask(internal::ThreadContext & threadContext,FiberContext * fiberContext)21858964d0bSSergey Makeev 	FiberContext* TaskScheduler::ExecuteTask(internal::ThreadContext& threadContext, FiberContext* fiberContext)
21958964d0bSSergey Makeev 	{
2209c716f68Ss.makeev_local 		MT_ASSERT(threadContext.threadId.IsEqual(ThreadId::Self()), "Thread context sanity check failed");
22158964d0bSSergey Makeev 
22234a394c3SSergey Makeev 		MT_ASSERT(fiberContext, "Invalid fiber context");
22334a394c3SSergey Makeev 		MT_ASSERT(fiberContext->currentTask.IsValid(), "Invalid task");
22458964d0bSSergey Makeev 
22558964d0bSSergey Makeev 		// Set actual thread context to fiber
22658964d0bSSergey Makeev 		fiberContext->SetThreadContext(&threadContext);
22758964d0bSSergey Makeev 
22858964d0bSSergey Makeev 		// Update task status
22958964d0bSSergey Makeev 		fiberContext->SetStatus(FiberTaskStatus::RUNNED);
23058964d0bSSergey Makeev 
2319c716f68Ss.makeev_local 		MT_ASSERT(fiberContext->GetThreadContext()->threadId.IsEqual(ThreadId::Self()), "Thread context sanity check failed");
23258964d0bSSergey Makeev 
233f4db079dSs.makeev 		const void* poolUserData = fiberContext->currentTask.userData;
23411d67161SSergey Makeev 		TPoolTaskDestroy poolDestroyFunc = fiberContext->currentTask.poolDestroyFunc;
23511d67161SSergey Makeev 
23660ac17fbSs.makeev_local #ifdef MT_INSTRUMENTED_BUILD
23747ecee31Ss.makeev_local 		threadContext.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::STOP, MT_SYSTEM_FIBER_INDEX);
23860ac17fbSs.makeev_local #endif
23960ac17fbSs.makeev_local 
24058964d0bSSergey Makeev 		// Run current task code
24158964d0bSSergey Makeev 		Fiber::SwitchTo(threadContext.schedulerFiber, fiberContext->fiber);
24258964d0bSSergey Makeev 
24360ac17fbSs.makeev_local #ifdef MT_INSTRUMENTED_BUILD
24447ecee31Ss.makeev_local 		threadContext.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::START, MT_SYSTEM_FIBER_INDEX);
24560ac17fbSs.makeev_local #endif
24660ac17fbSs.makeev_local 
24758964d0bSSergey Makeev 		// If task was done
24858964d0bSSergey Makeev 		FiberTaskStatus::Type taskStatus = fiberContext->GetStatus();
24958964d0bSSergey Makeev 		if (taskStatus == FiberTaskStatus::FINISHED)
25058964d0bSSergey Makeev 		{
25111d67161SSergey Makeev 			//destroy task (call dtor) for "fire and forget" type of task from TaskPool
25211d67161SSergey Makeev 			if (poolDestroyFunc != nullptr)
25311d67161SSergey Makeev 			{
25411d67161SSergey Makeev 				poolDestroyFunc(poolUserData);
25511d67161SSergey Makeev 			}
25611d67161SSergey Makeev 
257806ef292SSergey Makeev 			TaskGroup taskGroup = fiberContext->currentGroup;
25831bebe6fSSergey Makeev 
259806ef292SSergey Makeev 			TaskScheduler::TaskGroupDescription  & groupDesc = threadContext.taskScheduler->GetGroupDesc(taskGroup);
26058964d0bSSergey Makeev 
26158964d0bSSergey Makeev 			// Update group status
262806ef292SSergey Makeev 			int groupTaskCount = groupDesc.Dec();
26334a394c3SSergey Makeev 			MT_ASSERT(groupTaskCount >= 0, "Sanity check failed!");
26458964d0bSSergey Makeev 			if (groupTaskCount == 0)
26558964d0bSSergey Makeev 			{
266754cb997SSergey Makeev 				fiberContext->currentGroup = TaskGroup::INVALID;
26758964d0bSSergey Makeev 			}
26858964d0bSSergey Makeev 
26958964d0bSSergey Makeev 			// Update total task count
270806ef292SSergey Makeev 			int allGroupTaskCount = threadContext.taskScheduler->allGroups.Dec();
271e0717aaeSs.makeev_local 			MT_USED_IN_ASSERT(allGroupTaskCount);
272806ef292SSergey Makeev 			MT_ASSERT(allGroupTaskCount >= 0, "Sanity check failed!");
27358964d0bSSergey Makeev 
27458964d0bSSergey Makeev 			FiberContext* parentFiberContext = fiberContext->parentFiber;
27558964d0bSSergey Makeev 			if (parentFiberContext != nullptr)
27658964d0bSSergey Makeev 			{
27781ec7369SSergey Makeev 				int childrenFibersCount = parentFiberContext->childrenFibersCount.DecFetch();
27834a394c3SSergey Makeev 				MT_ASSERT(childrenFibersCount >= 0, "Sanity check failed!");
27958964d0bSSergey Makeev 
28058964d0bSSergey Makeev 				if (childrenFibersCount == 0)
28158964d0bSSergey Makeev 				{
28258964d0bSSergey Makeev 					// This is a last subtask. Restore parent task
2839c716f68Ss.makeev_local 					MT_ASSERT(threadContext.threadId.IsEqual(ThreadId::Self()), "Thread context sanity check failed");
28434a394c3SSergey Makeev 					MT_ASSERT(parentFiberContext->GetThreadContext() == nullptr, "Inactive parent should not have a valid thread context");
28558964d0bSSergey Makeev 
28658964d0bSSergey Makeev 					// WARNING!! Thread context can changed here! Set actual current thread context.
28758964d0bSSergey Makeev 					parentFiberContext->SetThreadContext(&threadContext);
28858964d0bSSergey Makeev 
2899c716f68Ss.makeev_local 					MT_ASSERT(parentFiberContext->GetThreadContext()->threadId.IsEqual(ThreadId::Self()), "Thread context sanity check failed");
29058964d0bSSergey Makeev 
29158964d0bSSergey Makeev 					// All subtasks is done.
29258964d0bSSergey Makeev 					// Exiting and return parent fiber to scheduler
29358964d0bSSergey Makeev 					return parentFiberContext;
29458964d0bSSergey Makeev 				} else
29558964d0bSSergey Makeev 				{
29658964d0bSSergey Makeev 					// Other subtasks still exist
29758964d0bSSergey Makeev 					// Exiting
29858964d0bSSergey Makeev 					return nullptr;
29958964d0bSSergey Makeev 				}
30058964d0bSSergey Makeev 			} else
30158964d0bSSergey Makeev 			{
30258964d0bSSergey Makeev 				// Task is finished and no parent task
30358964d0bSSergey Makeev 				// Exiting
30458964d0bSSergey Makeev 				return nullptr;
30558964d0bSSergey Makeev 			}
30658964d0bSSergey Makeev 		}
30758964d0bSSergey Makeev 
30834a394c3SSergey Makeev 		MT_ASSERT(taskStatus != FiberTaskStatus::RUNNED, "Incorrect task status")
30958964d0bSSergey Makeev 		return nullptr;
31058964d0bSSergey Makeev 	}
31158964d0bSSergey Makeev 
31258964d0bSSergey Makeev 
FiberMain(void * userData)31358964d0bSSergey Makeev 	void TaskScheduler::FiberMain(void* userData)
31458964d0bSSergey Makeev 	{
31558964d0bSSergey Makeev 		FiberContext& fiberContext = *(FiberContext*)(userData);
31658964d0bSSergey Makeev 		for(;;)
31758964d0bSSergey Makeev 		{
31834a394c3SSergey Makeev 			MT_ASSERT(fiberContext.currentTask.IsValid(), "Invalid task in fiber context");
31934a394c3SSergey Makeev 			MT_ASSERT(fiberContext.GetThreadContext(), "Invalid thread context");
3209c716f68Ss.makeev_local 			MT_ASSERT(fiberContext.GetThreadContext()->threadId.IsEqual(ThreadId::Self()), "Thread context sanity check failed");
32158964d0bSSergey Makeev 
32260ac17fbSs.makeev_local #ifdef MT_INSTRUMENTED_BUILD
32360ac17fbSs.makeev_local 			fiberContext.fiber.SetName( MT_SYSTEM_TASK_FIBER_NAME );
32447ecee31Ss.makeev_local 			fiberContext.GetThreadContext()->NotifyTaskExecuteStateChanged( fiberContext.currentTask.debugColor, fiberContext.currentTask.debugID, TaskExecuteState::START, (int32)fiberContext.fiberIndex);
32560ac17fbSs.makeev_local #endif
32658964d0bSSergey Makeev 
32760ac17fbSs.makeev_local 			fiberContext.currentTask.taskFunc( fiberContext, fiberContext.currentTask.userData );
32858964d0bSSergey Makeev 			fiberContext.SetStatus(FiberTaskStatus::FINISHED);
32958964d0bSSergey Makeev 
3308112dedfSSergey Makeev #ifdef MT_INSTRUMENTED_BUILD
33160ac17fbSs.makeev_local 			fiberContext.fiber.SetName( MT_SYSTEM_TASK_FIBER_NAME );
33247ecee31Ss.makeev_local 			fiberContext.GetThreadContext()->NotifyTaskExecuteStateChanged( fiberContext.currentTask.debugColor, fiberContext.currentTask.debugID, TaskExecuteState::STOP, (int32)fiberContext.fiberIndex);
3338112dedfSSergey Makeev #endif
3348112dedfSSergey Makeev 
33558964d0bSSergey Makeev 			Fiber::SwitchTo(fiberContext.fiber, fiberContext.GetThreadContext()->schedulerFiber);
33658964d0bSSergey Makeev 		}
33758964d0bSSergey Makeev 
33858964d0bSSergey Makeev 	}
33958964d0bSSergey Makeev 
34058964d0bSSergey Makeev 
TryStealTask(internal::ThreadContext & threadContext,internal::GroupedTask & task)3413d930776Ss.makeev_local 	bool TaskScheduler::TryStealTask(internal::ThreadContext& threadContext, internal::GroupedTask & task)
3422b4df162SSergey Makeev 	{
3433d930776Ss.makeev_local 		uint32 workersCount = threadContext.taskScheduler->GetWorkersCount();
3443d930776Ss.makeev_local 
345a1626843SSergey Makeev 		uint32 victimIndex = threadContext.random.Get();
346a1626843SSergey Makeev 
347a1626843SSergey Makeev 		for (uint32 attempt = 0; attempt < workersCount; attempt++)
3482b4df162SSergey Makeev 		{
349a1626843SSergey Makeev 			uint32 index = victimIndex % workersCount;
350a1626843SSergey Makeev 			if (index == threadContext.workerIndex)
351a1626843SSergey Makeev 			{
352a1626843SSergey Makeev 				victimIndex++;
353a1626843SSergey Makeev 				index = victimIndex % workersCount;
3542b4df162SSergey Makeev 			}
3552b4df162SSergey Makeev 
356a1626843SSergey Makeev 			internal::ThreadContext& victimContext = threadContext.taskScheduler->threadContext[index];
357d7cf17b1Ss.makeev_local 			if (victimContext.queue.TryPopNewest(task))
358a1626843SSergey Makeev 			{
359a1626843SSergey Makeev 				return true;
360a1626843SSergey Makeev 			}
361a1626843SSergey Makeev 
362a1626843SSergey Makeev 			victimIndex++;
363a1626843SSergey Makeev 		}
364a1626843SSergey Makeev 		return false;
3652b4df162SSergey Makeev 	}
3662b4df162SSergey Makeev 
WorkerThreadMain(void * userData)367c88507a8Ss.makeev_local 	void TaskScheduler::WorkerThreadMain( void* userData )
36858964d0bSSergey Makeev 	{
36958964d0bSSergey Makeev 		internal::ThreadContext& context = *(internal::ThreadContext*)(userData);
37034a394c3SSergey Makeev 		MT_ASSERT(context.taskScheduler, "Task scheduler must be not null!");
371c88507a8Ss.makeev_local 
3729c716f68Ss.makeev_local 		context.threadId = ThreadId::Self();
3733d930776Ss.makeev_local 
374d7cf17b1Ss.makeev_local #ifdef MT_INSTRUMENTED_BUILD
375c88507a8Ss.makeev_local 		const char* threadNames[] = {"worker0","worker1","worker2","worker3","worker4","worker5","worker6","worker7","worker8","worker9","worker10","worker11","worker12"};
376c88507a8Ss.makeev_local 		if (context.workerIndex < MT_ARRAY_SIZE(threadNames))
377c88507a8Ss.makeev_local 		{
378d7cf17b1Ss.makeev_local 			Thread::SetThreadName(threadNames[context.workerIndex]);
379c88507a8Ss.makeev_local 		} else
380c88507a8Ss.makeev_local 		{
381d7cf17b1Ss.makeev_local 			Thread::SetThreadName("worker_thread");
382c88507a8Ss.makeev_local 		}
383d7cf17b1Ss.makeev_local #endif
384c88507a8Ss.makeev_local 
385ae5bbefbSs.makeev_local 		context.schedulerFiber.CreateFromCurrentThreadAndRun(SchedulerFiberMain, userData);
38602d170cfSs.makeev_local 	}
38702d170cfSs.makeev_local 
38802d170cfSs.makeev_local 
SchedulerFiberWait(void * userData)3893d930776Ss.makeev_local 	void TaskScheduler::SchedulerFiberWait( void* userData )
3903d930776Ss.makeev_local 	{
3913d930776Ss.makeev_local 		WaitContext& waitContext = *(WaitContext*)(userData);
3923d930776Ss.makeev_local 		internal::ThreadContext& context = *waitContext.threadContext;
3933d930776Ss.makeev_local 		MT_ASSERT(context.taskScheduler, "Task scheduler must be not null!");
3943d930776Ss.makeev_local 		MT_ASSERT(waitContext.waitCounter, "Wait counter must be not null!");
3953d930776Ss.makeev_local 
3963d930776Ss.makeev_local #ifdef MT_INSTRUMENTED_BUILD
39747ecee31Ss.makeev_local 		context.NotifyTemporaryWorkerThreadJoin();
39847ecee31Ss.makeev_local 
3993d930776Ss.makeev_local 		context.NotifyWaitStarted();
40047ecee31Ss.makeev_local 		context.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::START, MT_SYSTEM_FIBER_INDEX);
4013d930776Ss.makeev_local #endif
4023d930776Ss.makeev_local 
403ef444cf7Ss.makeev_local 		bool isTaskStealingDisabled = context.taskScheduler->IsTaskStealingDisabled(0);
4043cb1fd8eSs.makeev_local 
405*d91b8dc0SDmitry Tsarevich 		int64 timeOut = GetTimeMicroSeconds() + ((int64)waitContext.waitTimeMs * 1000);
4063d930776Ss.makeev_local 
4073cb1fd8eSs.makeev_local 		SpinWait spinWait;
4083d930776Ss.makeev_local 
4093d930776Ss.makeev_local 		for(;;)
4103d930776Ss.makeev_local 		{
4113cb1fd8eSs.makeev_local 			if ( SchedulerFiberStep(context, isTaskStealingDisabled) == false )
4123d930776Ss.makeev_local 			{
4133cb1fd8eSs.makeev_local 				spinWait.SpinOnce();
4143d930776Ss.makeev_local 			} else
4153d930776Ss.makeev_local 			{
4163cb1fd8eSs.makeev_local 				spinWait.Reset();
4173d930776Ss.makeev_local 			}
4183d930776Ss.makeev_local 
4193d930776Ss.makeev_local 			int32 groupTaskCount = waitContext.waitCounter->Load();
4203d930776Ss.makeev_local 			if (groupTaskCount == 0)
4213d930776Ss.makeev_local 			{
4223d930776Ss.makeev_local 				waitContext.exitCode = 0;
4233d930776Ss.makeev_local 				break;
4243d930776Ss.makeev_local 			}
4253d930776Ss.makeev_local 
4263d930776Ss.makeev_local 			int64 timeNow = GetTimeMicroSeconds();
4273d930776Ss.makeev_local 			if (timeNow >= timeOut)
4283d930776Ss.makeev_local 			{
4293d930776Ss.makeev_local 				waitContext.exitCode = 1;
4303d930776Ss.makeev_local 				break;
4313d930776Ss.makeev_local 			}
4323d930776Ss.makeev_local 		}
4333d930776Ss.makeev_local 
4343d930776Ss.makeev_local #ifdef MT_INSTRUMENTED_BUILD
43547ecee31Ss.makeev_local 		context.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::STOP, MT_SYSTEM_FIBER_INDEX);
4363d930776Ss.makeev_local 		context.NotifyWaitFinished();
4373d930776Ss.makeev_local 
43847ecee31Ss.makeev_local 		context.NotifyTemporaryWorkerThreadLeave();
43947ecee31Ss.makeev_local #endif
4403d930776Ss.makeev_local 	}
4413d930776Ss.makeev_local 
SchedulerFiberMain(void * userData)44271198a5eSs.makeev_local 	void TaskScheduler::SchedulerFiberMain( void* userData )
44302d170cfSs.makeev_local 	{
44402d170cfSs.makeev_local 		internal::ThreadContext& context = *(internal::ThreadContext*)(userData);
44502d170cfSs.makeev_local 		MT_ASSERT(context.taskScheduler, "Task scheduler must be not null!");
4460727c1f9SSergey Makeev 
4470727c1f9SSergey Makeev #ifdef MT_INSTRUMENTED_BUILD
4483d930776Ss.makeev_local 		context.NotifyThreadCreated(context.workerIndex);
4490727c1f9SSergey Makeev #endif
4500727c1f9SSergey Makeev 
451a23fd933SSergey Makeev 		int32 totalThreadsCount = context.taskScheduler->threadsCount.LoadRelaxed();
45281ec7369SSergey Makeev 		context.taskScheduler->startedThreadsCount.IncFetch();
45343c41d5cSSergey Makeev 
454a23fd933SSergey Makeev 		//Simple spinlock until all threads is started and initialized
4556bbc0262SSergey Makeev 		for(;;)
45643c41d5cSSergey Makeev 		{
457a23fd933SSergey Makeev 			int32 initializedThreadsCount = context.taskScheduler->startedThreadsCount.Load();
458a23fd933SSergey Makeev 			if (initializedThreadsCount == totalThreadsCount)
45943c41d5cSSergey Makeev 			{
46043c41d5cSSergey Makeev 				break;
46143c41d5cSSergey Makeev 			}
462d7cf17b1Ss.makeev_local 
463d7cf17b1Ss.makeev_local 			// sleep some time until all other thread initialized
46443c41d5cSSergey Makeev 			Thread::Sleep(1);
46543c41d5cSSergey Makeev 		}
46643c41d5cSSergey Makeev 
467f4db079dSs.makeev 		HardwareFullMemoryBarrier();
468f4db079dSs.makeev 
4690727c1f9SSergey Makeev #ifdef MT_INSTRUMENTED_BUILD
4703d930776Ss.makeev_local 		context.NotifyThreadStarted(context.workerIndex);
47147ecee31Ss.makeev_local 		context.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::START, MT_SYSTEM_FIBER_INDEX);
4720727c1f9SSergey Makeev #endif
4733cb1fd8eSs.makeev_local 		bool isTaskStealingDisabled = context.taskScheduler->IsTaskStealingDisabled();
4740727c1f9SSergey Makeev 
47581ec7369SSergey Makeev 		while(context.state.Load() != internal::ThreadState::EXIT)
47658964d0bSSergey Makeev 		{
4773cb1fd8eSs.makeev_local 			if ( SchedulerFiberStep(context, isTaskStealingDisabled) == false)
4783d930776Ss.makeev_local 			{
4793d930776Ss.makeev_local #ifdef MT_INSTRUMENTED_BUILD
4803d930776Ss.makeev_local 				context.NotifyThreadIdleStarted(context.workerIndex);
4813d930776Ss.makeev_local #endif
4823cb1fd8eSs.makeev_local 
4833cb1fd8eSs.makeev_local #if MT_LOW_LATENCY_EXPERIMENTAL_WAIT
4843cb1fd8eSs.makeev_local 
4853cb1fd8eSs.makeev_local 				SpinWait spinWait;
4863cb1fd8eSs.makeev_local 
4873cb1fd8eSs.makeev_local 				for(;;)
4883cb1fd8eSs.makeev_local 				{
4893cb1fd8eSs.makeev_local 					// Queue is empty and stealing attempt has failed.
4903cb1fd8eSs.makeev_local 					// Fast Spin Wait for new tasks
4913cb1fd8eSs.makeev_local 					if (spinWait.SpinOnce() >= SpinWait::YIELD_SLEEP0_THRESHOLD)
4923cb1fd8eSs.makeev_local 					{
4933cb1fd8eSs.makeev_local 						// Fast Spin wait for new tasks has failed.
4943cb1fd8eSs.makeev_local 						// Wait for new events using events
4953cb1fd8eSs.makeev_local 						context.hasNewTasksEvent.Wait(20000);
4963cb1fd8eSs.makeev_local 
4973cb1fd8eSs.makeev_local 						spinWait.Reset();
4983d930776Ss.makeev_local 
4993d930776Ss.makeev_local #ifdef MT_INSTRUMENTED_BUILD
5003d930776Ss.makeev_local 						context.NotifyThreadIdleFinished(context.workerIndex);
5013d930776Ss.makeev_local #endif
5023cb1fd8eSs.makeev_local 
5033cb1fd8eSs.makeev_local 						break;
5043cb1fd8eSs.makeev_local 					}
5053cb1fd8eSs.makeev_local 
5063cb1fd8eSs.makeev_local 					internal::GroupedTask task;
5073cb1fd8eSs.makeev_local 					if ( context.queue.TryPopOldest(task) )
5083cb1fd8eSs.makeev_local 					{
5093cb1fd8eSs.makeev_local #ifdef MT_INSTRUMENTED_BUILD
5103cb1fd8eSs.makeev_local 						context.NotifyThreadIdleFinished(context.workerIndex);
5113cb1fd8eSs.makeev_local #endif
5123cb1fd8eSs.makeev_local 
5133cb1fd8eSs.makeev_local 						SchedulerFiberProcessTask(context, task);
5143cb1fd8eSs.makeev_local 
5153cb1fd8eSs.makeev_local 						break;
5163cb1fd8eSs.makeev_local 					}
5173cb1fd8eSs.makeev_local 
5183cb1fd8eSs.makeev_local 				}
5193cb1fd8eSs.makeev_local #else
5203cb1fd8eSs.makeev_local 				// Queue is empty and stealing attempt has failed.
5213cb1fd8eSs.makeev_local 				// Wait for new events using events
5223cb1fd8eSs.makeev_local 				context.hasNewTasksEvent.Wait(20000);
5233cb1fd8eSs.makeev_local 
5243cb1fd8eSs.makeev_local #ifdef MT_INSTRUMENTED_BUILD
5253cb1fd8eSs.makeev_local 				context.NotifyThreadIdleFinished(context.workerIndex);
5263cb1fd8eSs.makeev_local #endif
5273cb1fd8eSs.makeev_local 
5283cb1fd8eSs.makeev_local #endif
5293cb1fd8eSs.makeev_local 
5303d930776Ss.makeev_local 			}
5313d930776Ss.makeev_local 
5323d930776Ss.makeev_local 		} // main thread loop
5333d930776Ss.makeev_local 
5343d930776Ss.makeev_local #ifdef MT_INSTRUMENTED_BUILD
53547ecee31Ss.makeev_local 		context.NotifyTaskExecuteStateChanged( MT_SYSTEM_TASK_COLOR, MT_SYSTEM_TASK_NAME, TaskExecuteState::STOP, MT_SYSTEM_FIBER_INDEX);
5363d930776Ss.makeev_local 		context.NotifyThreadStoped(context.workerIndex);
5373d930776Ss.makeev_local #endif
5383d930776Ss.makeev_local 
5393d930776Ss.makeev_local 	}
5403d930776Ss.makeev_local 
SchedulerFiberProcessTask(internal::ThreadContext & context,internal::GroupedTask & task)5413cb1fd8eSs.makeev_local 	void TaskScheduler::SchedulerFiberProcessTask( internal::ThreadContext& context, internal::GroupedTask& task )
54258964d0bSSergey Makeev 	{
54360ac17fbSs.makeev_local #ifdef MT_INSTRUMENTED_BUILD
54460ac17fbSs.makeev_local 		bool isNewTask = (task.awaitingFiber == nullptr);
54560ac17fbSs.makeev_local #endif
54660ac17fbSs.makeev_local 
54758964d0bSSergey Makeev 		// There is a new task
54858964d0bSSergey Makeev 		FiberContext* fiberContext = context.taskScheduler->RequestFiberContext(task);
54934a394c3SSergey Makeev 		MT_ASSERT(fiberContext, "Can't get execution context from pool");
55034a394c3SSergey Makeev 		MT_ASSERT(fiberContext->currentTask.IsValid(), "Sanity check failed");
551f4db079dSs.makeev 		MT_ASSERT(fiberContext->stackRequirements == task.desc.stackRequirements, "Sanity check failed");
55258964d0bSSergey Makeev 
55358964d0bSSergey Makeev 		while(fiberContext)
55458964d0bSSergey Makeev 		{
5558112dedfSSergey Makeev #ifdef MT_INSTRUMENTED_BUILD
55660ac17fbSs.makeev_local 			if (isNewTask)
55760ac17fbSs.makeev_local 			{
55860ac17fbSs.makeev_local 				//TODO:
55960ac17fbSs.makeev_local 				isNewTask = false;
56060ac17fbSs.makeev_local 			}
5618112dedfSSergey Makeev #endif
56258964d0bSSergey Makeev 			// prevent invalid fiber resume from child tasks, before ExecuteTask is done
56381ec7369SSergey Makeev 			fiberContext->childrenFibersCount.IncFetch();
56458964d0bSSergey Makeev 
56558964d0bSSergey Makeev 			FiberContext* parentFiber = ExecuteTask(context, fiberContext);
56658964d0bSSergey Makeev 
56758964d0bSSergey Makeev 			FiberTaskStatus::Type taskStatus = fiberContext->GetStatus();
56858964d0bSSergey Makeev 
56958964d0bSSergey Makeev 			//release guard
57081ec7369SSergey Makeev 			int childrenFibersCount = fiberContext->childrenFibersCount.DecFetch();
57158964d0bSSergey Makeev 
57258964d0bSSergey Makeev 			// Can drop fiber context - task is finished
57358964d0bSSergey Makeev 			if (taskStatus == FiberTaskStatus::FINISHED)
57458964d0bSSergey Makeev 			{
57534a394c3SSergey Makeev 				MT_ASSERT( childrenFibersCount == 0, "Sanity check failed");
57660ac17fbSs.makeev_local 				context.taskScheduler->ReleaseFiberContext(std::move(fiberContext));
57758964d0bSSergey Makeev 
57858964d0bSSergey Makeev 				// If parent fiber is exist transfer flow control to parent fiber, if parent fiber is null, exit
57958964d0bSSergey Makeev 				fiberContext = parentFiber;
58058964d0bSSergey Makeev 			} else
58158964d0bSSergey Makeev 			{
58234a394c3SSergey Makeev 				MT_ASSERT( childrenFibersCount >= 0, "Sanity check failed");
58358964d0bSSergey Makeev 
58458964d0bSSergey Makeev 				// No subtasks here and status is not finished, this mean all subtasks already finished before parent return from ExecuteTask
58558964d0bSSergey Makeev 				if (childrenFibersCount == 0)
58658964d0bSSergey Makeev 				{
58734a394c3SSergey Makeev 					MT_ASSERT(parentFiber == nullptr, "Sanity check failed");
58858964d0bSSergey Makeev 				} else
58958964d0bSSergey Makeev 				{
59058964d0bSSergey Makeev 					// If subtasks still exist, drop current task execution. task will be resumed when last subtask finished
59158964d0bSSergey Makeev 					break;
59258964d0bSSergey Makeev 				}
59358964d0bSSergey Makeev 
594b8503d38Ss.makeev_local 				// If task is yielded execution, get another task from queue.
5953a3d248dSs.makeev_local 				if (taskStatus == FiberTaskStatus::YIELDED)
59658964d0bSSergey Makeev 				{
597b8503d38Ss.makeev_local 					// Task is yielded, add to tasks queue
598b8503d38Ss.makeev_local 					ArrayView<internal::GroupedTask> buffer(context.descBuffer, 1);
599b8503d38Ss.makeev_local 					ArrayView<internal::TaskBucket> buckets( MT_ALLOCATE_ON_STACK(sizeof(internal::TaskBucket)), 1 );
600b8503d38Ss.makeev_local 
601b8503d38Ss.makeev_local 					FiberContext* yieldedTask = fiberContext;
602b8503d38Ss.makeev_local 					StaticVector<FiberContext*, 1> yieldedTasksQueue(1, yieldedTask);
603b8503d38Ss.makeev_local 					internal::DistibuteDescriptions( TaskGroup(TaskGroup::ASSIGN_FROM_CONTEXT), yieldedTasksQueue.Begin(), buffer, buckets );
604b8503d38Ss.makeev_local 
605b8503d38Ss.makeev_local 					// add yielded task to scheduler
606b8503d38Ss.makeev_local 					context.taskScheduler->RunTasksImpl(buckets, nullptr, true);
607b8503d38Ss.makeev_local 
608b8503d38Ss.makeev_local 					// ATENTION! yielded task can be already completed at this point
609b8503d38Ss.makeev_local 
61058964d0bSSergey Makeev 					break;
61158964d0bSSergey Makeev 				}
61258964d0bSSergey Makeev 			}
61358964d0bSSergey Makeev 		} //while(fiberContext)
6143cb1fd8eSs.makeev_local 	}
61558964d0bSSergey Makeev 
SchedulerFiberStep(internal::ThreadContext & context,bool disableTaskStealing)6163cb1fd8eSs.makeev_local 	bool TaskScheduler::SchedulerFiberStep( internal::ThreadContext& context, bool disableTaskStealing)
6173cb1fd8eSs.makeev_local 	{
6183cb1fd8eSs.makeev_local 		internal::GroupedTask task;
6193cb1fd8eSs.makeev_local 		if ( context.queue.TryPopOldest(task) || (disableTaskStealing == false && TryStealTask(context, task) ) )
6203cb1fd8eSs.makeev_local 		{
6213cb1fd8eSs.makeev_local 			SchedulerFiberProcessTask(context, task);
6223d930776Ss.makeev_local 			return true;
62358964d0bSSergey Makeev 		}
62458964d0bSSergey Makeev 
6253d930776Ss.makeev_local 		return false;
62658964d0bSSergey Makeev 	}
62758964d0bSSergey Makeev 
RunTasksImpl(ArrayView<internal::TaskBucket> & buckets,FiberContext * parentFiber,bool restoredFromAwaitState)62856aa031bSSergey Makeev 	void TaskScheduler::RunTasksImpl(ArrayView<internal::TaskBucket>& buckets, FiberContext * parentFiber, bool restoredFromAwaitState)
62958964d0bSSergey Makeev 	{
6303cb1fd8eSs.makeev_local 
6313cb1fd8eSs.makeev_local #if MT_LOW_LATENCY_EXPERIMENTAL_WAIT
6323cb1fd8eSs.makeev_local 		// Early wakeup worker threads (worker thread spin wait for some time before sleep)
6333cb1fd8eSs.makeev_local 		int32 roundRobinIndex = roundRobinThreadIndex.LoadRelaxed();
6343cb1fd8eSs.makeev_local 		for (size_t i = 0; i < buckets.Size(); ++i)
6353cb1fd8eSs.makeev_local 		{
6363cb1fd8eSs.makeev_local 			int bucketIndex = ((roundRobinIndex + i) % threadsCount.LoadRelaxed());
6373cb1fd8eSs.makeev_local 			internal::ThreadContext & context = threadContext[bucketIndex];
6383cb1fd8eSs.makeev_local 			context.hasNewTasksEvent.Signal();
6393cb1fd8eSs.makeev_local 		}
6403cb1fd8eSs.makeev_local #endif
6413cb1fd8eSs.makeev_local 
6423cb1fd8eSs.makeev_local 
643806ef292SSergey Makeev 		// This storage is necessary to calculate how many tasks we add to different groups
644754cb997SSergey Makeev 		int newTaskCountInGroup[TaskGroup::MT_MAX_GROUPS_COUNT];
645806ef292SSergey Makeev 
646806ef292SSergey Makeev 		// Default value is 0
64735e18df7Ss.makeev_local 		memset(&newTaskCountInGroup[0], 0, sizeof(newTaskCountInGroup));
648806ef292SSergey Makeev 
64958964d0bSSergey Makeev 		// Set parent fiber pointer
65058964d0bSSergey Makeev 		// Calculate the number of tasks per group
65158964d0bSSergey Makeev 		// Calculate total number of tasks
65258964d0bSSergey Makeev 		size_t count = 0;
653a101e543SSergey Makeev 		for (size_t i = 0; i < buckets.Size(); ++i)
65458964d0bSSergey Makeev 		{
65558964d0bSSergey Makeev 			internal::TaskBucket& bucket = buckets[i];
65658964d0bSSergey Makeev 			for (size_t taskIndex = 0; taskIndex < bucket.count; taskIndex++)
65758964d0bSSergey Makeev 			{
65858964d0bSSergey Makeev 				internal::GroupedTask & task = bucket.tasks[taskIndex];
65958964d0bSSergey Makeev 
66058964d0bSSergey Makeev 				task.parentFiber = parentFiber;
661754cb997SSergey Makeev 
662754cb997SSergey Makeev 				int idx = task.group.GetValidIndex();
663754cb997SSergey Makeev 				MT_ASSERT(idx >= 0 && idx < TaskGroup::MT_MAX_GROUPS_COUNT, "Invalid index");
664754cb997SSergey Makeev 				newTaskCountInGroup[idx]++;
66531bebe6fSSergey Makeev 			}
66631bebe6fSSergey Makeev 
66758964d0bSSergey Makeev 			count += bucket.count;
66858964d0bSSergey Makeev 		}
66958964d0bSSergey Makeev 
67058964d0bSSergey Makeev 		// Increments child fibers count on parent fiber
67158964d0bSSergey Makeev 		if (parentFiber)
67258964d0bSSergey Makeev 		{
67381ec7369SSergey Makeev 			parentFiber->childrenFibersCount.AddFetch((int)count);
67458964d0bSSergey Makeev 		}
67558964d0bSSergey Makeev 
67658964d0bSSergey Makeev 		if (restoredFromAwaitState == false)
67758964d0bSSergey Makeev 		{
678806ef292SSergey Makeev 			// Increase the number of active tasks in the group using data from temporary storage
679754cb997SSergey Makeev 			for (size_t i = 0; i < TaskGroup::MT_MAX_GROUPS_COUNT; i++)
680806ef292SSergey Makeev 			{
681806ef292SSergey Makeev 				int groupNewTaskCount = newTaskCountInGroup[i];
682806ef292SSergey Makeev 				if (groupNewTaskCount > 0)
683806ef292SSergey Makeev 				{
684806ef292SSergey Makeev 					groupStats[i].Add((uint32)groupNewTaskCount);
685806ef292SSergey Makeev 				}
686806ef292SSergey Makeev 			}
687806ef292SSergey Makeev 
68858964d0bSSergey Makeev 			// Increments all task in progress counter
6892a2464ccSSergey Makeev 			allGroups.Add((uint32)count);
69058964d0bSSergey Makeev 		} else
69158964d0bSSergey Makeev 		{
69258964d0bSSergey Makeev 			// If task's restored from await state, counters already in correct state
69358964d0bSSergey Makeev 		}
69458964d0bSSergey Makeev 
69558964d0bSSergey Makeev 		// Add to thread queue
696a101e543SSergey Makeev 		for (size_t i = 0; i < buckets.Size(); ++i)
69758964d0bSSergey Makeev 		{
698a23fd933SSergey Makeev 			int bucketIndex = roundRobinThreadIndex.IncFetch() % threadsCount.LoadRelaxed();
69958964d0bSSergey Makeev 			internal::ThreadContext & context = threadContext[bucketIndex];
70058964d0bSSergey Makeev 
70158964d0bSSergey Makeev 			internal::TaskBucket& bucket = buckets[i];
70258964d0bSSergey Makeev 
703d7cf17b1Ss.makeev_local 			for(;;)
704d7cf17b1Ss.makeev_local 			{
7054dcd71e3Ss.makeev_local 				MT_ASSERT(bucket.count < (internal::TASK_BUFFER_CAPACITY - 1), "Sanity check failed. Too many tasks per one bucket.");
7064dcd71e3Ss.makeev_local 
707d7cf17b1Ss.makeev_local 				bool res = context.queue.Add(bucket.tasks, bucket.count);
708d7cf17b1Ss.makeev_local 				if (res == true)
709d7cf17b1Ss.makeev_local 				{
710d7cf17b1Ss.makeev_local 					break;
711d7cf17b1Ss.makeev_local 				}
712d7cf17b1Ss.makeev_local 
713d7cf17b1Ss.makeev_local 				//Can't add new tasks onto the queue. Look like the job system is overloaded. Wait some time and try again.
714d7cf17b1Ss.makeev_local 				//TODO: implement waiting until workers done using events.
715d7cf17b1Ss.makeev_local 				Thread::Sleep(10);
716d7cf17b1Ss.makeev_local 			}
717d7cf17b1Ss.makeev_local 
71858964d0bSSergey Makeev 			context.hasNewTasksEvent.Signal();
71958964d0bSSergey Makeev 		}
72058964d0bSSergey Makeev 	}
72158964d0bSSergey Makeev 
RunAsync(TaskGroup group,const TaskHandle * taskHandleArray,uint32 taskHandleCount)722f4db079dSs.makeev 	void TaskScheduler::RunAsync(TaskGroup group, const TaskHandle* taskHandleArray, uint32 taskHandleCount)
72358d12dadSSergey Makeev 	{
72458d12dadSSergey Makeev 		MT_ASSERT(!IsWorkerThread(), "Can't use RunAsync inside Task. Use FiberContext.RunAsync() instead.");
72558d12dadSSergey Makeev 
72658d12dadSSergey Makeev 		ArrayView<internal::GroupedTask> buffer(MT_ALLOCATE_ON_STACK(sizeof(internal::GroupedTask) * taskHandleCount), taskHandleCount);
72758d12dadSSergey Makeev 
728a23fd933SSergey Makeev 		uint32 bucketCount = MT::Min((uint32)GetWorkersCount(), taskHandleCount);
72958d12dadSSergey Makeev 		ArrayView<internal::TaskBucket> buckets(MT_ALLOCATE_ON_STACK(sizeof(internal::TaskBucket) * bucketCount), bucketCount);
73058d12dadSSergey Makeev 
73158d12dadSSergey Makeev 		internal::DistibuteDescriptions(group, taskHandleArray, buffer, buckets);
73258d12dadSSergey Makeev 		RunTasksImpl(buckets, nullptr, false);
73358d12dadSSergey Makeev 	}
73458d12dadSSergey Makeev 
WaitGroup(TaskGroup group,uint32 milliseconds)735806ef292SSergey Makeev 	bool TaskScheduler::WaitGroup(TaskGroup group, uint32 milliseconds)
73658964d0bSSergey Makeev 	{
73734a394c3SSergey Makeev 		MT_VERIFY(IsWorkerThread() == false, "Can't use WaitGroup inside Task. Use FiberContext.WaitGroupAndYield() instead.", return false);
73858964d0bSSergey Makeev 
739806ef292SSergey Makeev 		TaskScheduler::TaskGroupDescription& groupDesc = GetGroupDesc(group);
7402f083884Ss.makeev_local 
741f7a9bfc3Ss.makeev_local 		// Early exit if not tasks in group
742f7a9bfc3Ss.makeev_local 		int32 taskCount = groupDesc.GetTaskCount();
743f7a9bfc3Ss.makeev_local 		if (taskCount == 0)
744f7a9bfc3Ss.makeev_local 		{
745f7a9bfc3Ss.makeev_local 			return true;
746f7a9bfc3Ss.makeev_local 		}
747f7a9bfc3Ss.makeev_local 
7483d930776Ss.makeev_local 		size_t bytesCountForDescBuffer = internal::ThreadContext::GetMemoryRequrementInBytesForDescBuffer();
7493d930776Ss.makeev_local 		void* descBuffer = MT_ALLOCATE_ON_STACK(bytesCountForDescBuffer);
7503d930776Ss.makeev_local 
7513d930776Ss.makeev_local 		internal::ThreadContext context(descBuffer);
7523d930776Ss.makeev_local 		context.taskScheduler = this;
7533d930776Ss.makeev_local 		context.SetThreadIndex(0xFFFFFFFF);
7549c716f68Ss.makeev_local 		context.threadId = ThreadId::Self();
7553d930776Ss.makeev_local 
7563d930776Ss.makeev_local 		WaitContext waitContext;
7573d930776Ss.makeev_local 		waitContext.threadContext = &context;
7583d930776Ss.makeev_local 		waitContext.waitCounter = groupDesc.GetWaitCounter();
7593d930776Ss.makeev_local 		waitContext.waitTimeMs = milliseconds;
7603d930776Ss.makeev_local 		waitContext.exitCode = 0;
7613d930776Ss.makeev_local 
76247ecee31Ss.makeev_local 		int32 waitingSlotIndex = nextWaitingThreadSlotIndex.IncFetch();
76347ecee31Ss.makeev_local 		waitingThreads[waitingSlotIndex % waitingThreads.size()] = ThreadId::Self();
7643d930776Ss.makeev_local 		context.schedulerFiber.CreateFromCurrentThreadAndRun(SchedulerFiberWait, &waitContext);
7653d930776Ss.makeev_local 
76647ecee31Ss.makeev_local 		MT_ASSERT( waitingThreads[waitingSlotIndex % waitingThreads.size()].IsEqual(ThreadId::Self()), "waitingThreads array overflow");
76747ecee31Ss.makeev_local 		waitingThreads[waitingSlotIndex % waitingThreads.size()] = ThreadId();
7689c716f68Ss.makeev_local 
7693d930776Ss.makeev_local 		return (waitContext.exitCode == 0);
77058964d0bSSergey Makeev 	}
77158964d0bSSergey Makeev 
WaitAll(uint32 milliseconds)77258964d0bSSergey Makeev 	bool TaskScheduler::WaitAll(uint32 milliseconds)
77358964d0bSSergey Makeev 	{
77434a394c3SSergey Makeev 		MT_VERIFY(IsWorkerThread() == false, "Can't use WaitAll inside Task.", return false);
77558964d0bSSergey Makeev 
776f7a9bfc3Ss.makeev_local 		// Early exit if not tasks in group
777f7a9bfc3Ss.makeev_local 		int32 taskCount = allGroups.GetTaskCount();
778f7a9bfc3Ss.makeev_local 		if (taskCount == 0)
779f7a9bfc3Ss.makeev_local 		{
780f7a9bfc3Ss.makeev_local 			return true;
781f7a9bfc3Ss.makeev_local 		}
782f7a9bfc3Ss.makeev_local 
7833d930776Ss.makeev_local 		size_t bytesCountForDescBuffer = internal::ThreadContext::GetMemoryRequrementInBytesForDescBuffer();
7843d930776Ss.makeev_local 		void* descBuffer = MT_ALLOCATE_ON_STACK(bytesCountForDescBuffer);
7853d930776Ss.makeev_local 
7863d930776Ss.makeev_local 		internal::ThreadContext context(descBuffer);
7873d930776Ss.makeev_local 		context.taskScheduler = this;
7883d930776Ss.makeev_local 		context.SetThreadIndex(0xFFFFFFFF);
7899c716f68Ss.makeev_local 		context.threadId = ThreadId::Self();
7903d930776Ss.makeev_local 
7913d930776Ss.makeev_local 		WaitContext waitContext;
7923d930776Ss.makeev_local 		waitContext.threadContext = &context;
7933d930776Ss.makeev_local 		waitContext.waitCounter = allGroups.GetWaitCounter();
7943d930776Ss.makeev_local 		waitContext.waitTimeMs = milliseconds;
7953d930776Ss.makeev_local 		waitContext.exitCode = 0;
7963d930776Ss.makeev_local 
79747ecee31Ss.makeev_local 		int32 waitingSlotIndex = nextWaitingThreadSlotIndex.IncFetch();
79847ecee31Ss.makeev_local 		waitingThreads[waitingSlotIndex % waitingThreads.size()] = ThreadId::Self();
7993d930776Ss.makeev_local 
8003d930776Ss.makeev_local 		context.schedulerFiber.CreateFromCurrentThreadAndRun(SchedulerFiberWait, &waitContext);
8013d930776Ss.makeev_local 
80247ecee31Ss.makeev_local 		MT_ASSERT( waitingThreads[waitingSlotIndex % waitingThreads.size()].IsEqual(ThreadId::Self()), "waitingThreads array overflow");
80347ecee31Ss.makeev_local 		waitingThreads[waitingSlotIndex % waitingThreads.size()] = ThreadId();
8049c716f68Ss.makeev_local 
8053d930776Ss.makeev_local 		return (waitContext.exitCode == 0);
80658964d0bSSergey Makeev 	}
80758964d0bSSergey Makeev 
IsTaskStealingDisabled(uint32 minWorkersCount) const808ef444cf7Ss.makeev_local 	bool TaskScheduler::IsTaskStealingDisabled(uint32 minWorkersCount) const
80958964d0bSSergey Makeev 	{
81058c31458Ss.makeev_local 		if (threadsCount.LoadRelaxed() <= (int32)minWorkersCount)
8113cb1fd8eSs.makeev_local 		{
8123cb1fd8eSs.makeev_local 			return true;
8133cb1fd8eSs.makeev_local 		}
8143cb1fd8eSs.makeev_local 
815b23bdf5aSs.makeev_local 		return taskStealingDisabled;
81658964d0bSSergey Makeev 	}
81758964d0bSSergey Makeev 
GetWorkersCount() const818a23fd933SSergey Makeev 	int32 TaskScheduler::GetWorkersCount() const
81958964d0bSSergey Makeev 	{
820a23fd933SSergey Makeev 		return threadsCount.LoadRelaxed();
82158964d0bSSergey Makeev 	}
82258964d0bSSergey Makeev 
8233d930776Ss.makeev_local 
IsWorkerThread() const82458964d0bSSergey Makeev 	bool TaskScheduler::IsWorkerThread() const
82558964d0bSSergey Makeev 	{
82647ecee31Ss.makeev_local 		int32 threadsCount = GetWorkersCount();
82747ecee31Ss.makeev_local 		for (int32 i = 0; i < threadsCount; i++)
82847ecee31Ss.makeev_local 		{
82947ecee31Ss.makeev_local 			if (threadContext[i].threadId.IsEqual(ThreadId::Self()))
83047ecee31Ss.makeev_local 			{
83147ecee31Ss.makeev_local 				return true;
83247ecee31Ss.makeev_local 			}
83347ecee31Ss.makeev_local 		}
83447ecee31Ss.makeev_local 		for (uint32 i = 0; i < waitingThreads.size(); i++)
83547ecee31Ss.makeev_local 		{
83647ecee31Ss.makeev_local 			if (waitingThreads[i].IsEqual(ThreadId::Self()))
83747ecee31Ss.makeev_local 				return true;
83847ecee31Ss.makeev_local 		}
83947ecee31Ss.makeev_local 
84047ecee31Ss.makeev_local 		return false;
84158964d0bSSergey Makeev 	}
84258964d0bSSergey Makeev 
CreateGroup()843806ef292SSergey Makeev 	TaskGroup TaskScheduler::CreateGroup()
844806ef292SSergey Makeev 	{
845806ef292SSergey Makeev 		MT_ASSERT(IsWorkerThread() == false, "Can't use CreateGroup inside Task.");
846806ef292SSergey Makeev 
847754cb997SSergey Makeev 		TaskGroup group;
84860ac17fbSs.makeev_local 		if (!availableGroups.TryPop(group))
849806ef292SSergey Makeev 		{
8506bbc0262SSergey Makeev 			MT_REPORT_ASSERT("Group pool is empty");
851806ef292SSergey Makeev 		}
852806ef292SSergey Makeev 
853754cb997SSergey Makeev 		int idx = group.GetValidIndex();
8544965e494Ss.makeev_local 		MT_USED_IN_ASSERT(idx);
8552e846c40SSergey Makeev 		MT_ASSERT(groupStats[idx].GetDebugIsFree() == true, "Bad logic!");
8569d94a278Ss.makeev_local #if MT_GROUP_DEBUG
8572e846c40SSergey Makeev 		groupStats[idx].SetDebugIsFree(false);
8589d94a278Ss.makeev_local #endif
859806ef292SSergey Makeev 
860806ef292SSergey Makeev 		return group;
861806ef292SSergey Makeev 	}
862806ef292SSergey Makeev 
ReleaseGroup(TaskGroup group)863806ef292SSergey Makeev 	void TaskScheduler::ReleaseGroup(TaskGroup group)
864806ef292SSergey Makeev 	{
865806ef292SSergey Makeev 		MT_ASSERT(IsWorkerThread() == false, "Can't use ReleaseGroup inside Task.");
866754cb997SSergey Makeev 		MT_ASSERT(group.IsValid(), "Invalid group ID");
867806ef292SSergey Makeev 
868754cb997SSergey Makeev 		int idx = group.GetValidIndex();
8694965e494Ss.makeev_local 		MT_USED_IN_ASSERT(idx);
8702e846c40SSergey Makeev 		MT_ASSERT(groupStats[idx].GetDebugIsFree() == false, "Group already released");
8719d94a278Ss.makeev_local #if MT_GROUP_DEBUG
8722e846c40SSergey Makeev 		groupStats[idx].SetDebugIsFree(true);
8739d94a278Ss.makeev_local #endif
874806ef292SSergey Makeev 
87560ac17fbSs.makeev_local 		bool res = availableGroups.TryPush(std::move(group));
87660ac17fbSs.makeev_local 		MT_USED_IN_ASSERT(res);
87760ac17fbSs.makeev_local 		MT_ASSERT(res, "Can't return group to pool");
878806ef292SSergey Makeev 	}
879806ef292SSergey Makeev 
GetGroupDesc(TaskGroup group)880806ef292SSergey Makeev 	TaskScheduler::TaskGroupDescription& TaskScheduler::GetGroupDesc(TaskGroup group)
881806ef292SSergey Makeev 	{
882754cb997SSergey Makeev 		MT_ASSERT(group.IsValid(), "Invalid group ID");
883806ef292SSergey Makeev 
884754cb997SSergey Makeev 		int idx = group.GetValidIndex();
885754cb997SSergey Makeev 		TaskScheduler::TaskGroupDescription & groupDesc = groupStats[idx];
886806ef292SSergey Makeev 
8872e846c40SSergey Makeev 		MT_ASSERT(groupDesc.GetDebugIsFree() == false, "Invalid group");
888806ef292SSergey Makeev 		return groupDesc;
889806ef292SSergey Makeev 	}
8909c716f68Ss.makeev_local 
8919c716f68Ss.makeev_local 
8929c716f68Ss.makeev_local #ifdef MT_INSTRUMENTED_BUILD
8939c716f68Ss.makeev_local 
NotifyFibersCreated(uint32 fibersCount)8949c716f68Ss.makeev_local 	void TaskScheduler::NotifyFibersCreated(uint32 fibersCount)
8959c716f68Ss.makeev_local 	{
8969c716f68Ss.makeev_local 		if (IProfilerEventListener* eventListener = GetProfilerEventListener())
8979c716f68Ss.makeev_local 		{
8989c716f68Ss.makeev_local 			eventListener->OnFibersCreated(fibersCount);
8999c716f68Ss.makeev_local 		}
9009c716f68Ss.makeev_local 	}
9019c716f68Ss.makeev_local 
NotifyThreadsCreated(uint32 threadsCount)9029c716f68Ss.makeev_local 	void TaskScheduler::NotifyThreadsCreated(uint32 threadsCount)
9039c716f68Ss.makeev_local 	{
9049c716f68Ss.makeev_local 		if (IProfilerEventListener* eventListener = GetProfilerEventListener())
9059c716f68Ss.makeev_local 		{
9069c716f68Ss.makeev_local 			eventListener->OnThreadsCreated(threadsCount);
9079c716f68Ss.makeev_local 		}
9089c716f68Ss.makeev_local 	}
9099c716f68Ss.makeev_local 
9109c716f68Ss.makeev_local 
9119c716f68Ss.makeev_local #endif
9129c716f68Ss.makeev_local 
91358964d0bSSergey Makeev }
91402d170cfSs.makeev_local 
91502d170cfSs.makeev_local 
916