FreeCalypso > hg > tcs211-fcmodem
diff chipsetsw/os/nucleus/tct.s @ 0:509db1a7b7b8
initial import: leo2moko-r1
| author | Space Falcon <falcon@ivan.Harhan.ORG> |
|---|---|
| date | Mon, 01 Jun 2015 03:24:05 +0000 |
| parents | |
| children |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/chipsetsw/os/nucleus/tct.s Mon Jun 01 03:24:05 2015 +0000 @@ -0,0 +1,3073 @@ +;/*************************************************************************/ +;/* */ +;/* Copyright (c) 1993-1994 Accelerated Technology, Inc. */ +;/* */ +;/* PROPRIETARY RIGHTS of Accelerated Technology are involved in the */ +;/* subject matter of this material. All manufacturing, reproduction, */ +;/* use, and sales rights pertaining to this subject matter are governed */ +;/* by the license agreement. The recipient of this software implicitly */ +;/* accepts the terms of the license. */ +;/* */ +;/*************************************************************************/ +; +;/*************************************************************************/ +;/* */ +;/* FILE NAME VERSION */ +;/* */ +;/* tct.s PLUS/THUMB/T 1.2 */ +;/* */ +;/* COMPONENT */ +;/* */ +;/* TC - Thread Control */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This file contains the target processor dependent routines for */ +;/* performing target-dependent scheduling functions. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* DATA STRUCTURES */ +;/* */ +;/* None */ +;/* */ +;/* FUNCTIONS */ +;/* */ +;/* TCT_Control_Interrupts Enable / disable interrupts */ +;/* by changing */ +;/* TCD_Interrupt_Level */ +;/* TCT_Local_Control_Interrupts Enable/disable interrupts */ +;/* by not changing */ +;/* TCD_Interrupt_Level */ +;/* TCT_Restore_Interrupts Restores interrupts to the */ +;/* level in TCD_Interrupt_Level */ +;/* TCT_Build_Task_Stack Build initial task stack */ +;/* TCT_Build_HISR_Stack Build initial HISR stack */ +;/* TCT_Build_Signal_Frame Build signal handler frame */ +;/* TCT_Check_Stack Check current stack */ +;/* TCT_Schedule Schedule the next thread */ +;/* TCT_Control_To_Thread Transfer control to a thread */ +;/* TCT_Control_To_System Transfer control from thread */ +;/* TCT_Signal_Exit Exit from signal handler */ +;/* TCT_Current_Thread Returns a pointer to current */ +;/* thread */ +;/* TCT_Set_Execute_Task Sets TCD_Execute_Task under */ +;/* protection from interrupts */ +;/* TCT_Protect Protect critical section */ +;/* TCT_Unprotect Unprotect critical section */ +;/* TCT_Unprotect_Specific Release specific protection */ +;/* TCT_Set_Current_Protect Set the thread's current */ +;/* protection field */ +;/* TCT_Protect_Switch Switch to protected thread */ +;/* TCT_Schedule_Protected Schedule the protected thread*/ +;/* TCT_Interrupt_Context_Save Save interrupted context */ +;/* TCT_Interrupt_Context_Restore Restore interrupted context */ +;/* TCT_Activate_HISR Activate a HISR */ +;/* TCT_HISR_Shell HISR execution shell */ +;/* */ +;/* DEPENDENCIES */ +;/* */ +;/* cs_extr.h Common Service functions */ +;/* tc_extr.h Thread Control functions */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* B. Sellew 04-19-1996 Added saving and restoring of */ +;/* v5, v6, and ip, resulting in */ +;/* version 1.2 (spr103) */ +;/* P. Roussel (TI) 07-21-1999 Modified TCT_Schedule for GSM */ +;/* small sleep implementation */ +;/* */ +;/*************************************************************************/ +;#define NU_SOURCE_FILE +; +;#include "cs_extr.h" /* Common service functions */ +;#include "tc_extr.h" /* Thread control functions */ +; +;/* Define constants used in low-level initialization. */ +; +; +LOCKOUT .equ 00C0h ; Interrupt lockout value +LOCK_MSK .equ 00C0h ; Interrupt lockout mask value +MODE_MASK .equ 001Fh ; Processor Mode Mask +SUP_MODE .equ 0013h ; Supervisor Mode (SVC) +IRQ_MODE .equ 0012h ; Interrupt Mode (IRQ) +FIQ_MODE .equ 0011h ; Fast Interrupt Mode (FIQ) +; +; +; +;/* Define a variable for saving the system stack limit in. This value is +; intialized in INT.S and is in effect whenever the system stack is in +; use. */ +; +;VOID *TCT_System_Limit; +; +;/* Define internal variables so the C compiler can provide meaningful +; code with offsets into data structures. Typically, this section is +; removed after this file is compiled down to assembly language. */ +; +;BYTE_PTR REG_Stack_Base; +;BYTE_PTR REG_Stack_End; +;BYTE_PTR REG_Stack_Ptr; +;UNSIGNED REG_Stack_Size; +;TC_TCB *REG_Thread_Ptr; +;TC_HCB *REG_HISR_Ptr; +;TC_PROTECT *REG_Protect_Ptr; +;VOID *REG_Function_Ptr; +; + .def _TCT_System_Limit + .bss _TCT_System_Limit, 4, 4 +; +; + .text +; +;/* Define external inner-component global data references. */ +; +;extern TC_TCB *TCD_Execute_Task; +;extern TC_HCB *TCD_Execute_HISR; +;extern VOID *TCD_Current_Thread; +;extern VOID *TCD_System_Stack; +;extern INT TCD_Interrupt_Count; +;extern TC_HCB *TCD_Active_HISR_Heads[TC_HISR_PRIORITIES]; +;extern TC_HCB *TCD_Active_HISR_Tails[TC_HISR_PRIORITIES]; +;extern INT TCD_Interrupt_Level; +;extern UNSIGNED TMD_Time_Slice; +;extern INT TMD_Time_Slice_State; +; + .ref _TCD_Execute_Task + .ref _TCD_Execute_HISR + .ref _TCD_Current_Thread + .ref _TCD_System_Stack + .ref _TCD_Interrupt_Count + .ref _TCD_Active_HISR_Heads + .ref _TCD_Active_HISR_Tails + .ref _TCD_Interrupt_Level + .ref _TMD_Time_Slice + .ref _TMD_Time_Slice_State +; +; +;/* Define external function references. */ +;VOID TCC_Task_Shell(VOID); +;VOID TCC_Signal_Shell(VOID); +;VOID TCT_HISR_Shell(VOID); +;VOID ERC_System_Error(INT error); +; + .ref $TCC_Task_Shell + .ref $TCC_Signal_Shell + .ref $ERC_System_Error + .ref IND_CALL +; +;/* Define internal function references. */ +;VOID TCT_Schedule_Protected(VOID *thread); +; + .def _TCT_Schedule_Protected +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Control_Interrupts */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function enables and disables interrupts as specified by */ +;/* the caller. Interrupts disabled by this call are left disabled */ +;/* until the another call is made to enable them. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* Application */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* new_level New interrupt enable level */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* old_level Previous interrupt enable */ +;/* level */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;INT TCT_Control_Interrupts (INT new_level) +;{ + .def $TCT_Control_Interrupts +$TCT_Control_Interrupts ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Control_Interrupts +; + .def _TCT_Control_Interrupts +_TCT_Control_Interrupts +; +;INT old_level; /* Old interrupt level */ +; +; /* lock out all interrupts before any checking or changing */ +; +; /* Obtain the current interrupt lockout posture. */ +; old_level = TCD_Interrupt_Level; +; +; /* Setup new interrupt lockout posture. */ +; TCD_Interrupt_Level = new_level; +; +; /* renable interrupts for the specified lockout */ +; +; /* Return old interrupt lockout level. */ +; return(old_level); +; + MRS a3,CPSR ; Pickup current CPSR + ORR a3,a3,#LOCKOUT ; Build lockout CPSR + MSR CPSR,a3 ; Lockout interrupts temporarily + LDR a2,Int_Level ; Pickup interrupt level + LDR a4,[a2, #0] ; Pickup current interrupt lockout + BIC a3,a3,#LOCK_MSK ; Clear lockout mask + ORR a3,a3,a1 ; Build new CPSR with appropriate + ; interrupts locked out + STR a1,[a2,#0] ; Save current lockout + MSR CPSR,a3 ; Setup new CPSR lockout bits + MOV a1,a4 ; Return previous lockout + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Local_Control_Interrupts */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function enables and disables interrupts as specified by */ +;/* the caller. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* Application */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* new_level New interrupt enable level */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* old_level Previous interrupt enable */ +;/* level */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;INT TCT_Local_Control_Interrupts (INT new_level) +;{ + .def $TCT_Local_Control_Interrupts +$TCT_Local_Control_Interrupts ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Local_Control_Interrupts +; + .def _TCT_Local_Control_Interrupts +_TCT_Local_Control_Interrupts +; +;INT old_level; /* Old interrupt level */ +; +; /* read in the old level */ +; old_level = current interrupt level of processor; +; + MRS a3,CPSR ; Pickup current CPSR + MOV a4,a3 ; save the old level +; +; /* clear out the old level and set the new level */ +; current interrupt level of processor &= ~LOCKOUT; +; current interrupt level of processor |= new_level; +; + BIC a3,a3,#LOCK_MSK ; Clear all current interrupts + ORR a3,a3,a1 ; Build new CPSR with new + ; interrupt level + MSR CPSR,a3 ; Setup new CPSR interrupt bits +; +; /* Return old interrupt lockout level. */ +; return(old_level); +; + MOV a1,a4 ; Return previous lockout + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Restore_Interrupts */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function restores interrupts to that specified in the global*/ +;/* TCD_Interrupt_Level variable. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* Application */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* None. */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None. */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Restore_Interrupts (VOID) +;{ + .def $TCT_Restore_Interrupts +$TCT_Restore_Interrupts ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Restore_Interrupts +; + .def _TCT_Restore_Interrupts +_TCT_Restore_Interrupts +; +; /* lock out all interrupts before any checking or changing */ +; +; /* Obtain the current interrupt lockout posture. */ +; +; /* reload the level base on the TCD_Interrupt_Level variable */ +; +; + MRS a2,CPSR ; Pickup current CPSR + MOV a3,a2 ; save the CPSR value + ORR a2,a2,#LOCKOUT ; Build lockout CPSR + MSR CPSR,a2 ; Lockout interrupts temporarily + BIC a3,a3,#LOCK_MSK ; Clear current interrupt levels + LDR a2,Int_Level ; Load address of TCD_Interrupt_Level + LDR a1,[a2, #0] ; Pickup current interrupt lockout + ORR a3,a3,a1 ; Build new CPSR with appropriate + ; interrupts locked out + MSR CPSR,a3 ; Setup new CPSR lockout bits + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Build_Task_Stack */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function builds an initial stack frame for a task. The */ +;/* initial stack contains information concerning initial values of */ +;/* registers and the task's point of entry. Furthermore, the */ +;/* initial stack frame is in the same form as an interrupt stack */ +;/* frame. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* TCC_Create_Task Create a new task */ +;/* TCC_Reset_Task Reset the specified task */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* task Task control block pointer */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Build_Task_Stack(TC_TCB *task) +;{ + .def $TCT_Build_Task_Stack +$TCT_Build_Task_Stack ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Build_Task_Stack +; + .def _TCT_Build_Task_Stack +_TCT_Build_Task_Stack +; +; /* Pickup the stack base. */ +; REG_Stack_Base = (BYTE_PTR) task -> tc_stack_start; +; + LDR a3,[a1,#24h] ; Pickup the stack starting address +; +; /* Pickup the stack size. */ +; REG_Stack_Size = task -> tc_stack_size; +; + LDR a2,[a1,#30h] ; Pickup the stack size in bytes +; +; /* Calculate the stack ending address. */ +; REG_Stack_End = REG_Stack_Base + REG_Stack_Size - 1; +; + ADD a4,a2,a3 ; Compute the beginning of stack + BIC a4,a4,#3 ; Insure word alignment + SUB a4,a4,#4 ; Reserve a word +; +; /* Save the stack ending address. */ +; task -> tc_stack_end = REG_Stack_End; +; + STR a4,[a1,#28h] ; Save the stack ending address +; +; /* Reference the task shell. */ +; REG_Function_Ptr = (VOID *) TCC_Task_Shell; +; +; /* Build an initial stack. This initial stack frame facilitates an +; interrupt return to the TCC_Task_Shell function, which in turn +; invokes the application task. The initial stack frame has the +; following format: +; +; (Lower Address) Stack Top -> 1 (Interrupt stack type) +; CPSR Saved CPSR +; a1 Saved a1 +; a2 Saved a2 +; a3 Saved a3 +; a4 Saved a4 +; v1 Saved v1 +; v2 Saved v2 +; v3 Saved v3 +; v4 Saved v4 +; v5 Saved v5 +; v6 Saved v6 +; v7 Saved v7 +; v8 Saved v8 +; ip Saved ip +; sp Saved sp +; lr Saved lr +; (Higher Address) Stack Bottom-> pc Saved pc +; */ +; + LDR a3,Task_Shell ; Pickup address of shell entry + STR a3,[a4], #-4 ; Store entry address on stack + MOV a3,#0 ; Clear value for initial registers + STR a3,[a4], #-4 ; Store initial lr + ADD a3,a4,#8h ; Compute initial sp + STR a3,[a4], #-4 ; Store initial sp (Stack Bottom) + STR ip,[a4], #-4 ; Store ip + STR a3,[a4], #-4 ; Store initial v8 + LDR a3,[a1,#24h] ; Pickup the stack starting address + STR a3,[a4], #-4 ; Store initial v7 + MOV a3,#0 ; Clear value for initial registers + STR v6,[a4], #-4 ; Store v6 + STR v5,[a4], #-4 ; Store v5 + STR a3,[a4], #-4 ; Store initial v4 + STR a3,[a4], #-4 ; Store initial v3 + STR a3,[a4], #-4 ; Store initial v2 + STR a3,[a4], #-4 ; Store initial v1 + STR a3,[a4], #-4 ; Store initial a4 + STR a3,[a4], #-4 ; Store initial a3 + STR a3,[a4], #-4 ; Store initial a2 + STR a3,[a4], #-4 ; Store initial a1 + MSR CPSR_FLG,a3 ; Clear the flags + MRS a3,CPSR ; Pickup the CPSR + BIC a3,a3,#LOCK_MSK ; Clear initial interrupt lockout + ORR a3,a3,#20h ; Set to Thumb state + STR a3,[a4], #-4 ; Store CPSR on the initial stack + MOV a3,#1 ; Build interrupt stack type (1) + STR a3,[a4, #0] ; Store stack type on the top +; +; /* Save the minimum amount of remaining stack memory. */ +; task -> tc_stack_minimum = REG_Stack_Size - 72; +; + MOV a3,#72 ; Size of interrupt stack frame + SUB a2,a2,a3 ; Compute minimum available bytes + STR a2,[a1, #34h] ; Save in minimum stack area +; +; /* Save the new stack pointer into the task's control block. */ +; task -> tc_stack_pointer = (VOID *) Stack_Top; +; + STR a4,[a1, #2Ch] ; Save stack pointer + BX lr +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Build_HISR_Stack */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function builds an HISR stack frame that allows quick */ +;/* scheduling of the HISR. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* TCC_Create_HISR Create HISR function */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* hisr HISR control block pointer */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Build_HISR_Stack(TC_HCB *hisr) +;{ + .def $TCT_Build_HISR_Stack +$TCT_Build_HISR_Stack ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Build_HISR_Stack +; + .def _TCT_Build_HISR_Stack +_TCT_Build_HISR_Stack +; +; /* Pickup the stack base. */ +; REG_Stack_Base = (BYTE_PTR) hisr -> tc_stack_start; +; + LDR a3,[a1,#24h] ; Pickup the stack starting address +; +; /* Pickup the stack size. */ +; REG_Stack_Size = hisr -> tc_stack_size; +; + LDR a2,[a1,#30h] ; Pickup the stack size in bytes +; +; /* Calculate the stack ending address. */ +; REG_Stack_End = REG_Stack_Base + REG_Stack_Size; +; + ADD a4,a2,a3 ; Compute the beginning of stack + BIC a4,a4,#3 ; Insure word alignment + SUB a4,a4,#4 ; Reserve a word +; +; /* Save the stack ending address. */ +; hisr -> tc_stack_end = REG_Stack_End; +; + STR a4,[a1,#28h] ; Save the stack ending address +; +; /* Reference the HISR shell. */ +; REG_Function_Ptr = (VOID *) TCT_HISR_Shell; +; +; /* Build an initial stack. This initial stack frame facilitates an +; solicited return to the TCT_HISR_Shell function, which in turn +; invokes the appropriate HISR. The initial HISR stack frame has the +; following format: +; +; (Lower Address) Stack Top -> 0 (Solicited stack type) +; 0/0x20 Saved state mask +; v1 Saved v1 +; v2 Saved v2 +; v3 Saved v3 +; v4 Saved v4 +; v5 Saved v5 +; v6 Saved v6 +; v7 Saved v7 +; v8 Saved v8 +; ip Saved ip +; (Higher Address) Stack Bottom-> pc Saved pc +; */ +; + LDR a3,HISR_Shell ; Pickup address of shell entry + STR a3,[a4], #-4 ; Store entry address on stack + ADD a3,a4,#4h ; Compute initial sp + STR ip,[a4], #-4 ; Store ip + STR a3,[a4], #-4 ; Store initial v8 + LDR a3,[a1,#24h] ; Pickup the stack starting address + STR a3,[a4], #-4 ; Store initial v7 + MOV a3,#0 ; Clear value for initial registers + STR v6,[a4], #-4 ; Store v6 + STR v5,[a4], #-4 ; Store v5 + STR a3,[a4], #-4 ; Store initial v4 + STR a3,[a4], #-4 ; Store initial v3 + STR a3,[a4], #-4 ; Store initial v2 + STR a3,[a4], #-4 ; Store initial v1 + STR a3,[a4], #-4 ; Store initial state mask + STR a3,[a4, #0] ; Store solicited stack type on the + ; top of the stack +; +; /* Save the minimum amount of remaining stack memory. */ +; hisr -> tc_stack_minimum = REG_Stack_Size - 44; +; + MOV a3,#44 ; Size of solicited stack frame + SUB a2,a2,a3 ; Compute minimum available bytes + STR a2,[a1, #34h] ; Save in minimum stack area +; +; /* Save the new stack pointer into the task's control block. */ +; hisr -> tc_stack_pointer = (VOID *) Stack_Top; +; + STR a4,[a1, #2Ch] ; Save stack pointer + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Build_Signal_Frame */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function builds a frame on top of the task's stack to */ +;/* cause the task's signal handler to execute the next time */ +;/* the task is executed. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* TCC_Send_Signals Send signals to a task */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* task Task control block pointer */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Build_Signal_Frame(TC_TCB *task) +;{ + .def $TCT_Build_Signal_Frame +$TCT_Build_Signal_Frame ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Build_Signal_Frame +; + .def _TCT_Build_Signal_Frame +_TCT_Build_Signal_Frame +; +; /* Pickup the stack pointer. */ +; REG_Stack_Ptr = (BYTE_PTR) task -> tc_stack_pointer; +; + LDR a4,[a1,#2ch] ; Pickup the current stack pointer +; +; /* Reference the Signal shell. */ +; REG_Function_Ptr = (VOID *) TCC_Signal_Shell; +; +; /* Build a signal stack. This signal stack frame facilitates an +; solicited return to the TCC_Signal_Shell function, which in turn +; invokes the appropriate signal handler. The initial HISR stack frame +; has the following format: +; +; (Lower Address) Stack Top -> 0 (Solicited stack type) +; 0/0x20 Saved state mask +; v1 Saved v1 +; v2 Saved v2 +; v3 Saved v3 +; v4 Saved v4 +; v5 Saved v5 +; v6 Saved v6 +; v7 Saved v7 +; v8 Saved v8 +; ip Saved ip +; (Higher Address) Stack Bottom-> pc Saved pc +; */ +; + LDR a3,Signal_Shell ; Pickup address of shell entry + STR a3,[a4], #-4 ; Store entry address on stack + ADD a3,a4,#4h ; Compute initial sp + STR ip,[a4], #-4 ; Store ip + STR a3,[a4], #-4 ; Store initial v8 + LDR a3,[a1,#24h] ; Pickup the stack starting address + STR a3,[a4], #-4 ; Store initial v7 + MOV a3,#0 ; Clear value for initial registers + STR v6,[a4], #-4 ; Store v6 + STR v5,[a4], #-4 ; Store v5 + STR a3,[a4], #-4 ; Store initial v4 + STR a3,[a4], #-4 ; Store initial v3 + STR a3,[a4], #-4 ; Store initial v2 + STR a3,[a4], #-4 ; Store initial v1 + MOV a2,#20h ; Get initial state mask + STR a2,[a4, #0] ; Store initial state mask + STR a3,[a4, #0] ; Store solicited stack type on the + ; top of the stack +; +; /* Save the new stack pointer into the task's control block. */ +; task -> tc_stack_pointer = (VOID *) (REG_Stack_Ptr - REG_Stack_Size); +; + STR a4,[a1, #2Ch] ; Save stack pointer + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Check_Stack */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function checks the current stack for overflow conditions. */ +;/* Additionally, this function keeps track of the minimum amount */ +;/* of stack space for the calling thread and returns the current */ +;/* available stack space. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* TCC_Send_Signals Send signals to a task */ +;/* */ +;/* CALLS */ +;/* */ +;/* ERC_System_Error System error handler */ +;/* */ +;/* INPUTS */ +;/* */ +;/* None */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* available bytes in stack */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;UNSIGNED TCT_Check_Stack(void) +;{ + .def $TCT_Check_Stack +$TCT_Check_Stack ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Check_Stack +; + .def _TCT_Check_Stack +_TCT_Check_Stack +; +;TC_TCB *thread; +;UNSIGNED remaining; +; +; /* Pickup the current task/HISR pointer. */ +; thread = (TC_TCB *) TCD_Current_Thread; +; + LDR a1,Current_Thread ; Pickup address of thread pointer + LDR a1,[a1,#0] ; Pickup thread pointer +; +; /* Determine if there is a current thread. */ +; if (thread) +; { +; + CMP a1,#0 ; Determine if a thread is active + MOV a4,#0 ; Default remaining value + BEQ TCT_Skip_Stack_Check ; If NU_NULL, skip stack checking +; +; /* Determine if the stack pointers are out of range. */ +; if ((thread -> tc_stack_pointer < thread -> tc_stack_start) || +; (thread -> tc_stack_pointer > thread -> tc_stack_end)) +; + LDR a3,[a1,#24h] ; Pickup start of stack area + CMP sp,a3 ; Compare with current stack ptr + BLT TCT_Stack_Range_Error ; If less, stack is out of range + LDR a2,[a1,#28h] ; Pickup end of stack area + CMP sp,a2 ; Compare with current stack ptr + BLE TCT_Stack_Range_Okay ; If less, stack range is okay +; +; /* Stack overflow condition exits. */ +; ERC_System_Error(NU_STACK_OVERFLOW); +; +TCT_Stack_Range_Error +; + STR lr,[sp, #4]! ; Store lr on the stack + MOV a1,#3 ; Build NU_STACK_OVERFLOW code + LDR a4,System_Error ; Call system error handler. Note: + BX a4 ; control is not returned! + ; Examine stack to find return + ; address of this routine. +TCT_Stack_Range_Okay +; +; /* Calculate the amount of available space on the stack. */ +; remaining = (BYTE_PTR) thread -> tc_stack_pointer - +; (BYTE_PTR) thread -> tc_stack_start; +; + SUB a4,sp,a3 ; Calculate remaining stack size +; +; /* Determine if there is enough memory on the stack to save all of the +; registers. */ +; if (remaining < 80) +; + CMP a4,#80 ; Is there enough room for an + ; interrupt frame? + BCS TCT_No_Stack_Error ; If so, no stack overflow yet +; +; /* Stack overflow condition is about to happen. */ +; ERC_System_Error(NU_STACK_OVERFLOW); +; + STR lr,[sp, #4]! ; Store lr on the stack + MOV a1,#3 ; Build NU_STACK_OVERFLOW code + LDR a4,System_Error ; Call system error handler. Note: + BX a4 ; control is not returned! + ; Examine stack to find return + ; address of this routine. +TCT_No_Stack_Error +; +; /* Determine if this is a new minimum amount of stack space. */ +; if (remaining < thread -> tc_stack_minimum) +; + LDR a3,[a1,#34h] + CMP a4,a3 + STRCC a4,[a1,#34h] +; +; /* Save the new stack minimum. */ +; thread -> tc_stack_minimum = remaining; +; } +; else +; +; /* Set the remaining bytes to 0. */ +; remaining = 0; +; +; /* Return the remaining number of bytes on the stack. */ +; return(remaining); +; +TCT_Skip_Stack_Check + MOV a1,a4 ; Return remaining bytes + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCC_Schedule */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function waits for a thread to become ready. Once a thread */ +;/* is ready, this function initiates a transfer of control to that */ +;/* thread. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* INC_Initialize Main initialization routine */ +;/* */ +;/* CALLS */ +;/* */ +;/* TCT_Control_To_Thread Transfer control to a thread */ +;/* INT_Small_Sleep GSM small sleep */ +;/* INPUTS */ +;/* */ +;/* TCD_Execute_Task Pointer to task to execute */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* P. Roussel (TI) 07-21-1999 Call GSM small sleep */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Schedule(void) +;{ + .def $TCT_Schedule +$TCT_Schedule ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Schedule +; + .def _TCT_Schedule +_TCT_Schedule +; +; /* Restore interrupts according to the value contained in +; TCD_Interrupt_Level. */ +; + LDR a2,Int_Level ; Build address of interrupt level + MRS a1,CPSR ; Pickup current CPSR + LDR a3,[a2, #0] ; Pickup current interrupt lockout + BIC a1,a1,#LOCK_MSK ; Clear the interrupt lockout bits + ORR a1,a1,a3 ; Build new interrupt lockout CPSR + MSR CPSR,a1 ; Setup new CPSR + LDR a3,Execute_HISR ; Pickup TCD_Execute_HISR address + LDR a4,Execute_Task ; Pickup TCD_Execute_Task address +; +; /* Wait until a thread (task or HISR) is available to execute. */ +; do +; { + .def TCT_Schedule_Loop +TCT_Schedule_Loop +; +; } while ((!TCD_Execute_HISR) && (!TCD_Execute_Task)); +; + LDR a1,[a3, #0] ; Pickup highest priority HISR ptr + CMP a1,#0 ; Is there a HISR active? + BNE TCT_Schedule_Thread ; Found an HISR + LDR a1,[a4, #0] ; Pickup highest priority Task ptr + CMP a1,#0 ; Is there a task active? + + .ref INT_Small_Sleep + BEQ INT_Small_Sleep ; No, enter the GSM Small Sleep mode + +; +; /* Yes, either a task or an HISR is ready to execute. Lockout +; interrupts while the thread is transferred to. */ +; +TCT_Schedule_Thread + MRS a2,CPSR ; Pickup CPSR again + ORR a2,a2,#LOCKOUT ; Build interrupt lockout value + MSR CPSR,a2 ; Lockout interrupts +; +; /* Transfer control to the thread by falling through to the following +; routine. */ +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Control_To_Thread */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function transfers control to the specified thread. Each */ +;/* time control is transferred to a thread, its scheduled counter */ +;/* is incremented. Additionally, time-slicing for task threads is */ +;/* enabled in this routine. The TCD_Current_Thread pointer is */ +;/* setup by this function. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* TCT_Schedule Indirectly called */ +;/* TCT_Protect Protection task switch */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* thread Thread control block pointer */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Control_To_Thread(TC_TCB *thread) +;{ +; +_TCT_Control_To_Thread +; +; /* Setup the current thread pointer. */ +; TCD_Current_Thread = (VOID *) thread; +; + LDR a2,Current_Thread ; Pickup current thread ptr address + LDR a3,[a1, #1ch] ; Pickup scheduled count + STR a1,[a2, #0] ; Setup current thread pointer +; TI CODE : Call the Function that log the Current Thread. + + .if OP_L1_STANDALONE = 0 + .if TI_NUC_MONITOR = 1 + .global _ti_nuc_monitor_Thread_log + STMFD sp!,{r0-r5} + BL _ti_nuc_monitor_Thread_log ; Call the Thread Log function. + LDMFD sp!,{r0-r5} + .endif + .endif +; +; /* Increment the thread scheduled counter. */ +; thread -> tc_scheduled++; +; + LDR a4,[a1, #20h] ; Pickup time slice value + ADD a3,a3,#1 ; Increment the scheduled count + STR a3,[a1, #1ch] ; Store new scheduled count +; +; /* Check for time slice option. */ +; if (thread -> tc_cur_time_slice) +; { + CMP a4,#0 ; Is there a time slice? + BEQ TCT_No_Start_TS_1 ; If 0, there is no time slice +; +; /* Start a time slice. */ +; TMD_Time_Slice = thread -> tc_cur_time_slice; +; TMD_Time_Slice_State = 0; +; + LDR a3,Time_Slice ; Pickup address of TMD_Time_Slice + LDR a2,Slice_State ; Pickup address of + ; TMD_Time_Slice_State + STR a4,[a3,#0] ; Setup the time slice + MOV a3,#0 ; Build active state flag + STR a3,[a2,#0] ; Set the active flag +; } +TCT_No_Start_TS_1 +; +; /* Pickup the stack pointer and resume the thread. */ +; REG_Stack_Ptr = thread -> tc_stack_pointer; +; + LDR sp,[a1, #2ch] ; Switch to thread's stack pointer +; +; /* Pop off the saved information associated with the thread. After we +; determine which type of stack is present. A 1 on the top of the +; stack indicates an interrupt stack, while a 0 on the top of the +; stack indicates a solicited type of stack. */ +; +; /* Remember that the interrupt level that is restored must represent +; the interrupt level in TCD_Interrupt_Level. */ +; + LDR a2,[sp], #4 ; Pop off the stack type + CMP a2,#1 ; See if it is an interrupt stack + BEQ TCT_Interrupt_Resume ; If so, an interrupt resume of + ; thread is required + LDR a2,Int_Level ; Pickup address of interrupt + ; lockout + MRS a1,CPSR ; Pickup current CPSR + BIC a1,a1,#LOCK_MSK ; Clear lockout mask + LDR a3,[a2, #0] ; Pickup interrupt lockout mask + ORR a1,a1,a3 ; Build new interrupt lockout mask + LDR a3,[sp], #4 ; Pop off the state mask + ORR a1,a1,a3 ; Set appropriate state + MSR SPSR,a1 ; Place in the SPSR + LDMIA sp!,{v1-ip,pc}^ ; A solicited return is required. +; +TCT_Interrupt_Resume + LDR a1,[sp],#4 ; Pop off the CPSR + LDR a2,Int_Level ; Pickup address of interrupt + ; lockout + BIC a1,a1,#LOCK_MSK ; Clear lockout mask + LDR a3,[a2, #0] ; Pickup interrupt lockout mask + ORR a1,a1,a3 ; Build new interrupt lockout mask + MSR SPSR,a1 ; Place it into the SPSR + LDMIA sp,{a1-pc}^ ; Recover all registers and resume + ; at point of interrupt +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Control_To_System */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function returns control from a thread to the system. Note */ +;/* that this service is called in a solicited manner, i.e. it is */ +;/* not called from an interrupt thread. Registers required by the */ +;/* compiler to be preserved across function boundaries are saved by */ +;/* this routine. Note that this is usually a sub-set of the total */ +;/* number of available registers. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* Other Components */ +;/* */ +;/* CALLS */ +;/* */ +;/* TCT_Schedule Schedule the next thread */ +;/* */ +;/* INPUTS */ +;/* */ +;/* None */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Control_To_System(void) +;{ + .def $TCT_Control_To_System +$TCT_Control_To_System ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Control_To_System +; + .def _TCT_Control_To_System +_TCT_Control_To_System +; +; /* Lockout interrupts. */ +; + MRS a1,CPSR ; Pickup current CPSR + ORR a1,a1,#LOCKOUT ; Build interrupt lockout value + MSR CPSR,a1 ; Lockout interrupts +; +; /* Save a minimal context of the thread. */ +; + STMDB sp!,{v1-ip,lr} ; Save minimal context of thread on + ; the current stack + MOV a3,lr ; Determine what state the + MOV a3,a3,LSL #31 ; caller was in and build an + MOV a3,a3,LSR #26 ; appropriate state mask + STR a3,[sp, #-4]! ; Place it on the stack + MOV a3,#0 ; Build solicited stack type value + ; and NU_NULL value + STR a3,[sp, #-4]! ; Place it on the top of the stack +; +; /* Setup a pointer to the thread control block. */ +; REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread; +; + LDR a2,Current_Thread ; Pickup current thread ptr address + LDR a1,[a2, #0] ; Pickup current thread pointer +; +; /* Clear the current thread control block pointer. */ +; TCD_Current_Thread = NU_NULL; +; + LDR a4,Slice_State ; Pickup time slice state address + STR a3,[a2, #0] ; Set current thread pointer to + ; NU_NULL +; +; /* Check to see if a time slice is active. If so, copy the original time +; slice into the current time slice field of the task's control block. */ +; if (TMD_Time_Slice_State == 0) +; { + LDR a2,[a4, #0] ; Pickup time slice state flag + CMP a2,#0 ; Compare with active value + BNE TCT_No_Stop_TS_1 ; If non-active, don't disable +; +; +; /* Insure that the next time the task runs it gets a fresh time +; slice. */ +; REG_Thread_Ptr -> tc_cur_time_slice = REG_Thread_Ptr -> tc_time_slice; +; + LDR a2,[a1, #40h] ; Pickup original time slice +; +; /* Clear any active time slice by setting the state to NOT_ACTIVE. */ +; TMD_Time_Slice_State = 1; +; + MOV a3,#1 ; Build disable value + STR a3,[a4, #0] ; Disable time slice + STR a2,[a1, #20h] ; Reset current time slice +; } +TCT_No_Stop_TS_1 +; +; /* Save off the current stack pointer in the control block. */ +; REG_Thread_Ptr -> tc_stack_pointer = (VOID *) REG_Stack_Ptr; +; + STR sp,[a1, #2ch] ; Save the thread's stack pointer +; +; /* Clear the task's current protection. */ +; (REG_Thread_Ptr -> tc_current_protect) -> tc_tcb_pointer = NU_NULL; +; REG_Thread_Ptr -> tc_current_protect = NU_NULL; +; + LDR a2,[a1, #38h] ; Pickup current thread pointer + MOV a3,#0 ; Build NU_NULL value + STR a3,[a1, #38h] ; Clear the protect pointer field + STR a3,[a2, #0] ; Release the actual protection +; +; /* Switch to the system stack. */ +; REG_Stack_Ptr = TCD_System_Stack; +; + LDR a2,System_Stack ; Pickup address of stack pointer + LDR a3,System_Limit ; Pickup address of stack limit ptr + LDR sp,[a2, #0] ; Switch to system stack + LDR v7,[a3, #0] ; Setup system stack limit +; +; /* Finished, return to the scheduling loop. */ +; + B _TCT_Schedule ; Return to scheduling loop +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Signal_Exit */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function exits from a signal handler. The primary purpose */ +;/* of this function is to clear the scheduler protection and switch */ +;/* the stack pointer back to the normal task's stack pointer. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* TCC_Signal_Shell Signal handling shell func */ +;/* */ +;/* CALLS */ +;/* */ +;/* TCT_Schedule Scheduler */ +;/* */ +;/* INPUTS */ +;/* */ +;/* None */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Signal_Exit(void) +;{ + .def $TCT_Signal_Exit +$TCT_Signal_Exit ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Signal_Exit +; + .def _TCT_Signal_Exit +_TCT_Signal_Exit +; +; /* Lockout interrupts. */ +; + MRS a4,CPSR ; Pickup current CPSR + ORR a4,a4,#LOCKOUT ; Build lockout value + MSR CPSR,a4 ; Lockout interrupts +; +; /* Setup a pointer to the thread control block. */ +; REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread; +; + LDR a2,Current_Thread ; Pickup address of thread pointer + MOV a3,#0 ; Build NU_NULL value + LDR a1,[a2,#0] ; Pickup current thread pointer +; +; /* Clear the current thread control block. */ +; TCD_Current_Thread = NU_NULL; +; + LDR a4,Slice_State ; Pickup time slice state address + STR a3,[a2, #0] ; Clear current thread pointer +; +; /* Check to see if a time slice is active. If so, copy the original time +; slice into the current time slice field of the task's control block. */ +; if (TMD_Time_Slice_State == 0) +; { +; + LDR a2,[a4, #0] ; Pickup time slice state flag + CMP a2,#0 ; Compare with active value + BNE TCT_No_Stop_TS_2 ; If non-active, don't disable +; +; /* Insure that the next time the task runs it gets a fresh time +; slice. */ +; REG_Thread_Ptr -> tc_cur_time_slice = REG_Thread_Ptr -> tc_time_slice; +; + LDR a2,[a1, #40h] ; Pickup original time slice +; +; /* Clear any active time slice by setting the state to NOT_ACTIVE. */ +; TMD_Time_Slice_State = 1; +; + MOV a3,#1 ; Build disable value + STR a3,[a4, #0] ; Disable time slice + STR a2,[a1, #20h] ; Reset current time slice +; } +TCT_No_Stop_TS_2 +; +; /* Switch back to the saved stack. The saved stack pointer was saved +; before the signal frame was built. */ +; REG_Thread_Ptr -> tc_stack_pointer = +; REG_Thread_Ptr -> tc_saved_stack_ptr; +; + LDR a2,[a1, #3ch] ; Pickup saved stack pointer + STR a2,[a1, #2ch] ; Place in current stack pointer +; +; /* Clear the task's current protection. */ +; (REG_Thread_Ptr -> tc_current_protect) -> tc_tcb_pointer = NU_NULL; +; REG_Thread_Ptr -> tc_current_protect = NU_NULL; +; + LDR a2,[a1, #38h] ; Pickup current thread pointer + MOV a3,#0 ; Build NU_NULL value + STR a3,[a1, #38h] ; Clear the protect pointer field + STR a3,[a2, #0] ; Release the actual protection +; +; /* Switch to the system stack. */ +; REG_Stack_Ptr = (BYTE_PTR) TCD_System_Stack; +; + LDR a2,System_Stack ; Pickup address of stack pointer + LDR a3,System_Limit ; Pickup address of stack limit ptr + LDR sp,[a2, #0] ; Switch to system stack + LDR v7,[a3, #0] ; Setup system stack limit +; +; /* Finished, return to the scheduling loop. */ +; + B _TCT_Schedule ; Return to scheduling loop +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Current_Thread */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function returns the current thread pointer. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* Application */ +;/* System Components */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* None */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* Pointer to current thread */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID *TCT_Current_Thread(void) +;{ + .def $TCT_Current_Thread +$TCT_Current_Thread ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Current_Thread +; + .def _TCT_Current_Thread +_TCT_Current_Thread +; +; /* Return the current thread pointer. */ +; return(TCD_Current_Thread); +; + LDR a1,Current_Thread ; Pickup address of thread pointer + LDR a1,[a1, #0] ; Pickup current thread pointer + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Set_Execute_Task */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function sets the current task to execute variable under */ +;/* protection against interrupts. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* TCC Scheduling Routines */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* task Pointer to task control block*/ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* TCD_Execute_Task Modified variable */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Set_Execute_Task(TC_TCB *task) +;{ + .def $TCT_Set_Execute_Task +$TCT_Set_Execute_Task ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Set_Execute_Task +; + .def _TCT_Set_Execute_Task +_TCT_Set_Execute_Task +; +; /* Now setup the TCD_Execute_Task pointer. */ +; TCD_Execute_Task = task; +; + LDR a2,Execute_Task ; Pickup execute task ptr address + STR a1,[a2,#0] ; Setup new task to execute + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Protect */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function protects against multiple thread access. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* Application */ +;/* System Components */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* protect Pointer to protection block */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Protect(TC_PROTECT *protect) +;{ + .def $TCT_Protect +$TCT_Protect ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Protect +; + .def _TCT_Protect +_TCT_Protect +; +; /* Determine if the caller is in a task or HISR thread. */ +; if (TCD_Current_Thread) +; { +; + LDR a2,Current_Thread ; Pickup current thread ptr address + LDR a4,[a2, #0] ; Pickup current thread pointer + CMP a4,#0 ; Check to see if it is non-NULL + BEQ TCT_Skip_Protect ; If NULL, skip protection +; +; /* Lockout interrupts. */ +; + MRS a2,CPSR ; Pickup current CPSR + ORR a2,a2,#LOCKOUT ; Place lockout value in + MSR CPSR,a2 ; Lockout interrupts +; +; /* Wait until the protect structure is available. */ +; while (protect -> tc_tcb_pointer != NU_NULL) +; { +; +TCT_Protect_Loop + LDR a2,[a1, #0] ; Pickup protection owner field + CMP a2,#0 ; Is there any protection? + BEQ TCT_Protect_Available ; If NU_NULL, no current protection +; +; /* Protection structure is not available. */ +; +; /* Indicate that another thread is waiting. */ +; protect -> tc_thread_waiting = 1; +; + MOV a3,#1 ; Build thread waiting flag + STR a3,[a1, #4] ; Set waiting field +; +; /* Directly schedule the thread waiting. */ +; TCT_Schedule_Protected(protect -> tc_tcb_pointer); +; + STR a1,[sp, #-4]! ; Save a1 on the stack + STR lr,[sp, #-4]! ; Save lr on the stack + MOV a1,a4 ; Place current thread into a1 + BL _TCT_Schedule_Protected ; Call routine to schedule the + ; owner of the thread +; + LDR lr,[sp], #4 ; Recover saved lr + LDR a1,[sp], #4 ; Recover saved a1 +; +; /* Lockout interrupts. */ +; + LDR a2,Current_Thread ; Pickup current thread ptr address + LDR a4,[a2, #0] ; Pickup current thread pointer + MRS a2,CPSR ; Pickup current CPSR + ORR a2,a2,#LOCKOUT ; Place lockout value in + MSR CPSR,a2 ; Lockout interrupts + B TCT_Protect_Loop ; Examine protect flags again +; } +TCT_Protect_Available +; +; /* Protection structure is available. */ +; +; /* Indicate that this thread owns the protection. */ +; protect -> tc_tcb_pointer = TCD_Current_Thread; +; + STR a4,[a1, #0] ; Indicate calling thread owns this + ; protection +; +; /* Clear the thread waiting flag. */ +; protect -> tc_thread_waiting = 0; +; + MOV a3,#0 ; Clear value + STR a3,[a1, #4] ; Clear the thread waiting flag +; +; /* Save the protection pointer in the thread's control block. Note +; that both task and HISR threads share the same control block +; format. */ +; REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread; +; REG_Thread_Ptr -> tc_current_protect = protect; +; + STR a1,[a4, #38h] ; Setup current protection +; +; /* Restore interrupts. */ +; + LDR a3,Int_Level ; Pickup address of interrupt level + MRS a2,CPSR ; Pickup current CPSR + LDR a4,[a3, #0] ; Pickup interrupt lockout level + BIC a2,a2,#LOCK_MSK ; Clear lockout bits + ORR a2,a2,a4 ; Build new interrupt lockout + MSR CPSR,a2 ; Setup CPSR appropriately +; } +; +TCT_Skip_Protect + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Unprotect */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function releases protection of the currently active */ +;/* thread. If the caller is not an active thread, then this */ +;/* request is ignored. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* Application */ +;/* System Components */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* None */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Unprotect(void) +;{ + .def $TCT_Unprotect +$TCT_Unprotect ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Unprotect +; + .def _TCT_Unprotect +_TCT_Unprotect +; +; +; /* Determine if the caller is in a task or HISR thread. */ +; if (TCD_Current_Thread) +; { +; + LDR a2,Current_Thread ; Pickup current thread ptr address + LDR a4,[a2, #0] ; Pickup current thread pointer + CMP a4,#0 ; Check to see if it is non-NULL + BEQ TCT_Skip_Unprotect ; If NULL, skip unprotection +; +; /* Setup a thread control block pointer. */ +; REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread; +; +; /* Determine if there is a currently active protection. */ +; if (REG_Thread_Ptr -> tc_current_protect) +; { +; + LDR a1,[a4, #38h] ; Pickup current protect field + CMP a1,#0 ; Is there a protection in force? + BEQ TCT_Skip_Unprotect ; If not, nothing is protected +; +; /* Lockout interrupts. */ +; + MRS a2,CPSR ; Pickup current CPSR + ORR a2,a2,#LOCKOUT ; Place lockout value in + MSR CPSR,a2 ; Lockout interrupts +; +; /* Yes, this thread still has this protection structure. */ +; REG_Protect_Ptr = REG_Thread_Ptr -> tc_current_protect; +; +; /* Is there a higher priority thread waiting for the protection +; structure? */ +; if (REG_Protect_Ptr -> tc_thread_waiting) +; + LDR a3,[a1, #4] ; Pickup thread waiting flag + CMP a3,#0 ; Are there any threads waiting? + BEQ TCT_Not_Waiting_Unpr ; If not, just release protection +; +; /* Transfer control to the system. Note that this +; automatically clears the current protection and it returns +; to the caller of this routine instead of this routine. */ +; TCT_Control_To_System(); +; + B _TCT_Control_To_System ; Return control to the system +; +; else +; { +TCT_Not_Waiting_Unpr +; +; /* Clear the protection. */ +; REG_Thread_Ptr -> tc_current_protect = NU_NULL; +; REG_Protect_Ptr -> tc_tcb_pointer = NU_NULL; +; + MOV a3,#0 ; Build NU_NULL value + STR a3,[a1, #0] ; Release the protection + STR a3,[a4, #38h] ; Clear protection pointer in the + ; control block +; +; } +; +TCT_Not_Protected +; /* Restore interrupts again. */ +; + LDR a3,Int_Level ; Pickup address of interrupt level + MRS a2,CPSR ; Pickup current CPSR + LDR a4,[a3, #0] ; Pickup interrupt lockout level + BIC a2,a2,#LOCK_MSK ; Clear lockout bits + ORR a2,a2,a4 ; Build new interrupt lockout + MSR CPSR,a2 ; Setup CPSR appropriately +; +; } +; } +TCT_Skip_Unprotect + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Unprotect_Specific */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function releases a specific protection structure. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* Application */ +;/* System Components */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* protect Pointer to protection block */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Unprotect_Specific(TC_PROTECT *protect) +;{ + .def $TCT_Unprotect_Specific +$TCT_Unprotect_Specific ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Unprotect_Specific +; + .def _TCT_Unprotect_Specific +_TCT_Unprotect_Specific +; +; /* Determine if the caller is in a task or HISR thread. */ +; if (TCD_Current_Thread) +; { +; + LDR a2,Current_Thread ; Pickup current thread ptr address + LDR a4,[a2, #0] ; Pickup current thread pointer + CMP a4,#0 ; Check to see if it is non-NULL + BEQ TCT_Skip_Unprot_Spec ; If NULL, skip unprotect specific +; +; /* Lockout interrupts. */ +; + MRS a2,CPSR ; Pickup current CPSR + ORR a2,a2,#LOCKOUT ; Place lockout value in + MSR CPSR,a2 ; Lockout interrupts +; +; /* Clear the protection pointer. */ +; protect -> tc_tcb_pointer = NU_NULL; +; + MOV a3,#0 ; Build NU_NULL value + STR a3,[a1, #0] ; Clear protection ownership +; +; /* Determine if a thread is waiting. */ +; if (protect -> tc_thread_waiting) +; { +; + LDR a2,[a1, #4] ; Pickup the waiting field + CMP a2,#0 ; Is there another thread waiting? + BEQ TCT_Not_Waiting_Unspec ; No, restore interrupts and return +; +; /* A higher-priority thread is waiting. */ +; +; /* Save a minimal context of the thread. */ +; + STMDB sp!,{v1-ip,lr} ; Save minimal context of thread on + ; the current stack + MOV a3,lr ; Determine what state the + MOV a3,a3,LSL #31 ; caller was in and build an + MOV a3,a3,LSR #26 ; appropriate state mask + STR a3,[sp, #-4]! ; Place it on the stack + MOV a3,#0 ; Build solicited stack type value + ; and NU_NULL value + STR a3,[sp, #-4]! ; Place it on the top of the stack +; +; /* Setup a pointer to the thread control block. */ +; REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread; +; + LDR a2,Current_Thread ; Pickup current thread ptr address + LDR a1,[a2, #0] ; Pickup current thread pointer +; +; /* Clear the current thread control block pointer. */ +; TCD_Current_Thread = NU_NULL; +; + LDR a4,Slice_State ; Pickup time slice state address + STR a3,[a2, #0] ; Set current thread pointer to + ; NU_NULL +; +; /* Check to see if a time slice is active. If so, copy the +; original time slice into the current time slice field of the +; thread's control block. */ +; if (TMD_Time_Slice_State == 0) +; { +; + LDR a2,[a4, #0] ; Pickup time slice state flag + CMP a2,#0 ; Compare with active value + BNE TCT_No_Stop_TS_3 ; If non-active, don't disable +; +; /* Insure that the next time the task runs it gets a fresh time +; slice. */ +; REG_Thread_Ptr -> tc_cur_time_slice = +; REG_Thread_Ptr -> tc_time_slice; +; + LDR a2,[a1, #40h] ; Pickup original time slice +; +; /* Clear any active time slice by setting the state to +; NOT_ACTIVE. */ +; TMD_Time_Slice_State = 1; +; + MOV a3,#1 ; Build disable value + STR a3,[a4, #0] ; Disable time slice + STR a2,[a1, #20h] ; Reset current time slice +; } +; +TCT_No_Stop_TS_3 +; +; /* Save off the current stack pointer in the control block. */ +; REG_Thread_Ptr -> tc_stack_pointer = (VOID *) REG_Stack_Ptr; +; + STR sp,[a1, #2ch] ; Save the thread's stack pointer +; +; /* Switch to the system stack. */ +; REG_Stack_Ptr = TCD_System_Stack; +; + LDR a2,System_Stack ; Pickup address of stack pointer + LDR a3,System_Limit ; Pickup address of stack limit ptr + LDR sp,[a2, #0] ; Switch to system stack + LDR v7,[a3, #0] ; Setup system stack limit +; +; /* Finished, return to the scheduling loop. */ +; + B _TCT_Schedule ; Return to scheduling loop +; +; } +; else +; { +TCT_Not_Waiting_Unspec +; +; /* No higher-priority thread is waiting. */ +; +; /* Restore interrupts. */ +; + LDR a3,Int_Level ; Pickup address of interrupt level + MRS a2,CPSR ; Pickup current CPSR + LDR a4,[a3, #0] ; Pickup interrupt lockout level + BIC a2,a2,#LOCK_MSK ; Clear lockout bits + ORR a2,a2,a4 ; Build new interrupt lockout + MSR CPSR,a2 ; Setup CPSR appropriately +; +; } +; } +; +TCT_Skip_Unprot_Spec + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Set_Current_Protect */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function sets the current protection field of the current */ +;/* thread's control block to the specified protection pointer. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* TCC_Resume_Task Resume task function */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* protect Pointer to protection block */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Set_Current_Protect(TC_PROTECT *protect) +;{ + .def $TCT_Set_Current_Protect +$TCT_Set_Current_Protect ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Set_Current_Protect +; + .def _TCT_Set_Current_Protect +_TCT_Set_Current_Protect +; +; /* Determine if the caller is in a task or HISR thread. */ +; if (TCD_Current_Thread) +; { +; + LDR a2,Current_Thread ; Pickup current thread ptr address + LDR a4,[a2, #0] ; Pickup current thread pointer + CMP a4,#0 ; Check to see if a thread is + ; active +; +; /* Point at the current thread control block. */ +; REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread; +; +; /* Modify the current protection. */ +; REG_Thread_Ptr -> tc_current_protect = protect; +; + STRNE a1,[a4, #38h] ; Setup new protection +; } +; + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Protect_Switch */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function waits until a specific task no longer has any */ +;/* protection associated with it. This is necessary since task's */ +;/* cannot be suspended or terminated unless they have released all */ +;/* of their protection. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* System Components */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* thread Pointer to thread control blk */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Protect_Switch(VOID *thread) +;{ + .def $TCT_Protect_Switch +$TCT_Protect_Switch ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Protect_Switch +; + .def _TCT_Protect_Switch +_TCT_Protect_Switch +; +; /* Lockout interrupts. */ +; + MRS a2,CPSR ; Pickup current CPSR + ORR a2,a2,#LOCKOUT ; Place lockout value in + MSR CPSR,a2 ; Lockout interrupts +; +; REG_Thread_Ptr = (TC_TCB *) thread; +; +; /* Wait until the specified task has no protection associated with it. */ +; while (REG_Thread_Ptr -> tc_current_protect) +; { +; + LDR a2,[a1, #38h] ; Pickup protection of specified + ; thread + CMP a2,#0 ; Does the specified thread have + ; an active protection? + BEQ TCT_Switch_Done ; If not, protect switch is done +; +; /* Let the task run again in an attempt to clear its protection. */ +; +; /* Indicate that a higher priority thread is waiting. */ +; (REG_Thread_Ptr -> tc_current_protect) -> tc_thread_waiting = 1; +; + MOV a3,#1 ; Build waiting flag value + STR a3,[a2, #4] ; Set waiting flag of the + ; protection owned by the other + ; thread +; +; /* Directly schedule the thread waiting. */ +; TCT_Schedule_Protected((REG_Thread_Ptr -> tc_current_protect) +; -> tc_tcb_pointer); +; + LDR a3,Current_Thread ; Pickup current thread ptr address + STR a1,[sp, #-4]! ; Save a1 on the stack + STR lr,[sp, #-4]! ; Save lr on the stack + MOV a2,a1 ; Move new thread into a2 + LDR a1,[a3, #0] ; Pickup current thread pointer + BL _TCT_Schedule_Protected ; Call routine to schedule the + ; owner of the thread +; + LDR lr,[sp], #4 ; Recover saved lr + LDR a1,[sp], #4 ; Recover saved a1 +; +; /* Lockout interrupts. */ +; + B _TCT_Protect_Switch ; Branch to top of routine and + ; start over +; } +TCT_Switch_Done +; +; /* Restore interrupts. */ +; + LDR a3,Int_Level ; Pickup address of interrupt level + MRS a2,CPSR ; Pickup current CPSR + LDR a4,[a3, #0] ; Pickup interrupt lockout level + BIC a2,a2,#LOCK_MSK ; Clear lockout bits + ORR a2,a2,a4 ; Build new interrupt lockout + MSR CPSR,a2 ; Setup CPSR appropriately +; + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Schedule_Protected */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function saves the minimal context of the thread and then */ +;/* directly schedules the thread that has protection over the */ +;/* the thread that called this routine. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* TCT_Protect */ +;/* TCT_Protect_Switch */ +;/* */ +;/* CALLS */ +;/* */ +;/* TCT_Control_To_Thread Transfer control to protected*/ +;/* thread */ +;/* */ +;/* INPUTS */ +;/* */ +;/* None */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Schedule_Protected(VOID *thread) +;{ +; +_TCT_Schedule_Protected +; +; /* Interrupts are already locked out by the caller. */ +; +; /* Save minimal context required by the system. */ +; + STMDB sp!,{v1-ip,lr} ; Save minimal context of thread on + ; the current stack + MOV a3,lr ; Determine what state the + MOV a3,a3,LSL #31 ; caller was in and build an + MOV a3,a3,LSR #26 ; appropriate state mask + STR a3,[sp, #-4]! ; Place it on the stack + MOV a3,#0 ; Build solicited stack type value + ; and NU_NULL value + STR a3,[sp, #-4]! ; Place it on the top of the stack + MOV v1,a2 ; Save thread to schedule +; +; /* Setup a pointer to the thread control block. */ +; REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread; +; + LDR a2,Current_Thread ; Pickup current thread ptr address +; +; /* Clear the current thread control block. */ +; TCD_Current_Thread = NU_NULL; +; + LDR a4,Slice_State ; Pickup time slice state address + STR a3,[a2, #0] ; Set current thread pointer to + ; NU_NULL +; +; /* Check to see if a time slice is active. If so, copy the original time +; slice into the current time slice field of the task's control block. */ +; if (TMD_Time_Slice_State == 0) +; { +; + LDR a2,[a4, #0] ; Pickup time slice state flag + CMP a2,#0 ; Compare with active value + BNE TCT_No_Stop_TS_4 ; If non-active, don't disable +; +; /* Insure that the next time the task runs it gets a fresh time +; slice. */ +; REG_Thread_Ptr -> tc_cur_time_slice = REG_Thread_Ptr -> tc_time_slice; +; + LDR a2,[a1, #40h] ; Pickup original time slice +; +; /* Clear any active time slice by setting the state to NOT_ACTIVE. */ +; TMD_Time_Slice_State = 1; +; + MOV a3,#1 ; Build disable value + STR a3,[a4, #0] ; Disable time slice + STR a2,[a1, #20h] ; Reset current time slice +; +; } +TCT_No_Stop_TS_4 +; +; /* Save off the current stack pointer in the control block. */ +; REG_Thread_Ptr -> tc_stack_pointer = (VOID *) REG_Stack_Ptr; +; + STR sp,[a1, #2ch] ; Save the thread's stack pointer +; +; /* Switch to the system stack. */ +; TCD_System_Stack = (VOID *) REG_Stack_Ptr; +; + LDR a2,System_Stack ; Pickup address of stack pointer + LDR a3,System_Limit ; Pickup address of stack limit ptr + LDR sp,[a2, #0] ; Switch to system stack + LDR v7,[a3, #0] ; Setup system stack limit +; +; /* Transfer control to the specified thread directly. */ +; TCT_Control_To_Thread(thread); +; + LDR a3,Int_Level ; Pickup address of interrupt level + MRS a2,CPSR ; Pickup current CPSR + LDR a4,[a3, #0] ; Pickup interrupt lockout level + BIC a2,a2,#LOCK_MSK ; Clear lockout bits + ORR a2,a2,a4 ; Build new interrupt lockout + MOV a1,v1 ; Indicate thread to schedule + MSR CPSR,a2 ; Setup CPSR appropriately + ORR a2,a2,#LOCKOUT ; Build lockout value again + MSR CPSR,a2 ; Lockout interrupts again + B _TCT_Control_To_Thread ; Schedule the thread indirectly +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Interrupt_Context_Save */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function saves the interrupted thread's context. Nested */ +;/* interrupts are also supported. If a task or HISR thread was */ +;/* interrupted, the stack pointer is switched to the system stack */ +;/* after the context is saved. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* Application ISRs Assembly language ISRs */ +;/* INT_Interrupt_Shell Interrupt handler shell */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* vector Interrupt's vector number */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Interrupt_Context_Save(INT vector) +;{ + .def $TCT_Interrupt_Context_Save +$TCT_Interrupt_Context_Save ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Interrupt_Context_Save +; + .def _TCT_Interrupt_Context_Save +_TCT_Interrupt_Context_Save +; +; /* This routine is designed to handle THUMB IRQ interrupts. The IRQ +; stack is used as a temporary area. Actual context is saved either +; on the interrupted thread's stack or the system stack- both of which +; are in the Supervisor (SVC) mode. Note: upon entry to this routine +; a1-a4 are saved on the current stack and a4 contains the original +; (interrupt return address) lr value. The current lr contains the +; ISR return address. */ +; +; /* Determine if this is a nested interrupt. */ +; if (TCD_Interrupt_Count++) +; { +; + LDR a1,Int_Count ; Pickup address of interrupt count + LDR a2,[a1, #0] ; Pickup interrupt counter + CMP a2,#0 ; Is it the first interrupt? + BEQ TCT_Not_Nested_Save ; If so, not a nested interrupt +; +; /* Nested interrupt. Save complete context on the current stack. */ +; + ADD a2,a2,#1 ; Increment the interrupt counter + STR a2,[a1, #0] ; Store in interrupt counter + STMDB sp!,{v1-v3} ; Save more registers on current + ; stack + MRS v1,SPSR ; Pickup and save current SPSR + MOV v2,lr ; Save current lr + MOV v3,sp ; Save current sp + ADD sp,sp,#28 ; Adjust sp for future interrupts + MRS a1,CPSR ; Pickup current CPSR + BIC a1,a1,#MODE_MASK ; Clear the mode bits + ORR a1,a1,#SUP_MODE ; Prepare to switch to supervisor + ; mode (SVC) + MSR CPSR,a1 ; Switch to SVC mode + MOV a2,sp ; Use a non sp register + NOP ; + STR a4,[a2, #-4]! ; Save interrupted pc on sys stack + STMDB a2!,{v4-lr} ; Save v4-lr on the system stack + MOV sp,a2 ; Setup sp again + LDMIA v3!,{v4-v6} ; Recover v1-v3 from int stack + STMDB sp!,{v4-v6} ; Save v1-v3 on the system stack + LDMIA v3,{a1-a4} ; Recover a1-a4 + STMDB sp!,{a1-a4} ; Save a1-a4 on the system stack + STR v1,[sp, #-4]! ; Save CPSR on the stack + BX v2 ; Return to calling ISR +; } +; else +; { +TCT_Not_Nested_Save +; + ADD a2,a2,#1 ; Increment the interrupt counter + STR a2,[a1, #0] ; Store in interrupt counter +; +; /* Determine if a thread was interrupted. */ +; if (TCD_Current_Thread) +; { +; + LDR a2,Current_Thread ; Pickup current thread ptr address + LDR a2,[a2, #0] ; Pickup the current thread pointer + CMP a2,#0 ; Is it NU_NULL? + BEQ TCT_Idle_Context_Save ; If no, no real save is necessary + +; +; /* Yes, a thread was interrupted. Save complete context on the +; thread's stack. */ +; + STMDB sp!,{v1-v3} ; Save more registers on temp stack + MOV v2,lr ; Save interrupt lr in v2 + MRS v1,SPSR ; Save interrupt SPSR in v1 + MOV v3,sp ; Save current sp in v3 + ADD sp,sp,#28 ; Adjust sp for future interrupts + MRS a1,CPSR ; Pickup current CPSR + BIC a1,a1,#MODE_MASK ; Clear the mode bits + ORR a1,a1,#SUP_MODE ; Prepare to switch to supervisor + ; mode (SVC) + MSR CPSR,a1 ; Switch to supervisor mode (SVC) + MOV a2,sp ; Use a non-stack pointer register + NOP ; + STR a4,[a2, #-4]! ; Save interrupted pc on the stack + STMDB a2!,{v4-lr} ; Save v4-lr on the stack + MOV sp,a2 ; Setup sp again + LDMIA v3!,{v4-v6} ; Recover v1-v3 into v4-v6 + STMDB sp!,{v4-v6} ; Save v1-v3 on the stack + LDMIA v3,{a1-a4} ; Recover a1-a4 + STMDB sp!,{a1-a4} ; Save a1-a4 on the stack + STR v1,[sp, #-4]! ; Save CPSR on the stack + MOV a2,#1 ; Interrupt stack type + STR a2,[sp, #-4]! ; Put interrupt stack type on top + ; of stack +; +; /* Save the thread's stack pointer in the control block. */ +; REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread; +; REG_Thread_Ptr -> tc_stack_pointer = (VOID *) REG_Stack_Ptr; +; + LDR a2,Current_Thread ; Pickup current thread ptr address + LDR a1,[a2, #0] ; Pickup current thread pointer + LDR a4,Slice_State ; Pickup time slice state address + STR sp,[a1, #2ch] ; Save stack pointer +; +; /* Switch to the system stack. */ +; REG_Stack_Ptr = TCD_System_Stack; +; + LDR a2,System_Stack ; Pickup address of stack pointer + LDR a3,System_Limit ; Pickup address of stack limit ptr + LDR sp,[a2, #0] ; Switch to system stack + LDR v7,[a3, #0] ; Setup system stack limit +; +; /* Return to caller ISR. */ +; + BX v2 ; Return to caller ISR +; +; } +; +TCT_Idle_Context_Save +; + MOV v2,lr ; Save lr in v2 + ADD sp,sp,#16 ; Adjust sp for future interrupts + MRS a1,CPSR ; Pickup current CPSR + BIC a1,a1,#MODE_MASK ; Clear the current mode + ORR a1,a1,#SUP_MODE ; Prepare to switch to supervisor + ; mode (SVC) + MSR CPSR,a1 ; Switch to supervisor mode (SVC) + BX v2 ; Return to caller ISR +; } +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Interrupt_Context_Restore */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function restores the interrupt context if a nested */ +;/* interrupt condition is present. Otherwise, this routine */ +;/* transfers control to the scheduling function. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* Application ISRs Assembly language ISRs */ +;/* INT_Interrupt_Shell Interrupt handler shell */ +;/* */ +;/* CALLS */ +;/* */ +;/* TCT_Schedule Thread scheduling function */ +;/* */ +;/* INPUTS */ +;/* */ +;/* None */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_Interrupt_Context_Restore(void) +;{ + .def $TCT_Interrupt_Context_Restore +$TCT_Interrupt_Context_Restore ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Interrupt_Context_Restore +; + .def _TCT_Interrupt_Context_Restore +_TCT_Interrupt_Context_Restore +; +; /* It is assumed that anything pushed on the stack by ISRs has been +; removed upon entry into this routine. */ +; +; /* Lockout interrupts. */ +; + MRS a2,CPSR ; Pickup current CPSR + ORR a2,a2,#LOCKOUT ; Build lockout value + MSR CPSR,a2 ; Lockout interrupts +; +; /* Decrement and check for nested interrupt conditions. */ +; if (--TCD_Interrupt_Count) +; { +; + LDR a1,Int_Count ; Pickup address of interrupt count + LDR a2,[a1, #0] ; Pickup interrupt counter + SUB a2,a2,#1 ; Decrement interrupt counter + STR a2,[a1, #0] ; Store interrupt counter + CMP a2,#0 ; Is this a nested interrupt? + BEQ TCT_Not_Nested_Restore ; If not, skip nested interrupt + ; restoration +; +; /* Restore previous context. */ +; + LDR a1,[sp], #4 ; Pickup the saved CPSR + MSR SPSR,a1 ; Put in SPSR + LDMIA sp,{a1-pc}^ ; Return to the point of interrupt +; +; } +; else +; { +; +TCT_Not_Nested_Restore +; +; /* Determine if a thread is active. */ +; if (TCD_Current_Thread) +; { +; + LDR a2,Current_Thread ; Pickup current thread ptr address + LDR a1,[a2, #0] ; Pickup current thread pointer + CMP a1,#0 ; Determine if a thread is active + BEQ TCT_Idle_Context_Restore ; If not, idle system restore +; +; /* Clear the current thread pointer. */ +; TCD_Current_Thread = NU_NULL; +; + LDR a4,Slice_State ; Pickup time slice state address + MOV a3,#0 ; Build NU_NULL value + STR a3,[a2, #0] ; Set current thread ptr to NU_NULL +; +; /* Determine if a time slice is active. If so, the remaining +; time left on the time slice must be saved in the task's +; control block. */ +; if (TMD_Time_Slice_State == 0) +; { +; + LDR a2,[a4, #0] ; Pickup time slice state + CMP a2,#0 ; Determine if time slice active + BNE TCT_Idle_Context_Restore ; If not, skip time slice reset +; +; /* Pickup the remaining portion of the time slice and save it +; in the task's control block. */ +; REG_Thread_Ptr -> tc_cur_time_slice = TMD_Time_Slice; +; TMD_Time_Slice_State = 1; +; + LDR a3,Time_Slice ; Pickup address of time slice left + MOV a2,#1 ; Build disable time slice value + LDR a3,[a3, #0] ; Pickup remaining time slice + STR a2,[a4, #0] ; Disable time slice + STR a3,[a1, #20h] ; Store remaining time slice +; +; } +; } +TCT_Idle_Context_Restore +; +; /* Reset the system stack pointer. */ +; + LDR a2,System_Stack ; Pickup address of stack pointer + LDR a3,System_Limit ; Pickup address of stack limit ptr + LDR sp,[a2, #0] ; Switch to system stack + LDR v7,[a3, #0] ; Setup system stack limit +; +; /* Return to scheduler. */ +; + B _TCT_Schedule ; Return to scheduling loop +; +; } +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_Activate_HISR */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function activates the specified HISR. If the HISR is */ +;/* already activated, the HISR's activation count is simply */ +;/* incremented. Otherwise, the HISR is placed on the appropriate */ +;/* HISR priority list in preparation for execution. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* Application LISRs */ +;/* */ +;/* CALLS */ +;/* */ +;/* None */ +;/* */ +;/* INPUTS */ +;/* */ +;/* hisr Pointer to HISR to activate */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* NU_SUCCESS Successful completion */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;STATUS TCT_Activate_HISR(TC_HCB *hisr) +;{ + .def $TCT_Activate_HISR +$TCT_Activate_HISR ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_Activate_HISR +; + .def _TCT_Activate_HISR +_TCT_Activate_HISR +; +;INT priority; +; +; +; /* Lockout interrupts. */ +; + STR v1,[sp, #-4]! ; Save v1 + MRS v1,CPSR ; Pickup current CPSR + ORR a2,v1,#LOCKOUT ; Build interrupt lockout value + MSR CPSR,a2 ; Lockout interrupts +; +; /* Determine if the HISR is already active. */ +; if (hisr -> tc_activation_count) +; { +; + LDR a2,[a1,#40h] ; Pickup current activation count + CMP a2,#0 ; Is it the first activation? + BEQ TCT_First_Activate ; Yes, place it on the correct list +; +; /* Increment the activation count. Make sure that it does not go +; to zero. */ +; hisr -> tc_activation_count++; +; + ADDS a2,a2,#1 ; Increment the activation count + STR a2,[a1,#40h] ; Store new activation count +; +; if (hisr -> tc_activation_count == 0) +; +; hisr -> tc_activation_count = 0xFFFFFFFFUL; +; + MVNEQ a2,#0 ; If counter rolled-over reset + STREQ a2,[a1,#40h] ; Store all ones count + B TCT_Activate_Done ; Finished with activation +; } +; else +; { +TCT_First_Activate +; +; +; /* Set the activation count to 1. */ +; hisr -> tc_activation_count = 1; +; + MOV a2,#1 ; Initial activation count + STR a2,[a1,#40h] ; Store initial activation count +; +; /* Pickup the HISR's priority. */ +; priority = hisr -> tc_priority; +; +; /* Determine if there is something in the given priority list. */ +; if (TCD_Active_HISR_Tails[priority]) +; { +; + LDRB a2,[a1,#1ah] ; Pickup priority of HISR + LDR a3,HISR_Tails ; Pickup tail pointer base + LDR a4,[a3,a2,LSL #2] ; Pickup tail pointer for priority + CMP a4,#0 ; Is this first HISR at priority? + BEQ TCT_First_HISR ; No, append to end of HISR list +; +; /* Something is already on this list. Add after the tail. */ +; (TCD_Active_HISR_Tails[priority]) -> tc_active_next = hisr; +; TCD_Active_HISR_Tails[priority] = hisr; +; + STR a1,[a4,#3ch] ; Setup the active next pointer + STR a1,[a3,a2,LSL #2] ; Setup the tail pointer + B TCT_Activate_Done ; Finished with activate processing +; } +; else +; { +TCT_First_HISR +; +; /* Nothing is on this list. */ +; TCD_Active_HISR_Heads[priority] = hisr; +; TCD_Active_HISR_Tails[priority] = hisr; +; + LDR a4,HISR_Heads ; Pickup address of head pointers + STR a1,[a3,a2,LSL #2] ; Set tail pointer to this HISR + STR a1,[a4,a2,LSL #2] ; Set head pointer to this HISR +; +; /* Determine the highest priority HISR. */ +; if (TCD_Active_HISR_Heads[0]) +; TCD_Execute_HISR = TCD_Active_HISR_Heads[0]; +; else if (TCD_Active_HISR_Heads[1]) +; TCD_Execute_HISR = TCD_Active_HISR_Heads[1]; +; else +; TCD_Execute_HISR = TCD_Active_HISR_Heads[2]; +; + LDR a2,[a4,#0] ; Pickup priority 0 head pointer + LDR a1,Execute_HISR ; Build address to execute HISR ptr + CMP a2,#0 ; Is priority 0 active? + LDREQ a2,[a4,#4] ; If not, pickup priority 1 head + CMPEQ a2,#0 ; Is priority 1 active? + LDREQ a2,[a4,#8] ; Else, must be priority 2 active + STR a2,[a1,#0] ; Store which ever priority is the + ; active one +; } +; } +TCT_Activate_Done +; + MSR CPSR,v1 ; Restore interrupt lockout + LDR v1,[sp], #4 ; Restore corrupted v1 +; +; return(NU_SUCCESS); +; + MOV a1,#0 ; Always return NU_SUCCESS + BX lr ; Return to caller +;} +; +; +; +;/*************************************************************************/ +;/* */ +;/* FUNCTION */ +;/* */ +;/* TCT_HISR_Shell */ +;/* */ +;/* DESCRIPTION */ +;/* */ +;/* This function is the execution shell of each and every HISR. If */ +;/* the HISR has completed its processing, this shell routine exits */ +;/* back to the system. Otherwise, it sequentially calls the HISR */ +;/* routine until the activation count goes to zero. */ +;/* */ +;/* AUTHOR */ +;/* */ +;/* Barry Sellew, Accelerated Technology, Inc. */ +;/* */ +;/* CALLED BY */ +;/* */ +;/* HISR Scheduling */ +;/* */ +;/* CALLS */ +;/* */ +;/* hisr -> tc_entry Actual entry function of HISR*/ +;/* */ +;/* INPUTS */ +;/* */ +;/* None */ +;/* */ +;/* OUTPUTS */ +;/* */ +;/* None */ +;/* */ +;/* HISTORY */ +;/* */ +;/* NAME DATE REMARKS */ +;/* */ +;/* B. Sellew 01-19-1996 Created initial version 1.0 */ +;/* B. Sellew 01-22-1996 Verified version 1.0 */ +;/* */ +;/*************************************************************************/ +;VOID TCT_HISR_Shell(void) +;{ + .def $TCT_HISR_Shell +$TCT_HISR_Shell ; Dual-state interworking veneer + .state16 + BX pc + NOP + .state32 + B _TCT_HISR_Shell +; + .def _TCT_HISR_Shell +_TCT_HISR_Shell +; +; /* Point at the HISR. */ +; REG_HISR_Ptr = (TC_HCB *) TCD_Current_Thread; +; + LDR a1,Current_Thread ; Build address of thread pointer + LDR v2,[a1, #0] ; Pickup control block pointer +; +; do +; { +TCT_HISR_Loop +; +; /* Call the HISR's entry routine. */ +; (*(REG_HISR_Ptr -> tc_entry)) (); +; + LDR v1,[v2,#44h] ; Call HISR entry function + BL IND_CALL ; indirectly +; +; /* Lockout interrupts. */ +; + MRS a2,CPSR ; Pickup current CPSR + ORR a2,a2,#LOCKOUT ; Build interrupt lockout + MSR CPSR,a2 ; Lockout interrupts +; +; /* On return, decrement the activation count and check to see if +; it is 0. Once it reaches 0, the HISR should be made inactive. */ +; REG_HISR_Ptr -> tc_activation_count--; +; + LDR a1,[v2, #40h] ; Pickup current activation count + SUBS a1,a1,#1 ; Subtract and set condition codes + STR a1,[v2, #40h] ; Store new activation count + BEQ TCT_HISR_Finished ; Finished processing HISR + +; /* Restore interrupts. */ +; + LDR a3,Int_Level ; Pickup address of interrupt level + MRS a2,CPSR ; Pickup current CPSR + LDR a4,[a3, #0] ; Pickup interrupt lockout level + BIC a2,a2,#LOCK_MSK ; Clear lockout bits + ORR a2,a2,a4 ; Build new interrupt lockout + MSR CPSR,a2 ; Setup CPSR appropriately + B TCT_HISR_Loop ; Return to HISR loop +; } +; while (REG_HISR_Ptr -> tc_activation_count); +; +TCT_HISR_Finished +; +; /* At this point, the HISR needs to be made inactive. */ +; +; /* Determine if this is the only HISR on the given priority list. */ +; if (REG_HISR_Ptr == TCD_Active_HISR_Tails[REG_HISR_Ptr -> tc_priority]) +; { +; + LDR lr,HISR_Tails ; Pickup tail pointers address + LDRB a4,[v2,#1ah] ; Pickup priority + LDR v3,[lr,a4,LSL #2] ; Pickup this priority tail pointer + LDR a3,Execute_HISR ; Build address to execute HISR ptr + MOV a1,#0 ; Clear a1 + LDR a2,HISR_Heads ; Pickup head pointers address + CMP v3,v2 ; Is this priority tail the same as + ; the current HISR? + BNE TCT_More_HISRs ; If not, more HISRs at this + ; priority +; +; /* The only HISR on the list. Clean up the list and check for the +; highest priority HISR. */ +; TCD_Active_HISR_Heads[REG_HISR_Ptr -> tc_priority] = NU_NULL; +; TCD_Active_HISR_Tails[REG_HISR_Ptr -> tc_priority] = NU_NULL; +; + STR a1,[a2,a4,LSL #2] ; Set head pointer to NU_NULL + STR a1,[lr,a4,LSL #2] ; Set tail pointer to NU_NULL +; +; /* Determine the highest priority HISR. */ +; if (TCD_Active_HISR_Heads[0]) +; TCD_Execute_HISR = TCD_Active_HISR_Heads[0]; +; else if (TCD_Active_HISR_Heads[1]) +; TCD_Execute_HISR = TCD_Active_HISR_Heads[1]; +; else +; TCD_Execute_HISR = TCD_Active_HISR_Heads[2]; +; + LDR a4,[a2,#0] ; Pickup priority 0 head pointer + CMP a4,#0 ; Is there an HISR active? + LDREQ a4,[a2,#4] ; If not, pickup priority 1 pointer + CMPEQ a4,#0 ; Is there an HISR active? + LDREQ a4,[a2,#8] ; If not, pickup priority 2 pointer + STR a4,[a3,#0] ; Setup execute HISR pointer + B TCT_HISR_Exit ; Exit HISR processing +; } +; else +; { +; +TCT_More_HISRs +; +; /* Move the head pointer to the next HISR in the list. */ +; TCD_Active_HISR_Heads[REG_HISR_Ptr -> tc_priority] = +; REG_HISR_Ptr -> tc_active_next; +; +; /* Also set the TCD_Execute_HISR pointer. */ +; TCD_Execute_HISR = REG_HISR_Ptr -> tc_active_next; +; + LDR lr,[v2,#3ch] ; Pickup next HISR to activate + STR lr,[a2,a4,LSL #2] ; Setup new head pointer + STR lr,[a3, #0] ; Setup execute HISR pointer +; } +; +TCT_HISR_Exit +; +; /* Build fake return to the top of this loop. The next time the HISR +; is activated, it will return to the top of this function. */ +; + LDR lr,HISR_Shell ; Pickup address of shell entry + STMDB sp!,{v1-ip,lr} ; Save minimal context of thread on + ; the current stack + MOV a3,#0 ; Build solicited stack type value + ; and NU_NULL value + STR a3,[sp, #-4]! ; Save state mask + STR a3,[sp, #-4]! ; Place it on the top of the stack +; +; /* Clear the current thread control block. */ +; TCD_Current_Thread = NU_NULL; +; + LDR a2,Current_Thread ; Pickup current thread ptr address + STR a3,[a2, #0] ; Set current thread pointer to + ; NU_NULL +; +; /* Save off the current stack pointer in the control block. */ +; REG_HISR_Ptr -> tc_stack_pointer = (VOID *) REG_Stack_Ptr; +; + STR sp,[v2, #2ch] ; Save the thread's stack pointer +; +; /* Switch to the system stack. */ +; REG_Stack_Ptr = (BYTE_PTR) TCD_System_Stack; +; + LDR a2,System_Stack ; Pickup address of stack pointer + LDR a3,System_Limit ; Pickup address of stack limit ptr + LDR sp,[a2, #0] ; Switch to system stack + LDR v7,[a3, #0] ; Setup system stack limit +; +; /* Transfer control to the main scheduling loop. */ +; + B _TCT_Schedule ; Return to main scheduling loop +;} +; +;/* Define the global addresses used in this section */ +; +System_Limit + .word _TCT_System_Limit +; +Int_Level + .word _TCD_Interrupt_Level +; +Task_Shell + .word $TCC_Task_Shell +; +HISR_Shell + .word _TCT_HISR_Shell +; +Signal_Shell + .word $TCC_Signal_Shell +; +Current_Thread + .word _TCD_Current_Thread +; +Execute_HISR + .word _TCD_Execute_HISR +; +Execute_Task + .word _TCD_Execute_Task +; +Time_Slice + .word _TMD_Time_Slice +; +Slice_State + .word _TMD_Time_Slice_State +; +System_Stack + .word _TCD_System_Stack +; +Int_Count + .word _TCD_Interrupt_Count +; +HISR_Tails + .word _TCD_Active_HISR_Tails +; +HISR_Heads + .word _TCD_Active_HISR_Heads +; +System_Error + .word $ERC_System_Error +; + .end