diff gsm-fw/nucleus/tmt.S @ 143:afceeeb2cba1

Our nuc-fw is destined to become gsm-fw, so I went ahead and did the big hg mv
author Michael Spacefalcon <msokolov@ivan.Harhan.ORG>
date Tue, 12 Nov 2013 05:35:48 +0000
parents nuc-fw/nucleus/tmt.S@947b1f473960
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/gsm-fw/nucleus/tmt.S	Tue Nov 12 05:35:48 2013 +0000
@@ -0,0 +1,679 @@
+/*
+ ************************************************************************
+ *                                                                       
+ *               Copyright Mentor Graphics Corporation 2002              
+ *                         All Rights Reserved.                          
+ *                                                                       
+ * THIS WORK CONTAINS TRADE SECRET AND PROPRIETARY INFORMATION WHICH IS  
+ * THE PROPERTY OF MENTOR GRAPHICS CORPORATION OR ITS LICENSORS AND IS   
+ * SUBJECT TO LICENSE TERMS.                                             
+ *                                                                       
+ ************************************************************************
+ ************************************************************************
+ *                                                                       
+ * FILE NAME                              VERSION                        
+ *                                                                       
+ *      tmt.s                   Nucleus PLUS\ARM925\Code Composer 1.14.1 
+ *                                                                       
+ * COMPONENT                                                             
+ *                                                                       
+ *      TM - Timer Management                                            
+ *                                                                       
+ * DESCRIPTION                                                           
+ *                                                                       
+ *      This file contains the target dependent routines of the timer    
+ *      management component.                                            
+ *                                                                       
+ * FUNCTIONS                                                             
+ *                                                                       
+ *      TMT_Set_Clock                       Set system clock             
+ *      TMT_Retrieve_Clock                  Retrieve system clock        
+ *      TMT_Read_Timer                      Read count-down timer        
+ *      TMT_Enable_Timer                    Enable count-down timer      
+ *      TMT_Adjust_Timer                    Adjust count-down timer      
+ *      TMT_Disable_Timer                   Disable count-down timer     
+ *      TMT_Retrieve_TS_Task                Retrieve time-sliced task ptr
+ *      TMT_Timer_Interrupt                 Process timer interrupt      
+ *                                                                       
+ * DEPENDENCIES                                                          
+ *                                                                       
+ *      tc_extr.h                           Thread Control functions     
+ *      tm_extr.h                           Timer functions              
+ *                                                                       
+ * HISTORY                                                               
+ *                                                                       
+ *         NAME            DATE                    REMARKS               
+ *                                                                       
+ *      B. Ronquillo     08-28-2002           Released version 1.14.1     
+ *                                                                       
+ *                                                                       
+ ************************************************************************
+ */
+
+#define         NU_SOURCE_FILE
+
+/*
+ ******************************
+ * INCLUDE ASSEMBLY CONSTANTS *
+ ******************************
+ * Define constants used in low-level initialization.
+ */
+
+#include "asm_defs.h"
+
+	.code 32
+
+    .text
+
+/*
+ **********************************
+ * LOCAL VARIABLE DECLARATIONS    *
+ **********************************
+ * Define various data structure pointers so their addresses 
+ * can be obtained in a PC-relative manner.
+ */
+
+System_Clock:
+        .word     TMD_System_Clock
+
+Timer:
+        .word     TMD_Timer
+
+Timer_State:
+        .word     TMD_Timer_State
+
+Slice_State:
+        .word     TMD_Time_Slice_State
+
+Time_Slice:
+        .word     TMD_Time_Slice
+
+Current_Thread:
+        .word     TCD_Current_Thread
+
+Slice_Task:
+        .word     TMD_Time_Slice_Task
+
+HISR:
+        .word     TMD_HISR
+
+Int_Level:
+        .word     TCD_Interrupt_Level
+
+/*
+ ************************************************************************
+ *                                                                       
+ * FUNCTION                                                              
+ *                                                                       
+ *      TMT_Set_Clock                                                    
+ *                                                                       
+ * DESCRIPTION                                                           
+ *                                                                       
+ *      This function sets the system clock to the specified value.      
+ *                                                                       
+ * CALLED BY                                                             
+ *                                                                       
+ *      Application                                                      
+ *                                                                       
+ * CALLS                                                                 
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * INPUTS                                                                
+ *                                                                       
+ *      new_value                           New value for the clock      
+ *                                                                       
+ * OUTPUTS                                                               
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * HISTORY                                                               
+ *                                                                       
+ *         NAME            DATE                    REMARKS               
+ *                                                                       
+ *      W. Lamie        02-15-1994      Created initial version 1.0      
+ *      D. Lamie        02-15-1994      Verified version 1.0             
+ *                                                                       
+ ************************************************************************
+ */
+
+@VOID  TMT_Set_Clock(UNSIGNED new_value)
+@{
+
+	.globl  TMT_Set_Clock
+TMT_Set_Clock:
+
+@ Set the system clock to the specified value.
+@    TMD_System_Clock =  new_value;
+
+        LDR     r1,System_Clock             @ Build address of system clock
+        STR     r0,[r1,#0]                  @ Store new system clock value
+
+        BX      r14                         @ Return to caller
+
+@}
+
+/*
+ ************************************************************************
+ *                                                                       
+ * FUNCTION                                                              
+ *                                                                       
+ *      TMT_Retrieve_Clock                                               
+ *                                                                       
+ * DESCRIPTION                                                           
+ *                                                                       
+ *      This function returns the current value of the system clock.     
+ *                                                                       
+ * CALLED BY                                                             
+ *                                                                       
+ *      Application                                                      
+ *                                                                       
+ * CALLS                                                                 
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * INPUTS                                                                
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * OUTPUTS                                                               
+ *                                                                       
+ *      TMD_System_Clock                    Value of system clock        
+ *                                                                       
+ * HISTORY                                                               
+ *                                                                       
+ *         NAME            DATE                    REMARKS               
+ *                                                                       
+ *      W. Lamie        02-15-1994      Created initial version 1.0      
+ *      D. Lamie        02-15-1994      Verified version 1.0             
+ *                                                                       
+ ************************************************************************
+ */
+
+@UNSIGNED  TMT_Retrieve_Clock(void)
+@{
+
+	.globl  TMT_Retrieve_Clock
+TMT_Retrieve_Clock:
+
+@ Return the current value of the system clock.
+@    return(TMD_System_Clock);
+
+        LDR     r0,System_Clock             @ Build address to system clock
+        LDR     r0,[r0,#0]                  @ Pickup system clock contents
+
+        BX      r14                         @ Return to caller
+
+@}
+
+/*
+ ************************************************************************
+ *                                                                       
+ * FUNCTION                                                              
+ *                                                                       
+ *      TMT_Read_Timer                                                   
+ *                                                                       
+ * DESCRIPTION                                                           
+ *                                                                       
+ *      This function returns the current value of the count-down timer. 
+ *                                                                       
+ * CALLED BY                                                             
+ *                                                                       
+ *      TMC_Start_Timer                     Start timer function         
+ *                                                                       
+ * CALLS                                                                 
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * INPUTS                                                                
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * OUTPUTS                                                               
+ *                                                                       
+ *      TMD_Timer                           Value of count-down timer    
+ *                                                                       
+ * HISTORY                                                               
+ *                                                                       
+ *         NAME            DATE                    REMARKS               
+ *                                                                       
+ *      W. Lamie        02-15-1994      Created initial version 1.0      
+ *      D. Lamie        02-15-1994      Verified version 1.0             
+ *                                                                       
+ ************************************************************************
+ */
+
+@UNSIGNED  TMT_Read_Timer(void)
+@{
+
+	.globl  TMT_Read_Timer
+TMT_Read_Timer:
+
+@ Return the current value of the count-down timer.
+@    return(TMD_Timer);
+
+        LDR     r0,Timer                    @ Build address to timer
+        LDR     r0,[r0,#0]                  @ Pickup timer contents
+
+        BX      r14                         @ Return to caller
+
+@}
+
+/*
+ ************************************************************************
+ *                                                                       
+ * FUNCTION                                                              
+ *                                                                       
+ *      TMT_Enable_Timer                                                 
+ *                                                                       
+ * DESCRIPTION                                                           
+ *                                                                       
+ *      This function enables the count-down timer with the specified    
+ *      value.                                                           
+ *                                                                       
+ * CALLED BY                                                             
+ *                                                                       
+ *      TMC_Start_Timer                     Start timer function         
+ *      TMC_Timer_Task                      Timer expiration task        
+ *                                                                       
+ * CALLS                                                                 
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * INPUTS                                                                
+ *                                                                       
+ *      time                                New count-down time          
+ *                                                                       
+ * OUTPUTS                                                               
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * HISTORY                                                               
+ *                                                                       
+ *         NAME            DATE                    REMARKS               
+ *                                                                       
+ *      W. Lamie        02-15-1994      Created initial version 1.0      
+ *      D. Lamie        02-15-1994      Verified version 1.0             
+ *                                                                       
+ ************************************************************************
+ */
+
+@VOID  TMT_Enable_Timer(UNSIGNED time)
+@{
+
+	.globl  TMT_Enable_Timer
+TMT_Enable_Timer:
+
+@ Place the new time value into the count-down timer.
+@    TMD_Timer =  time;
+
+        LDR     r1,Timer                    @ Build address of timer
+        STR     r0,[r1,#0]                  @ Store new timer value
+
+@ Indicate that the timer is active.
+@    TMD_Timer_State =  TM_ACTIVE;
+
+        MOV     r0,#0                       @ Build TM_ACTIVE value
+        LDR     r1,Timer_State              @ Build address of timer state var
+        STR     r0,[r1,#0]                  @ Change the state to active
+
+        BX      r14                         @ Return to caller
+
+@}
+
+/*
+ ************************************************************************
+ *                                                                       
+ * FUNCTION                                                              
+ *                                                                       
+ *      TMT_Adjust_Timer                                                 
+ *                                                                       
+ * DESCRIPTION                                                           
+ *                                                                       
+ *      This function adjusts the count-down timer with the specified    
+ *      value, if the new value is less than the current.                
+ *                                                                       
+ * CALLED BY                                                             
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * CALLS                                                                 
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * INPUTS                                                                
+ *                                                                       
+ *      time                                New count-down time.         
+ *                                                                       
+ * OUTPUTS                                                               
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * HISTORY                                                               
+ *                                                                       
+ *         NAME            DATE                    REMARKS               
+ *                                                                       
+ *      C. Meredith     03-01-1994      Created initial version 1.1      
+ *      D. Lamie        03-18-1994      Verified version 1.1             
+ *      C. Meredith     08-27-1994      Corrected bug in new timer       
+ *                                        adjust routine, resulting in   
+ *                                        version 1.1a                   
+ *      W. Lamie        08-27-1994      Verified version 1.1a            
+ *                                                                       
+ ************************************************************************
+ */
+
+@VOID  TMT_Adjust_Timer(UNSIGNED time)
+@{
+
+	.globl  TMT_Adjust_Timer
+TMT_Adjust_Timer:
+
+@ Lockout all interrupts
+@    TMD_Timer_State =  TM_NOT_ACTIVE;
+
+        MRS     r3,CPSR                     @ Pickup current CPSR
+        ORR     r2,r3,#LOCKOUT              @ Build lockout CPSR
+        MSR     CPSR,r2                     @ Setup new CPSR interrupt bits
+
+@ Check for the new value is less than the current time value
+@    if (time < TMD_Timer)
+
+        LDR     r1,Timer                    @ Build address to timer var
+        LDR     r2,[r1,#0]                  @ read value of the timer
+        CMP     r2,r0                       @ Do Timer - time > 0, means
+        BLT     TMT_No_Adjust               @ time < Timer.
+
+@        Adjust the time 
+@        TMD_Timer = time;
+
+        STR     r0,[r1,#0]                  @ load passed in timer value
+
+@ Return to caller after restoring interrupts
+
+TMT_No_Adjust:
+
+        MSR     CPSR,r3                     @ Setup new CPSR enable bits
+
+        BX      r14                         @ Return to caller
+@}
+
+/*
+ ************************************************************************
+ *                                                                       
+ * FUNCTION                                                              
+ *                                                                       
+ *      TMT_Disable_Timer                                                
+ *                                                                       
+ * DESCRIPTION                                                           
+ *                                                                       
+ *      This function disables the count-down timer.                     
+ *                                                                       
+ * CALLED BY                                                             
+ *                                                                       
+ *      TMC_Start_Timer                     Start timer function         
+ *      TMC_Timer_Task                      Timer expiration task        
+ *                                                                       
+ * CALLS                                                                 
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * INPUTS                                                                
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * OUTPUTS                                                               
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * HISTORY                                                               
+ *                                                                       
+ *         NAME            DATE                    REMARKS               
+ *                                                                       
+ *      W. Lamie        02-15-1994      Created initial version 1.0      
+ *      D. Lamie        02-15-1994      Verified version 1.0             
+ *                                                                       
+ ************************************************************************
+ */
+
+@VOID  TMT_Disable_Timer(void)
+@{
+
+	.globl  TMT_Disable_Timer
+TMT_Disable_Timer:
+
+@ Disable the count-down timer.
+@    TMD_Timer_State =  TM_NOT_ACTIVE;
+
+        MOV     r1,#1                       @ Build TM_NOT_ACTIVE value
+        LDR     r0,Timer_State              @ Build address to timer state var
+        STR     r1,[r0,#0]                  @ Change timer state to not active
+
+        BX      r14                         @ Return to caller
+@}
+
+/*
+ ************************************************************************
+ *                                                                       
+ * FUNCTION                                                              
+ *                                                                       
+ *      TMT_Retreive_TS_Timer                                            
+ *                                                                       
+ * DESCRIPTION                                                           
+ *                                                                       
+ *      This function returns the time-sliced task pointer.              
+ *                                                                       
+ * CALLED BY                                                             
+ *                                                                       
+ *      TMC_Timer_HISR                      Timer HISR                   
+ *                                                                       
+ * CALLS                                                                 
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * INPUTS                                                                
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * OUTPUTS                                                               
+ *                                                                       
+ *      TMD_Time_Slice_Task                 Time sliced task pointer     
+ *                                                                       
+ * HISTORY                                                               
+ *                                                                       
+ *         NAME            DATE                    REMARKS               
+ *                                                                       
+ *      C. Meredith     03-01-1994      Created initial version 1.1      
+ *      D. Lamie        03-18-1994      Verified version 1.1             
+ *                                                                       
+ ************************************************************************
+ */
+
+@NU_TASK TMT_Retrieve_TS_Task (VOID)
+@{
+
+	.globl  TMT_Retrieve_TS_Task
+TMT_Retrieve_TS_Task:
+
+@ Read the current TMD_Time_Slice_Task variable and load for
+@ return to caller.
+
+        LDR     r1,Slice_Task                @ Build address to timer slice var
+        LDR     r0,[r1,#0]                   @ Get task pointer to be returned
+
+@ Return to caller time slice value back to caller
+
+        BX      r14                          @ Return to caller
+
+@}
+
+/*
+ ************************************************************************
+ *                                                                       
+ * FUNCTION                                                              
+ *                                                                       
+ *      TMT_Timer_Interrupt                                              
+ *                                                                       
+ * DESCRIPTION                                                           
+ *                                                                       
+ *      This function processes the actual hardware interrupt.           
+ *      Processing includes updating the system clock and the count-     
+ *      down timer and the time-slice timer.  If one or both of the      
+ *      timers expire, the timer HISR is activated.                      
+ *                                                                       
+ * CALLED BY                                                             
+ *                                                                       
+ *      Interrupt Vector                                                 
+ *                                                                       
+ * CALLS                                                                 
+ *                                                                       
+ *      TCT_Activate_HISR                   Activate timer HISR          
+ *      TCT_Interrupt_Context_Save          Save interrupted context     
+ *      TCT_Interrupt_Context_Restore       Restore interrupted context  
+ *                                                                       
+ * INPUTS                                                                
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * OUTPUTS                                                               
+ *                                                                       
+ *      None                                                             
+ *                                                                       
+ * HISTORY                                                               
+ *                                                                       
+ *         NAME            DATE                    REMARKS               
+ *                                                                       
+ *      W. Lamie        02-15-1994      Created initial version 1.0      
+ *      D. Lamie        02-15-1994      Verified version 1.0             
+ *                                                                       
+ ************************************************************************
+ */
+
+@VOID  TMT_Timer_Interrupt(void)
+@{
+	.globl	TMT_Timer_Interrupt
+TMT_Timer_Interrupt:
+
+        MRS     r1,CPSR                         @ Pickup current CPSR
+        ORR     r1,r1,#LOCKOUT                  @ Set the interrupt lockout bits
+        MSR     CPSR,r1                         @ Lockout interrupts
+
+@ Increment the system clock.
+@    TMD_System_Clock++;
+
+        LDR     r0,System_Clock                 @ Pickup system clock address
+        LDR     r1,[r0,#0]                      @ Pickup system clock contents
+        ADD     r1,r1,#1                        @ Increment system clock
+        STR     r1,[r0,#0]                      @ Store new system clock value
+
+@ Determine if the count-down timer is active.
+@    if (TMD_Timer_State == TM_ACTIVE)
+@    {
+
+        LDR     r1,Timer_State                  @ Build address to timer state flag
+        LDR     r0,[r1,#0]                      @ Pickup timer state
+        MOV     r3,#2                           @ Build expired value
+        CMP     r0,#0                           @ Is there a timer active?
+        BNE     TMT_No_Timer_Active             @ No, skip timer processing
+
+@ Decrement the count-down timer.
+@        TMD_Timer--;
+
+        LDR     r0,Timer                        @ Build timer address
+        LDR     r2,[r0,#0]                      @ Pickup the current timer value
+
+@ Test if the Timer is at 0 and if so skip the decrement 
+        cmp     r2,#1
+        beq     EXPIRED
+
+        SUBS    r2,r2,#1                        @ Decrement the timer value
+        STR     r2,[r0,#0]                      @ Store the new timer value
+
+        bne     TMT_No_Timer_Active             @ Skip over the Set Timer State
+
+@ Determine if the timer has expired. If so, modify the state 
+@ to indicate that it has expired.
+@        if (TMD_Timer == 0)
+
+@            TMD_Timer_State =  TM_EXPIRED;
+
+EXPIRED:
+        STREQ   r3,[r1,#0]                      @ Change the timer state to 
+                                                @ expired
+
+@    }
+TMT_No_Timer_Active:
+
+@ Determine if the time-slice timer is active.  Note that the parameters
+@ for the time-slice are controlled by the Thread Control (TC) 
+@ component.
+@    if (TMD_Time_Slice_State == TM_ACTIVE)
+@    {
+        LDR     r0,Slice_State                  @ Build time slice state address
+        LDR     r2,[r0,#0]                      @ Pickup time slice state
+        CMP     r2,#0                           @ Is there a time slice active?
+        BNE     TMT_No_Time_Slice_Active        @ No, skip time slice processing
+
+@ Decrement the time slice counter.
+@        TMD_Time_Slice--;
+
+        LDR     r2,Time_Slice                   @ Build time slice address
+        LDR     r3,[r2,#0]                      @ Pickup the time slice value
+        SUBS    r3,r3,#1                        @ Decrement the time slice
+        STR     r3,[r2,#0]                      @ Store the new time slice value
+
+        @ Determine if the time-slice timer has expired. If so, modify the
+        @ time-slice state to indicate that it has.
+@        if (TMD_Time_Slice == 0)
+@        {
+
+        BNE     TMT_No_Time_Slice_Active        @ Has time slice expired?
+
+@            TMD_Time_Slice_State =  TM_EXPIRED;
+
+        MOV     r3,#2                           @ Build TM_EXPIRED value
+        STR     r3,[r0,#0]                      @ Indicate time slice is expired
+
+        @ Copy the current thread into the time-slice task pointer.
+@            TMD_Time_Slice_Task =  TCD_Current_Thread;
+
+        LDR     r2,Current_Thread               @ Pickup current thread pointer adr
+        LDR     r2,[r2,#0]                      @ Pickup current thread pointer
+        LDR     r3,Slice_Task                   @ Pickup time slice task pointer ad
+        STR     r2,[r3,#0]                      @ Store current thread pointer
+
+@            ((TC_TCB *) TCD_Current_Thread) -> tc_cur_time_slice =  1;
+
+        MOV     r3,#1                           @ For safety, place a minimal time-
+        STR     a4,[a3,#0x20]!                  @ slice into the task's control
+                                                @ block
+
+@        }
+@    }
+TMT_No_Time_Slice_Active:
+
+    @ Determine if either of the basic timers have expired.  If so, 
+    @ activate the timer HISR.
+@    if ((TMD_Timer_State == TM_EXPIRED) ||
+@        (TMD_Time_Slice_State == TM_EXPIRED))
+@    {
+
+        LDR     r1,[r1,#0]                      @ Pickup timer state 
+        CMP     r1,#2                           @ Does it indicate expiration?
+        LDRNE   r0,[r0,#0]                      @ Pickup time slice state
+        CMPNE   r0,#2                           @ Does it indicate expiration?
+         
+        BXNE    r14                             @ Return if no expiration
+
+        @ Activate the HISR timer function.
+@        TCT_Activate_HISR(&TMD_HISR);
+
+        STR     r14,[r13, #-4]!                 @ Save r14 on the stack
+        LDR     r0,HISR                         @ Build address of timer HISR
+        BL      TCT_Activate_HISR               @ Activate timer HISR
+        LDR     r14,[r13], #4                   @ Recover return address
+@    }
+
+        BX      r14                             @ Return to caller
+
+@}