smp: fixes to idle thread & condition

This commit is contained in:
Edgaru089 2021-11-11 02:16:39 +08:00
parent 2fd9209b85
commit 3aafc2a032

View File

@ -33,9 +33,8 @@ SYSV_ABI uintptr_t __smp_Switch() {
uint64_t priority = UINT64_MAX; uint64_t priority = UINT64_MAX;
// insert the current thread back into the waiting queue // insert the current thread back into the waiting queue
if (t) { if (t)
priority = t->nice + (t->lastTick > __smp_Now ? t->lastTick : __smp_Now); // new priority for the thread priority = t->nice + (t->lastTick > __smp_Now ? t->lastTick : __smp_Now); // new priority for the thread
}
//printTree(__smp_Threads->root, 0, 0); //printTree(__smp_Threads->root, 0, 0);
//printTree(__smp_ThreadsWaiting->root, 0, 0); //printTree(__smp_ThreadsWaiting->root, 0, 0);
tree_Node *first = tree_FirstNode(__smp_ThreadsWaiting); tree_Node *first = tree_FirstNode(__smp_ThreadsWaiting);
@ -46,7 +45,7 @@ SYSV_ABI uintptr_t __smp_Switch() {
first = tree_Node_Next(first); first = tree_Node_Next(first);
} }
if ((t->sleepUntil <= __smp_Now && t->waitCondition == NULL) && first->key > priority) { if (first && (NODE_POINTER(first)->sleepUntil <= __smp_Now && NODE_POINTER(first)->waitCondition == NULL) && first->key > priority) {
// the current thread is still the first, return // the current thread is still the first, return
//io_Printf(" Not context switching, still running %d\n", t ? t->id : 0); //io_Printf(" Not context switching, still running %d\n", t ? t->id : 0);
return 0; return 0;
@ -54,6 +53,7 @@ SYSV_ABI uintptr_t __smp_Switch() {
// we need a real context switch // we need a real context switch
// first save the current thread context // first save the current thread context
if (t) {
t->lastTick = __smp_Now; t->lastTick = __smp_Now;
memcpy(&t->state, &__smp_IntSwitch_LastState, sizeof(smp_thread_State)); memcpy(&t->state, &__smp_IntSwitch_LastState, sizeof(smp_thread_State));
tree_Node *node = 0; tree_Node *node = 0;
@ -63,15 +63,17 @@ SYSV_ABI uintptr_t __smp_Switch() {
priority++; priority++;
} while (!ok); } while (!ok);
NODE_POINTER(node) = t; NODE_POINTER(node) = t;
}
if (!first) { if (!first) {
// no thread available, load a dummy idle thread // no thread available, load a dummy idle thread
__smp_IntSwitch_LastState.rip = (uint64_t)__smp_Switch_Idle; __smp_IntSwitch_LastState.rip = (uint64_t)__smp_Switch_Idle;
__smp_IntSwitch_LastState.rflags |= 1 << 9; // Interrupt Enable flag
__smp_Current[0] = 0; __smp_Current[0] = 0;
io_WriteConsoleASCII("__smp_Switch: Entering idle\n"); //io_WriteConsoleASCII("__smp_Switch: Entering idle\n");
} else { } else {
// load the new context // load the new context
io_Printf(" Context switching, from %d to %d\n", t ? t->id : 0, NODE_POINTER(first)->id); //io_Printf(" Context switching, from %d to %d\n", t ? t->id : 0, NODE_POINTER(first)->id);
memcpy(&__smp_IntSwitch_LastState, &NODE_POINTER(first)->state, sizeof(smp_thread_State)); memcpy(&__smp_IntSwitch_LastState, &NODE_POINTER(first)->state, sizeof(smp_thread_State));
__smp_Current[0] = NODE_POINTER(first); __smp_Current[0] = NODE_POINTER(first);
tree_Delete(__smp_ThreadsWaiting, first); tree_Delete(__smp_ThreadsWaiting, first);