/*---------------------------------------------------------------------------* Project: CtrBrom - libraries - OS File: os_irqThreadSwitch.c Copyright 2008 Nintendo. All rights reserved. These coded instructions, statements, and computer programs contain proprietary information of Nintendo of America Inc. and/or Nintendo Company Ltd., and are protected by Federal copyright law. They may not be disclosed to third parties or copied or duplicated in any form, in whole or in part, without the prior written consent of Nintendo. $Date:: $ $Rev$ $Author$ *---------------------------------------------------------------------------*/ #include #include #ifdef SDK_ARM9 #include #endif //---- thread queue for interrupt OSThreadQueue i_osIrqThreadQueue; #ifdef SDK_ARM9 #include #include #endif // osIrqHandler_ThreadSwitch リンク防止のため外部宣言に extern OSIntrFunction i_osIrqThreadSwitch; void osIrqHandler_ThreadSwitch( void ); /*---------------------------------------------------------------------------* Name: i_osEnableIrqThreadSwitch Description: 割り込み割り込みスレッドスイッチ有効化 osInitThread 呼び出し時のみリンクされるようにファイルを分離 Arguments: なし Returns: なし *---------------------------------------------------------------------------*/ void i_osEnableIrqThreadSwitch( void ) { i_osIrqThreadSwitch = osIrqHandler_ThreadSwitch; } /*---------------------------------------------------------------------------* Name: osIRQHandler_ThreadSwitch Description: 割り込み分岐処理（テーブル OS_InterruptTable 引き） Arguments: なし Returns: なし *---------------------------------------------------------------------------*/ asm void osIrqHandler_ThreadSwitch( void ) { INASM_EXTERN( i_osIrqThreadQueue ) INASM_EXTERN( i_osThreadInfo ) INASM_EXTERN( i_osSaveContextVFP ) INASM_EXTERN( i_osLoadContextVFP ) INASM_EXTERN( i_osIrqHandlerReturn ) //-------------------------------------------------- // wakeup threads in i_osIrqThreadQueue //-------------------------------------------------- ldr r12, =i_osIrqThreadQueue mov r3, #0 // avoid stall ldr r12, [r12, #__cpp(offsetof(OSThreadQueue,head))] // r12 = i_osIrqThreadQueue.head mov r2, #__cpp(OS_THREAD_STATE_READY) // avoid stall cmp r12, #0 beq thread_switch // if r12 == 0 exit LSYM(1) str r2, [r12, #__cpp(offsetof(OSThread,state))] str r3, [r12, #__cpp(offsetof(OSThread,queue))] str r3, [r12, #__cpp(offsetof(OSThread,link.prev))] ldr r0, [r12, #__cpp(offsetof(OSThread,link.next))] str r3, [r12, #__cpp(offsetof(OSThread,link.next))] mov r12, r0 cmp r12, #0 bne BSYM(1) ldr r12, =i_osIrqThreadQueue str r3, [r12, #__cpp(offsetof(OSThreadQueue,head))] // clear i_osIrqThreadQueue.head str r3, [r12, #__cpp(offsetof(OSThreadQueue,tail))] // clear i_osIrqThreadQueue.tail ldr r12, =i_osThreadInfo // need to do scheduling mov r1, #1 strh r1, [ r12, #OS_THREADINFO_OFFSET_ISNEEDRESCHEDULING ] thread_switch //-------------------------------------------------- // THREAD SWITCH //-------------------------------------------------- // pseudo code // // if ( isNeedRescheduling == FALSE ) return; // isNeedRescheduling = FALSE; // // // OS_SelectThread // OSThread* t = i_osThreadInfo.list; // while( t && ! OS_IsThreadRunnable( t ) ){ t = t->next; } // return t; // // select: // current = CurrentThread; // if ( next == current ) return; // CurrentThread = next; // OS_SaveContext( current ); // OS_LoadContext( next ); // // [[[ new OS_SelectThread ]]] ldr r12, =i_osThreadInfo ldrh r1, [ r12, #OS_THREADINFO_OFFSET_ISNEEDRESCHEDULING ] cmp r1, #0 beq _dont_switched_ // return if i_osIsNeedResceduling == 0 mov r1, #0 strh r1, [ r12, #OS_THREADINFO_OFFSET_ISNEEDRESCHEDULING ] // ---- OS_SelectThread (disable FIQ to support IS-Debugger snooping thread information) mov r3, #HW_PSR_IRQ_MODE|HW_PSR_FIQ_DISABLE|HW_PSR_IRQ_DISABLE|HW_PSR_ARM_STATE msr cpsr_c, r3 add r2, r12, #OS_THREADINFO_OFFSET_LIST // r2 = &i_osThreadInfo.list ldr r1, [r2] // r1 = *r2 = TopOfList LSYM(11) cmp r1, #0 ldrneh r0, [ r1, #__cpp(OS_THREAD_OFFSET_STATE) ] // r0 = t->state cmpne r0, #__cpp(OS_THREAD_STATE_READY) ldrne r1, [ r1, #__cpp(OS_THREAD_OFFSET_NEXT) ] bne BSYM(11) cmp r1, #0 bne FSYM(12) _dont_switched_ mov r3, #HW_PSR_IRQ_MODE|HW_PSR_IRQ_DISABLE|HW_PSR_ARM_STATE msr cpsr_c, r3 b i_osIrqHandlerReturn // return to interrupted address // not reach here LSYM(12) // ---- OS_GetCurrentThread ldr r0, [ r12, #OS_THREADINFO_OFFSET_CURRENT ] cmp r1, r0 beq _dont_switched_ // return if no thread switching // call thread switch callback (need to save register r0, r1, r12) ldr r3, [ r12, #OS_THREADINFO_OFFSET_SWITCHCALLBACK ] cmp r3, #0 beq FSYM(13) // skip calling callback when callback == 0 stmfd sp!, { r0, r1, r12 } mov lr, pc bx r3 ldmfd sp!, { r0, r1, r12 } LSYM(13) // ---- OS_SetCurrentThread str r1, [ r12, #OS_THREADINFO_OFFSET_CURRENT ] // ---- OS_SaveContext // r0=currentThread r1=nextThread // stack=Lo[LR,R0,R1,R2,R3,R12,LR]Hi mrs r2, SPSR str r2, [ r0, #OS_THREAD_OFFSET_CONTEXT ]! // *r0=context:CPSR #ifdef SDK_CONTEXT_HAS_VFP // first, save VFP context stmfd sp!, { r0, r1 } add r0, r0, #OS_THREAD_OFFSET_CONTEXT bl i_osSaveContextVFP ldmfd sp!, { r0, r1 } #endif ldmia sp!, { r2,r3 } // Get R0,R1 // *sp=stack:R1 stmib r0!, { r2,r3 } // Put R0,R1 // *r0=context:R1 ldmia sp!, { r2-r4,r12,r14 } // Get R2-R4,R12,LR / *sp=stack:LR stmib r0!, { r2-r14 }^ // Put R2-R14^ // *r0=context:R14 stmib r0!, { r14 } // Put R14_irq // *r0=context:R15+4 #ifdef SDK_CONTEXT_HAS_SP_SVC mov r3, #HW_PSR_SVC_MODE|HW_PSR_FIQ_DISABLE|HW_PSR_IRQ_DISABLE|HW_PSR_ARM_STATE msr cpsr_c, r3 stmib r0!, { sp } #endif // ---- OS_LoadContext #ifdef SDK_CONTEXT_HAS_VFP // first, load VFP context stmfd sp!, { r1 } add r0, r1, #OS_THREAD_OFFSET_CONTEXT bl i_osLoadContextVFP ldmfd sp!, { r1 } #endif #ifdef SDK_CONTEXT_HAS_SP_SVC ldr sp, [ r1, #OS_THREAD_OFFSET_CONTEXT+OS_CONTEXT_SP_SVC ] mov r3, #HW_PSR_IRQ_MODE|HW_PSR_FIQ_DISABLE|HW_PSR_IRQ_DISABLE|HW_PSR_ARM_STATE msr cpsr_c, r3 #endif ldr r2, [ r1, #OS_THREAD_OFFSET_CONTEXT ]! // *r1=context:CPSR msr SPSR_cxsf, r2 // Put SPSR ldr r14, [ r1, #OS_CONTEXT_PC_PLUS4 - OS_CONTEXT_CPSR ] // Get R15 ldmib r1, { r0-r14 }^ // Get R0-R14^ // *r1=over written nop stmfd sp!, { r0-r4,r12,r14 } // Put R0-R4,R12,LR / *sp=stack:LR b i_osIrqHandlerReturn // return to irq master handler } #ifdef SDK_ARM9 #include #endif