Программная реализация простого бесприоритетного планировщика потоков

bool TaskManager::TerminateThread(Thread* pThread)
{
    if(Thread::GetCurrent() != pThread)
    {
        SwitchTaskLock();
        if(Smp)
        {
            //проверить на других CPU -> IPI
            bool no_run;
            if(pThread->IsSleep())
                no_run = pThread->FindFromThreadList(Thread::ShedulerListIterator, &SleepThreadListHead);
            else if(!pThread->IsIdle())
                no_run = pThread->FindFromThreadList(Thread::ShedulerListIterator, &ActivityThreadsListHead);
            else
                no_run = pThread->FindFromThreadList(Thread::ShedulerListIterator, &IdleThreadsListHead);
            if(!no_run)
            {
                SmpTerminateThread = pThread;
                SystemApic::SendIPI(pThread->GetLastCpuId(), SMP_TASK_KILL_VECTOR);
                while(SmpTerminateThread != NULL)
                    CpuPause();
                SwitchTaskUnlock();
                return true;
            }
        }
        if(pThread->IsSleep())
            pThread->DeleteFromThreadList(Thread::ShedulerListIterator, &SleepThreadListHead);
        else if(!pThread->IsIdle())
            pThread->DeleteFromThreadList(Thread::ShedulerListIterator, &ActivityThreadsListHead);
        else
            pThread->DeleteFromThreadList(Thread::ShedulerListIterator, &IdleThreadsListHead);
        SystemThreadCounter--;
        ProcessTerminateThread(pThread);
        SwitchTaskUnlock();
    }
    else
        TerminateCurrentThread();
    return true;
}