freecalypso-sw: gsm-fw/nucleus/tct.S annotate

annotate gsm-fw/nucleus/tct.S @ 810:47a9c4eadf7f

aci: psa_sim?.c done

author	Space Falcon <falcon@ivan.Harhan.ORG>
date	Sun, 05 Apr 2015 07:40:15 +0000
parents	962f0d3a4e7e
children

rev	line source
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	3 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	4 * Copyright Mentor Graphics Corporation 2002
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	5 * All Rights Reserved.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	6 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	7 * THIS WORK CONTAINS TRADE SECRET AND PROPRIETARY INFORMATION WHICH IS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	8 * THE PROPERTY OF MENTOR GRAPHICS CORPORATION OR ITS LICENSORS AND IS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	9 * SUBJECT TO LICENSE TERMS.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	10 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	11 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	12 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	13 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	14 * FILE NAME VERSION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	15 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	16 * tct.s Nucleus PLUS\ARM925\Code Composer 1.14.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	17 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	18 * COMPONENT
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	19 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	20 * TC - Thread Control
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	21 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	22 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	23 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	24 * This file contains the target processor dependent routines for
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	25 * performing target-dependent scheduling functions.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	26 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	27 * FUNCTIONS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	28 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	29 * TCT_Control_Interrupts Enable / disable interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	30 * by changing
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	31 * TCD_Interrupt_Level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	32 * TCT_Local_Control_Interrupts Enable/disable interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	33 * by not changing
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	34 * TCD_Interrupt_Level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	35 * TCT_Restore_Interrupts Restores interrupts to the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	36 * level in TCD_Interrupt_Level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	37 * TCT_Build_Task_Stack Build initial task stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	38 * TCT_Build_HISR_Stack Build initial HISR stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	39 * TCT_Build_Signal_Frame Build signal handler frame
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	40 * TCT_Check_Stack Check current stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	41 * TCT_Schedule Schedule the next thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	42 * TCT_Control_To_Thread Transfer control to a thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	43 * TCT_Control_To_System Transfer control from thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	44 * TCT_Signal_Exit Exit from signal handler
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	45 * TCT_Current_Thread Returns a pointer to current
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	46 * thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	47 * TCT_Set_Execute_Task Sets TCD_Execute_Task under
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	48 * protection from interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	49 * TCT_Protect Protect critical section
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	50 * TCT_Unprotect Unprotect critical section
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	51 * TCT_Unprotect_Specific Release specific protection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	52 * TCT_Set_Current_Protect Set the thread's current
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	53 * protection field
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	54 * TCT_Protect_Switch Switch to protected thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	55 * TCT_Schedule_Protected Schedule the protected thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	56 * TCT_Interrupt_Context_Save Save interrupted context
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	57 * TCT_Interrupt_Context_Restore Restore interrupted context
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	58 * TCT_Activate_HISR Activate a HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	59 * TCT_HISR_Shell HISR execution shell
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	60 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	61 * DEPENDENCIES
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	62 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	63 * cs_extr.h Common Service functions
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	64 * tc_extr.h Thread Control functions
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	65 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	66 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	67 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	68 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	69 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	70 * B. Ronquillo 08-28-2002 Released version 1.14.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	71 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	72 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	73 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	74
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	75 #define NU_SOURCE_FILE
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	76
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	77 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	78 ******************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	79 * INCLUDE ASSEMBLY CONSTANTS *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	80 ******************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	81 * Define constants used in low-level initialization.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	82 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	83
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	84 #include "asm_defs.h"
570 962f0d3a4e7e gsm-fw/nucleus/tct.S: preparations for hooking in GSM small sleep Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 143 diff changeset	85 #include "../include/config.h"
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	86
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	87 .code 32
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	88
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	89 /* TCT_System_Limit is a global variable defined in this module */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	90
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	91 .comm TCT_System_Limit,4,4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	92
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	93 .text
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	94
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	95 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	96 **********************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	97 * LOCAL VARIABLE DECLARATIONS *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	98 **********************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	99 * Define pointers to system variables so their addresses may be obtained in a
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	100 * pc-relative manner.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	101 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	102
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	103 System_Limit:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	104 .word TCT_System_Limit
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	105
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	106 Int_Level:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	107 .word TCD_Interrupt_Level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	108
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	109 Task_Shell:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	110 .word TCC_Task_Shell
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	111
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	112 HISR_Shell:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	113 .word TCT_HISR_Shell
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	114
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	115 Signal_Shell:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	116 .word TCC_Signal_Shell
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	117
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	118 Current_Thread:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	119 .word TCD_Current_Thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	120
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	121 Execute_HISR:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	122 .word TCD_Execute_HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	123
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	124 Execute_Task:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	125 .word TCD_Execute_Task
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	126
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	127 Time_Slice:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	128 .word TMD_Time_Slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	129
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	130 Slice_State:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	131 .word TMD_Time_Slice_State
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	132
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	133 System_Stack:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	134 .word TCD_System_Stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	135
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	136 Int_Count:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	137 .word TCD_Interrupt_Count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	138
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	139 HISR_Tails:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	140 .word TCD_Active_HISR_Tails
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	141
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	142 HISR_Heads:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	143 .word TCD_Active_HISR_Heads
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	144
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	145 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	146 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	147 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	148 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	149 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	150 * TCT_Control_Interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	151 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	152 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	153 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	154 * This function enables and disables interrupts as specified by
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	155 * the caller. Interrupts disabled by this call are left disabled
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	156 * until the another call is made to enable them.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	157 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	158 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	159 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	160 * Application
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	161 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	162 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	163 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	164 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	165 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	166 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	167 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	168 * new_level New interrupt enable level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	169 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	170 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	171 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	172 * old_level Previous interrupt enable
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	173 * level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	174 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	175 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	176 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	177 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	178 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	179 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	180 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	181 * C. Meredith 03-01-1994 Lockout interrupts while setting
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	182 * up the new level, resutling in
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	183 * version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	184 * D. Lamie 03-18-1994 Verified version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	185 * M. Trippi 02-03-1997 Masked the return value to only
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	186 * return the interrupt bits.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	187 * (SPR0252)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	188 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	189 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	190 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	191
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	192 @INT TCT_Control_Interrupts (INT new_level)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	193 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	194
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	195 .globl TCT_Control_Interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	196 TCT_Control_Interrupts:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	197
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	198 @INT old_level; Old interrupt level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	199
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	200 @ lock out all interrupts before any checking or changing
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	201
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	202 @ Obtain the current interrupt lockout posture.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	203 @ old_level = TCD_Interrupt_Level;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	204
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	205 @ Setup new interrupt lockout posture.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	206 @ TCD_Interrupt_Level = new_level;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	207
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	208 @ renable interrupts for the specified lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	209
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	210 @ Return old interrupt lockout level.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	211 @ return(old_level);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	212
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	213 MRS r2,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	214 ORR r2,r2,#LOCKOUT @ Build lockout CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	215 MSR CPSR,r2 @ Lockout interrupts temporarily
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	216 LDR r1, Int_Level @ Pickup interrupt level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	217 LDR r3,[r1, #0] @ Pickup current interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	218 BIC r2,r2,#LOCK_MSK @ Clear lockout mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	219 ORR r2,r2,r0 @ Build new CPSR with appropriate
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	220 @ interrupts locked out
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	221 STR r0,[r1,#0] @ Save current lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	222 MSR CPSR,r2 @ Setup new CPSR lockout bits
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	223 AND r0,r3,#LOCK_MSK @ Return previous lockout (SPR0252)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	224
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	225 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	226
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	227 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	228
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	229 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	230 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	231 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	232 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	233 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	234 * TCT_Local_Control_Interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	235 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	236 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	237 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	238 * This function enables and disables interrupts as specified by
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	239 * the caller.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	240 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	241 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	242 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	243 * Application
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	244 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	245 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	246 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	247 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	248 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	249 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	250 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	251 * new_level New interrupt enable level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	252 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	253 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	254 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	255 * old_level Previous interrupt enable
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	256 * level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	257 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	258 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	259 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	260 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	261 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	262 * C. Meredith 03-01-1994 Created initial version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	263 * D. Lamie 03-18-1994 Verified version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	264 * M. Trippi 02-03-1997 Masked the return value to only
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	265 * return the interrupt bits.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	266 * (SPR0252)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	267 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	268 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	269 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	270
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	271 @INT TCT_Local_Control_Interrupts (INT new_level)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	272 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	273
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	274 .globl TCT_Local_Control_Interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	275 TCT_Local_Control_Interrupts:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	276
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	277 @INT old_level; Old interrupt level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	278
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	279 @ read in the old level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	280 @ old_level = current interrupt level of processor;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	281
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	282 MRS r2,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	283 MOV r3,r2 @ save the old level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	284
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	285 @ clear out the old level and set the new level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	286 @ current interrupt level of processor &= ~LOCKOUT;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	287 @ current interrupt level of processor \|= new_level;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	288
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	289 BIC r2,r2,#LOCK_MSK @ Clear all current interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	290 ORR r2,r2,r0 @ Build new CPSR with new
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	291 @ interrupt level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	292 MSR CPSR,r2 @ Setup new CPSR interrupt bits
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	293
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	294 @ Return old interrupt lockout level.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	295 @ return(old_level);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	296
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	297 AND r0,r3,#LOCK_MSK @ Return previous lockout (SPR0252)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	298
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	299 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	300
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	301 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	302
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	303 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	304 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	305 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	306 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	307 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	308 * TCT_Restore_Interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	309 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	310 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	311 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	312 * This function restores interrupts to that specified in the global
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	313 * TCD_Interrupt_Level variable.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	314 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	315 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	316 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	317 * Application
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	318 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	319 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	320 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	321 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	322 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	323 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	324 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	325 * None.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	326 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	327 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	328 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	329 * None.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	330 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	331 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	332 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	333 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	334 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	335 * C. Meredith 03-01-1994 Created initial version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	336 * D. Lamie 03-18-1994 Verified version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	337 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	338 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	339 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	340
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	341 @VOID TCT_Restore_Interrupts (VOID)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	342 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	343
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	344 .globl TCT_Restore_Interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	345 TCT_Restore_Interrupts:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	346
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	347 @ Lock out all interrupts before any checking or changing
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	348 @ Obtain the current interrupt lockout posture.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	349 @ Reload the level base on the TCD_Interrupt_Level variable
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	350
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	351 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	352 MOV r2,r1 @ save the CPSR value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	353 ORR r1,r1,#LOCKOUT @ Build lockout CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	354 MSR CPSR,r1 @ Lockout interrupts temporarily
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	355 BIC r2,r2,#LOCK_MSK @ Clear current interrupt levels
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	356 LDR r1,Int_Level @ Load address of TCD_Interrupt_Level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	357 LDR r0,[r1, #0] @ Pickup current interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	358 ORR r2,r2,r0 @ Build new CPSR with appropriate
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	359 @ interrupts locked out
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	360 MSR CPSR,r2 @ Setup new CPSR lockout bits
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	361
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	362 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	363
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	364 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	365
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	366 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	367 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	368 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	369 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	370 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	371 * TCT_Build_Task_Stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	372 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	373 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	374 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	375 * This function builds an initial stack frame for a task. The
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	376 * initial stack contains information concerning initial values of
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	377 * registers and the task's point of entry. Furthermore, the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	378 * initial stack frame is in the same form as an interrupt stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	379 * frame.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	380 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	381 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	382 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	383 * TCC_Create_Task Create a new task
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	384 * TCC_Reset_Task Reset the specified task
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	385 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	386 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	387 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	388 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	389 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	390 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	391 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	392 * task Task control block pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	393 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	394 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	395 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	396 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	397 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	398 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	399 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	400 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	401 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	402 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	403 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	404 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	405 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	406 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	407
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	408 @VOID TCT_Build_Task_Stack(TC_TCB *task)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	409 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	410
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	411 .globl TCT_Build_Task_Stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	412 TCT_Build_Task_Stack:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	413
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	414 @ Pickup the stack base.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	415 @ REG_Stack_Base = (BYTE_PTR) task -> tc_stack_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	416
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	417 LDR r2,[r0,#0x24] @ Pickup the stack starting address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	418
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	419 @ Pickup the stack size.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	420 @ REG_Stack_Size = task -> tc_stack_size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	421
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	422 LDR r1,[r0,#0x30] @ Pickup the stack size in bytes
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	423
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	424 @ Calculate the stack ending address.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	425 @ REG_Stack_End = REG_Stack_Base + REG_Stack_Size - 1;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	426
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	427 ADD r3,r1,r2 @ Compute the beginning of stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	428 BIC r3,r3,#3 @ Insure word alignment
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	429 SUB r3,r3,#4 @ Reserve a word
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	430
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	431 @ Save the stack ending address.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	432 @ task -> tc_stack_end = REG_Stack_End;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	433
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	434 STR r3,[r0,#0x28] @ Save the stack ending address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	435
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	436 @ Reference the task shell.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	437 @ REG_Function_Ptr = (VOID *) TCC_Task_Shell;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	438
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	439 @ Build an initial stack. This initial stack frame facilitates an
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	440 @ interrupt return to the TCC_Task_Shell function, which in turn
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	441 @ invokes the application task. The initial stack frame has the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	442 @ following format:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	443
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	444 @ (Lower Address) Stack Top -> 1 (Interrupt stack type)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	445 @ CPSR Saved CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	446 @ r0 Saved r0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	447 @ r1 Saved r1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	448 @ r2 Saved r2
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	449 @ r3 Saved r3
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	450 @ r4 Saved r4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	451 @ r5 Saved r5
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	452 @ r6 Saved r6
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	453 @ r7 Saved r7
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	454 @ r8 Saved r8
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	455 @ r9/sb Saved r9/sl
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	456 @ r10/sl Saved r10/sl
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	457 @ fp Saved fp
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	458 @ r12 Saved r12
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	459 @ r13 Saved r13
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	460 @ r14 Saved r14
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	461 @ (Higher Address) Stack Bottom-> r15 Saved r15
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	462
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	463
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	464 LDR r2, Task_Shell @ Pickup address of shell entry
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	465 STR r2,[r3], #-4 @ Store entry address on stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	466 MOV r2,#0 @ Clear value for initial registers
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	467 STR r2,[r3], #-4 @ Store initial r14
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	468 ADD r2,r3,#8 @ Compute initial r13
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	469 STR r2,[r3], #-4 @ Store initial r13 (Stack Bottom)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	470 STR r2,[r3], #-4 @ Store initial r12
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	471 STR r2,[r3], #-4 @ Store initial fp
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	472 LDR r2,[r0,#0x24] @ Pickup the stack starting address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	473 STR r2,[r3], #-4 @ Store initial r10/sl
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	474 MOV r2,#0 @ Clear value for initial registers
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	475 STR r2,[r3], #-4 @ Store initial r9/sb
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	476 STR r2,[r3], #-4 @ Store initial r8
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	477 STR r2,[r3], #-4 @ Store initial r7
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	478 STR r2,[r3], #-4 @ Store initial r6
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	479 STR r2,[r3], #-4 @ Store initial r5
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	480 STR r2,[r3], #-4 @ Store initial r4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	481 STR r2,[r3], #-4 @ Store initial r3
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	482 STR r2,[r3], #-4 @ Store initial r2
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	483 STR r2,[r3], #-4 @ Store initial r1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	484 STR r2,[r3], #-4 @ Store initial r0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	485 MSR CPSR_f,r2 @ Clear the flags
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	486 MRS r2,CPSR @ Pickup the CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	487 BIC r2,r2,#LOCK_MSK @ Clear initial interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	488 STR r2,[r3], #-4 @ Store CPSR on the initial stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	489 MOV r2,#1 @ Build interrupt stack type (1)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	490 STR r2,[r3, #0] @ Store stack type on the top
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	491
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	492 @ Save the minimum amount of remaining stack memory.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	493 @ task -> tc_stack_minimum = REG_Stack_Size - 72;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	494
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	495 MOV r2,#72 @ Size of interrupt stack frame
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	496 SUB r1,r1,r2 @ Compute minimum available bytes
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	497 STR r1,[r0, #0x34] @ Save in minimum stack area
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	498
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	499 @ Save the new stack pointer into the task's control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	500 @ task -> tc_stack_pointer = (VOID *) Stack_Top;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	501
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	502 STR r3,[r0, #0x2C] @ Save stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	503
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	504 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	505
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	506 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	507
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	508 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	509 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	510 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	511 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	512 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	513 * TCT_Build_HISR_Stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	514 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	515 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	516 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	517 * This function builds an HISR stack frame that allows quick
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	518 * scheduling of the HISR.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	519 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	520 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	521 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	522 * TCC_Create_HISR Create HISR function
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	523 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	524 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	525 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	526 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	527 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	528 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	529 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	530 * hisr HISR control block pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	531 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	532 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	533 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	534 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	535 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	536 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	537 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	538 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	539 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	540 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	541 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	542 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	543 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	544 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	545
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	546 @VOID TCT_Build_HISR_Stack(TC_HCB *hisr)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	547 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	548
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	549 .globl TCT_Build_HISR_Stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	550 TCT_Build_HISR_Stack:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	551
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	552 @ Pickup the stack base.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	553 @ REG_Stack_Base = (BYTE_PTR) hisr -> tc_stack_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	554
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	555 LDR r2,[r0,#0x24] @ Pickup the stack starting address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	556
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	557 @ Pickup the stack size.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	558 @ REG_Stack_Size = hisr -> tc_stack_size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	559
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	560 LDR r1,[r0,#0x30] @ Pickup the stack size in bytes
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	561
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	562 @ Calculate the stack ending address.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	563 @ REG_Stack_End = REG_Stack_Base + REG_Stack_Size;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	564
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	565 ADD r3,r1,r2 @ Compute the beginning of stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	566 BIC r3,r3,#3 @ Insure word alignment
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	567 SUB r3,r3,#4 @ Reserve a word
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	568
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	569 @ Save the stack ending address.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	570 @ hisr -> tc_stack_end = REG_Stack_End;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	571
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	572 STR r3,[r0,#0x28] @ Save the stack ending address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	573
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	574 @ Reference the HISR shell.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	575 @ REG_Function_Ptr = (VOID *) TCT_HISR_Shell;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	576
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	577 @ Build an initial stack. This initial stack frame facilitates an
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	578 @ solicited return to the TCT_HISR_Shell function, which in turn
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	579 @ invokes the appropriate HISR. The initial HISR stack frame has the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	580 @ following format:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	581
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	582 @ (Lower Address) Stack Top -> 0 (Solicited stack type)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	583 @ !!FOR THUMB ONLY!! 0/0x20 Saved state mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	584 @ r4 Saved r4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	585 @ r5 Saved r5
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	586 @ r6 Saved r6
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	587 @ r7 Saved r7
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	588 @ r8 Saved r8
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	589 @ r9/sb Saved r9/sl
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	590 @ r10/sl Saved r10/sl
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	591 @ fp Saved fp
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	592 @ r12 Saved r12
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	593 @ (Higher Address) Stack Bottom-> r15 Saved r15
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	594
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	595
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	596 LDR r2,HISR_Shell @ Pickup address of shell entry
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	597 STR r2,[r3], #-4 @ Store entry address on stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	598 ADD r2,r3,#4 @ Compute initial r13
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	599 STR r2,[r3], #-4 @ Store initial r12
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	600 STR r2,[r3], #-4 @ Store initial fp
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	601 LDR r2,[r0,#0x24] @ Pickup the stack starting address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	602 STR r2,[r3], #-4 @ Store initial r10/sl
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	603 MOV r2,#0 @ Clear value for initial registers
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	604 STR r2,[r3], #-4 @ Store initial r9/sb
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	605 STR r2,[r3], #-4 @ Store initial r8
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	606 STR r2,[r3], #-4 @ Store initial r7
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	607 STR r2,[r3], #-4 @ Store initial r6
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	608 STR r2,[r3], #-4 @ Store initial r5
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	609 STR r2,[r3], #-4 @ Store initial r4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	610 #if 1 /* was .if THUMB */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	611 STR r2,[r3], #-4 @ Store initial state mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	612 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	613 STR r2,[r3, #0] @ Store solicited stack type on the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	614 @ top of the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	615
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	616 @ Save the minimum amount of remaining stack memory.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	617 @ hisr -> tc_stack_minimum = REG_Stack_Size - (ARM)44 or (THUMB)48;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	618
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	619 #if 1 /* was .if THUMB */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	620 MOV r2,#48 @ Size of solicited stack frame
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	621 #else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	622 MOV r2,#44 @ Size of solicited stack frame
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	623 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	624
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	625 SUB r1,r1,r2 @ Compute minimum available bytes
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	626 STR r1,[r0, #0x34] @ Save in minimum stack area
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	627
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	628 @ Save the new stack pointer into the task's control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	629 @ hisr -> tc_stack_pointer = (VOID *) Stack_Top;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	630
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	631 STR r3,[r0, #0x2C] @ Save stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	632
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	633 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	634
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	635 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	636
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	637 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	638 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	639 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	640 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	641 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	642 * TCT_Build_Signal_Frame
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	643 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	644 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	645 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	646 * This function builds a frame on top of the task's stack to
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	647 * cause the task's signal handler to execute the next time
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	648 * the task is executed.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	649 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	650 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	651 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	652 * TCC_Send_Signals Send signals to a task
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	653 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	654 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	655 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	656 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	657 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	658 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	659 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	660 * task Task control block pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	661 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	662 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	663 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	664 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	665 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	666 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	667 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	668 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	669 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	670 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	671 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	672 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	673 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	674 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	675
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	676 @VOID TCT_Build_Signal_Frame(TC_TCB *task)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	677 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	678
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	679 .globl TCT_Build_Signal_Frame
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	680 TCT_Build_Signal_Frame:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	681
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	682 @ Pickup the stack pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	683 @ REG_Stack_Ptr = (BYTE_PTR) task -> tc_stack_pointer;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	684
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	685 LDR r3,[r0,#0x2c] @ Pickup the current stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	686
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	687 @ Reference the Signal shell.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	688 @ REG_Function_Ptr = (VOID *) TCC_Signal_Shell;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	689
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	690 @ Build a signal stack. This signal stack frame facilitates an
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	691 @ solicited return to the TCC_Signal_Shell function, which in turn
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	692 @ invokes the appropriate signal handler. The initial HISR stack frame
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	693 @ has the following format:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	694
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	695 @ (Lower Address) Stack Top -> 0 (Solicited stack type)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	696 @ !!FOR THUMB ONLY!! 0/0x20 Saved state mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	697 @ r4 Saved r4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	698 @ r5 Saved r5
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	699 @ r6 Saved r6
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	700 @ r7 Saved r7
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	701 @ r8 Saved r8
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	702 @ r9/sb Saved r9/sl
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	703 @ r10/sl Saved r10/sl
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	704 @ fp Saved fp
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	705 @ r12 Saved r12
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	706 @ (Higher Address) Stack Bottom-> r15 Saved r15
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	707
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	708
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	709 LDR r2,Signal_Shell @ Pickup address of shell entry
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	710 SUB r3,r3,#4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	711 STR r2,[r3], #-4 @ Store entry address on stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	712 ADD r2,r3,#4 @ Compute initial r13
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	713 STR r2,[r3], #-4 @ Store initial r12
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	714 STR r2,[r3], #-4 @ Store initial fp
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	715 LDR r2,[r0,#0x24] @ Pickup the stack starting address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	716 STR r2,[r3], #-4 @ Store initial r10/sl
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	717 MOV r2,#0 @ Clear value for initial registers
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	718 STR r2,[r3], #-4 @ Store initial r9/sb
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	719 STR r2,[r3], #-4 @ Store initial r8
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	720 STR r2,[r3], #-4 @ Store initial r7
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	721 STR r2,[r3], #-4 @ Store initial r6
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	722 STR r2,[r3], #-4 @ Store initial r5
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	723 STR r2,[r3], #-4 @ Store initial r4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	724 #if 0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	725 MOV r1,#0x20 @ Get initial state mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	726 STR r1,[r3], #-4 @ Store initial state mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	727 #else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	728 STR r2,[r3], #-4 @ TCC_Signal_Shell is an ARM proc
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	729 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	730
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	731 STR r2,[r3, #0] @ Store solicited stack type on the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	732 @ top of the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	733
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	734 @ Save the new stack pointer into the task's control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	735 @ task -> tc_stack_pointer = (VOID *) (REG_Stack_Ptr - REG_Stack_Size);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	736
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	737 STR r3,[r0, #0x2C] @ Save stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	738
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	739 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	740
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	741 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	742
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	743 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	744 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	745 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	746 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	747 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	748 * TCT_Check_Stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	749 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	750 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	751 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	752 * This function checks the current stack for overflow conditions.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	753 * Additionally, this function keeps track of the minimum amount
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	754 * of stack space for the calling thread and returns the current
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	755 * available stack space.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	756 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	757 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	758 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	759 * TCC_Send_Signals Send signals to a task
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	760 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	761 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	762 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	763 * ERC_System_Error System error handler
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	764 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	765 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	766 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	767 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	768 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	769 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	770 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	771 * available bytes in stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	772 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	773 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	774 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	775 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	776 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	777 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	778 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	779 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	780 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	781 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	782
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	783 @UNSIGNED TCT_Check_Stack(void)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	784 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	785
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	786 .globl TCT_Check_Stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	787 TCT_Check_Stack:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	788
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	789 @TC_TCB *thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	790 @UNSIGNED remaining;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	791
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	792 @ Pickup the current task/HISR pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	793 @ thread = (TC_TCB *) TCD_Current_Thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	794
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	795 LDR r0,Current_Thread @ Pickup address of thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	796 LDR r0,[r0,#0] @ Pickup thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	797
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	798 @ Determine if there is a current thread.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	799 @ if (thread)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	800 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	801
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	802 CMP r0,#0 @ Determine if a thread is active
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	803 MOV r3,#0 @ Default remaining value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	804 BEQ TCT_Skip_Stack_Check @ If NU_NULL, skip stack checking
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	805
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	806 @ Determine if the stack pointers are out of range.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	807 @ if ((thread -> tc_stack_pointer < thread -> tc_stack_start) \|\|
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	808 @ (thread -> tc_stack_pointer > thread -> tc_stack_end))
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	809
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	810 LDR r2,[r0,#0x24] @ Pickup start of stack area
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	811 CMP r13,r2 @ Compare with current stack ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	812 BLT TCT_Stack_Range_Error @ If less, stack is out of range
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	813 LDR r1,[r0,#0x28] @ Pickup end of stack area
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	814 CMP r13,r1 @ Compare with current stack ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	815 BLE TCT_Stack_Range_Okay @ If less, stack range is okay
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	816
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	817 @ Stack overflow condition exits.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	818 @ ERC_System_Error(NU_STACK_OVERFLOW);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	819
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	820 TCT_Stack_Range_Error:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	821
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	822 STR r14,[r13, #4]! @ Store r14 on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	823 MOV r0,#3 @ Build NU_STACK_OVERFLOW code
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	824 BL ERC_System_Error @ Call system error handler. Note:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	825 @ control is not returned!
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	826 @ Examine stack to find return
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	827 @ address of this routine.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	828
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	829 TCT_Stack_Range_Okay:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	830
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	831 @ Calculate the amount of available space on the stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	832 @ remaining = (BYTE_PTR) thread -> tc_stack_pointer -
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	833 @ (BYTE_PTR) thread -> tc_stack_start;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	834
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	835 SUB r3,r13,r2 @ Calculate remaining stack size
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	836
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	837 @ Determine if there is enough memory on the stack to save all of the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	838 @ registers.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	839 @ if (remaining < 80)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	840
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	841 CMP r3,#80 @ Is there enough room for an
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	842 @ interrupt frame?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	843 BCS TCT_No_Stack_Error @ If so, no stack overflow yet
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	844
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	845 @ Stack overflow condition is about to happen.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	846 @ ERC_System_Error(NU_STACK_OVERFLOW);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	847
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	848 STR r14,[r13, #4]! @ Store r14 on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	849 MOV r0,#3 @ Build NU_STACK_OVERFLOW code
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	850 BL ERC_System_Error @ Call system error handler. Note:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	851 @ control is not returned!
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	852 @ Examine stack to find return
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	853 @ address of this routine.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	854
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	855 TCT_No_Stack_Error:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	856
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	857 @ Determine if this is a new minimum amount of stack space.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	858 @ if (remaining < thread -> tc_stack_minimum)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	859
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	860 LDR r2,[r0,#0x34]
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	861 CMP r3,r2
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	862 STRCC r3,[r0,#0x34]
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	863
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	864 @ Save the new stack minimum.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	865 @ thread -> tc_stack_minimum = remaining;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	866 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	867 @ else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	868
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	869 @ Set the remaining bytes to 0.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	870 @ remaining = 0;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	871
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	872 @ Return the remaining number of bytes on the stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	873 @ return(remaining);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	874
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	875 TCT_Skip_Stack_Check:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	876 MOV r0,r3 @ Return remaining bytes
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	877
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	878 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	879
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	880 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	881
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	882 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	883 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	884 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	885 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	886 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	887 * TCT_Schedule
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	888 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	889 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	890 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	891 * This function waits for a thread to become ready. Once a thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	892 * is ready, this function initiates a transfer of control to that
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	893 * thread.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	894 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	895 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	896 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	897 * INC_Initialize Main initialization routine
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	898 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	899 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	900 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	901 * TCT_Control_To_Thread Transfer control to a thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	902 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	903 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	904 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	905 * TCD_Execute_Task Pointer to task to execute
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	906 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	907 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	908 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	909 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	910 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	911 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	912 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	913 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	914 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	915 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	916 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	917 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	918 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	919 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	920
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	921 @VOID TCT_Schedule(void)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	922 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	923
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	924 .globl TCT_Schedule
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	925 TCT_Schedule:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	926
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	927 @ Restore interrupts according to the value contained in
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	928 @ TCD_Interrupt_Level.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	929
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	930 LDR r1,Int_Level @ Build address of interrupt level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	931 MRS r0,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	932 LDR r2,[r1, #0] @ Pickup current interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	933 BIC r0,r0,#LOCK_MSK @ Clear the interrupt lockout bits
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	934 ORR r0,r0,r2 @ Build new interrupt lockout CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	935 MSR CPSR,r0 @ Setup new CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	936 LDR r2,Execute_HISR @ Pickup TCD_Execute_HISR address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	937 LDR r3,Execute_Task @ Pickup TCD_Execute_Task address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	938
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	939 #ifdef INCLUDE_PROVIEW
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	940 @ Nucleus ProView Hook
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	941 @ We check if upon entering TCT_Schedule we already have a task to excute.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	942 @ if not, we start IDLE.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	943 LDR r0,[r2, #0] @ Pickup highest priority HISR ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	944 CMP r0,#0 @ Is there a HISR active?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	945 BNE TCT_Schedule_Thread @ Found an HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	946 LDR r0,[r3, #0] @ Pickup highest priority Task ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	947 CMP r0,#0 @ Is there a task active?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	948 BNE TCT_Schedule_Thread @ If not, start IDLE.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	949 STR r2,[r13, #-4]! @ Save r2 on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	950 STR r3,[r13, #-4]! @ Save r3 on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	951 BL _NU_Idle_Hook
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	952 LDR r3,[r13], #4 @ Recover r2
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	953 LDR r2,[r13], #4 @ Recover r3
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	954 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	955
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	956
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	957 @ Wait until a thread (task or HISR) is available to execute.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	958 @ do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	959 @ {
570 962f0d3a4e7e gsm-fw/nucleus/tct.S: preparations for hooking in GSM small sleep Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 143 diff changeset	960 .globl TCT_Schedule_Loop
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	961 TCT_Schedule_Loop:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	962
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	963 @ } while ((!TCD_Execute_HISR) && (!TCD_Execute_Task));
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	964
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	965 LDR r0,[r2, #0] @ Pickup highest priority HISR ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	966 CMP r0,#0 @ Is there a HISR active?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	967 BNE TCT_Schedule_Thread @ Found an HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	968 LDR r0,[r3, #0] @ Pickup highest priority Task ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	969 CMP r0,#0 @ Is there a task active?
570 962f0d3a4e7e gsm-fw/nucleus/tct.S: preparations for hooking in GSM small sleep Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 143 diff changeset	970 #if CONFIG_INCLUDE_L1
962f0d3a4e7e gsm-fw/nucleus/tct.S: preparations for hooking in GSM small sleep Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 143 diff changeset	971 BEQ _GSM_Small_Sleep
962f0d3a4e7e gsm-fw/nucleus/tct.S: preparations for hooking in GSM small sleep Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 143 diff changeset	972 #else
962f0d3a4e7e gsm-fw/nucleus/tct.S: preparations for hooking in GSM small sleep Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 143 diff changeset	973 BEQ TCT_Schedule_Loop @ If not, continue the search
962f0d3a4e7e gsm-fw/nucleus/tct.S: preparations for hooking in GSM small sleep Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 143 diff changeset	974 #endif
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	975
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	976 @ Yes, either a task or an HISR is ready to execute. Lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	977 @ interrupts while the thread is transferred to.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	978
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	979 TCT_Schedule_Thread:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	980 MRS r1,CPSR @ Pickup CPSR again
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	981 ORR r1,r1,#LOCKOUT @ Build interrupt lockout value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	982 MSR CPSR,r1 @ Lockout interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	983
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	984 @ Transfer control to the thread by falling through to the following
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	985 @ routine.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	986 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	987
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	988 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	989 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	990 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	991 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	992 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	993 * TCT_Control_To_Thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	994 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	995 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	996 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	997 * This function transfers control to the specified thread. Each
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	998 * time control is transferred to a thread, its scheduled counter
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	999 * is incremented. Additionally, time-slicing for task threads is
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1000 * enabled in this routine. The TCD_Current_Thread pointer is
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1001 * setup by this function.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1002 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1003 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1004 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1005 * TCT_Schedule Indirectly called
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1006 * TCT_Protect Protection task switch
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1007 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1008 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1009 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1010 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1011 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1012 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1013 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1014 * thread Thread control block pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1015 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1016 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1017 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1018 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1019 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1020 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1021 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1022 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1023 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1024 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1025 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1026 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1027 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1028 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1029
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1030 @VOID TCT_Control_To_Thread(TC_TCB *thread)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1031 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1032 TCT_Control_To_Thread:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1033
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1034 @ Setup the current thread pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1035 @ TCD_Current_Thread = (VOID *) thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1036
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1037 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1038 LDR r2,[r0, #0x1c] @ Pickup scheduled count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1039 STR r0,[r1, #0] @ Setup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1040
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1041 @ Increment the thread scheduled counter.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1042 @ thread -> tc_scheduled++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1043
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1044 LDR r3,[r0, #0x20] @ Pickup time slice value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1045 ADD r2,r2,#1 @ Increment the scheduled count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1046 STR r2,[r0, #0x1c] @ Store new scheduled count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1047
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1048 @ Check for time slice option.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1049 @ if (thread -> tc_cur_time_slice)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1050 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1051 CMP r3,#0 @ Is there a time slice?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1052 BEQ TCT_No_Start_TS_1 @ If 0, there is no time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1053
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1054 @ Start a time slice.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1055 @ TMD_Time_Slice = thread -> tc_cur_time_slice;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1056 @ TMD_Time_Slice_State = 0;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1057
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1058 LDR r2,Time_Slice @ Pickup address of TMD_Time_Slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1059 LDR r1,Slice_State @ Pickup address of
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1060 @ TMD_Time_Slice_State
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1061 STR r3,[r2, #0] @ Setup the time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1062 MOV r2,#0 @ Build active state flag
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1063 STR r2,[r1,#0] @ Set the active flag
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1064 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1065 TCT_No_Start_TS_1:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1066 #ifdef INCLUDE_PROVIEW
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1067 @ Nucleus ProView Hook
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1068
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1069 STR r0,[r13, #-4]! @ Save r0 on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1070 BL _NU_Schedule_Task_Hook @ Branch to RTView
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1071 LDR r0,[r13], #4 @ Recover return address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1072 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1073
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1074
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1075 @ Pickup the stack pointer and resume the thread.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1076 @ REG_Stack_Ptr = thread -> tc_stack_pointer;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1077
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1078 LDR r13,[r0, #0x2c] @ Switch to thread's stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1079
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1080 @ Pop off the saved information associated with the thread. After we
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1081 @ determine which type of stack is present. A 1 on the top of the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1082 @ stack indicates an interrupt stack, while a 0 on the top of the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1083 @ stack indicates a solicited type of stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1084
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1085 @ Remember that the interrupt level that is restored must represent
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1086 @ the interrupt level in TCD_Interrupt_Level.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1087
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1088 LDR r1,[r13], #4 @ Pop off the stack type
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1089 CMP r1,#1 @ See if it is an interrupt stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1090 BEQ TCT_Interrupt_Resume @ If so, an interrupt resume of
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1091 @ thread is required
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1092 LDR r1, Int_Level @ Pickup address of interrupt
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1093 @ lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1094 MRS r0,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1095 BIC r0,r0,#LOCK_MSK @ Clear lockout mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1096
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1097 BIC r0,r0,#0x80000000
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1098
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1099
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1100 LDR r2,[r1, #0] @ Pickup interrupt lockout mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1101 ORR r0,r0,r2 @ Build new interrupt lockout mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1102 #if 1 /* was .if THUMB */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1103 LDR r2,[r13], #4 @ Pop off the state mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1104 ORR r0,r0,r2 @ Set appropriate state
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1105 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1106 MSR SPSR,r0 @ Place it into the SPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1107 LDMIA r13!,{r4-r12,r15}^ @ A solicited return is required.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1108 @ This type of return only
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1109 @ recovers r4-r13 & r15
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1110 TCT_Interrupt_Resume:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1111 LDR r0,[r13], #4 @ Pop off the CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1112 LDR r1,Int_Level @ Pickup address of interrupt
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1113 @ lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1114 BIC r0,r0,#LOCK_MSK @ Clear lockout mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1115 LDR r2,[r1, #0] @ Pickup interrupt lockout mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1116 ORR r0,r0,r2 @ Build new interrupt lockout mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1117 MSR SPSR,r0 @ Place it into the SPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1118 LDMIA r13,{r0-r15}^ @ Recover all registers and resume
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1119 @ at point of interrupt
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1120 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1121
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1122 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1123 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1124 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1125 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1126 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1127 * TCT_Control_To_System
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1128 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1129 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1130 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1131 * This function returns control from a thread to the system. Note
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1132 * that this service is called in a solicited manner, i.e. it is
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1133 * not called from an interrupt thread. Registers required by the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1134 * compiler to be preserved across function boundaries are saved by
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1135 * this routine. Note that this is usually a sub-set of the total
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1136 * number of available registers.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1137 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1138 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1139 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1140 * Other Components
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1141 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1142 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1143 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1144 * TCT_Schedule Schedule the next thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1145 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1146 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1147 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1148 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1149 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1150 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1151 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1152 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1153 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1154 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1155 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1156 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1157 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1158 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1159 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1160 * C. Meredith 03-01-1994 Corrected problem in time-slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1161 * reset logic, resulting in
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1162 * version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1163 * D. Lamie 03-18-1994 Verified version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1164 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1165 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1166 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1167
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1168 @VOID TCT_Control_To_System(void)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1169 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1170
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1171 .globl TCT_Control_To_System
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1172 TCT_Control_To_System:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1173
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1174 @ Lockout interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1175
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1176 MRS r0,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1177 ORR r0,r0,#LOCKOUT @ Build interrupt lockout value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1178 MSR CPSR,r0 @ Lockout interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1179
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1180 @ Save a minimal context of the thread.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1181
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1182 STMDB r13!,{r4-r12,r14} @ Save minimal context of thread on
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1183 @ the current stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1184 #if 1 /* was .if THUMB */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1185 MOV r2,r14 @ Determine what state the caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1186 MOV r2,r2,LSL #31 @ was in and build an
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1187 MOV r2,r2,LSR #26 @ appropriate state mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1188 STR r2,[r13, #-4]! @ Place it on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1189 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1190
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1191 MOV r2,#0 @ Build solicited stack type value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1192 @ and NU_NULL value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1193 STR r2,[r13, #-4]! @ Place it on the top of the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1194
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1195 @ Setup a pointer to the thread control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1196 @ REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1197
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1198 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1199 LDR r0,[r1, #0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1200
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1201 @ Clear the current thread control block pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1202 @ TCD_Current_Thread = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1203
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1204 LDR r3,Slice_State @ Pickup time slice state address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1205 STR r2,[r1, #0] @ Set current thread pointer to
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1206 @ NU_NULL
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1207
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1208 @ Check to see if a time slice is active. If so, copy the original time
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1209 @ slice into the current time slice field of the task's control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1210 @ if (TMD_Time_Slice_State == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1211 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1212 LDR r1,[r3, #0] @ Pickup time slice state flag
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1213 CMP r1,#0 @ Compare with active value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1214 BNE TCT_No_Stop_TS_1 @ If non-active, don't disable
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1215
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1216
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1217 @ Insure that the next time the task runs it gets a fresh time
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1218 @ slice.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1219 @ REG_Thread_Ptr -> tc_cur_time_slice = REG_Thread_Ptr -> tc_time_slice;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1220
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1221 LDR r1,[r0, #0x40] @ Pickup original time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1222
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1223 @ Clear any active time slice by setting the state to NOT_ACTIVE.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1224 @ TMD_Time_Slice_State = 1;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1225
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1226 MOV r2,#1 @ Build disable value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1227 STR r2,[r3, #0] @ Disable time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1228 STR r1,[r0, #0x20] @ Reset current time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1229 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1230 TCT_No_Stop_TS_1:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1231
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1232 @ Save off the current stack pointer in the control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1233 @ REG_Thread_Ptr -> tc_stack_pointer = (VOID *) REG_Stack_Ptr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1234
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1235 STR r13,[r0, #0x2c] @ Save the thread's stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1236
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1237 @ Clear the task's current protection.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1238 @ (REG_Thread_Ptr -> tc_current_protect) -> tc_tcb_pointer = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1239 @ REG_Thread_Ptr -> tc_current_protect = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1240
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1241 LDR r1,[r0, #0x38] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1242 MOV r2,#0 @ Build NU_NULL value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1243 STR r2,[r0, #0x38] @ Clear the protect pointer field
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1244 STR r2,[r1, #0] @ Release the actual protection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1245
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1246 @ Switch to the system stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1247 @ REG_Stack_Ptr = TCD_System_Stack;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1248
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1249 LDR r1, System_Stack @ Pickup address of stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1250 LDR r2, System_Limit @ Pickup address of stack limit ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1251 LDR r13,[r1, #0] @ Switch to system stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1252 LDR r10,[r2, #0] @ Setup system stack limit
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1253
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1254 @ Finished, return to the scheduling loop.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1255
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1256 B TCT_Schedule @ Return to scheduling loop
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1257 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1258
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1259 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1260 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1261 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1262 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1263 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1264 * TCT_Signal_Exit
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1265 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1266 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1267 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1268 * This function exits from a signal handler. The primary purpose
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1269 * of this function is to clear the scheduler protection and switch
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1270 * the stack pointer back to the normal task's stack pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1271 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1272 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1273 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1274 * TCC_Signal_Shell Signal handling shell func
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1275 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1276 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1277 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1278 * TCT_Schedule Scheduler
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1279 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1280 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1281 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1282 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1283 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1284 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1285 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1286 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1287 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1288 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1289 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1290 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1291 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1292 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1293 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1294 * C. Meredith 03-01-1994 Corrected problem in time-slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1295 * reset logic, resulting in
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1296 * version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1297 * D. Lamie 03-18-1994 Verified version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1298 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1299 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1300 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1301
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1302 @VOID TCT_Signal_Exit(void)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1303 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1304
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1305 .globl TCT_Signal_Exit
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1306 TCT_Signal_Exit:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1307
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1308 @ Lockout interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1309
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1310 MRS r3,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1311 ORR r3,r3,#LOCKOUT @ Build lockout value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1312 MSR CPSR,r3 @ Lockout interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1313
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1314 @ Setup a pointer to the thread control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1315 @ REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1316
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1317 LDR r1,Current_Thread @ Pickup address of thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1318 MOV r2,#0 @ Build NU_NULL value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1319 LDR r0,[r1,#0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1320
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1321 @ Clear the current thread control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1322 @ TCD_Current_Thread = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1323
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1324 LDR r3,Slice_State @ Pickup time slice state address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1325 STR r2,[r1, #0] @ Clear current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1326
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1327 @ Check to see if a time slice is active. If so, copy the original time
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1328 @ slice into the current time slice field of the task's control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1329 @ if (TMD_Time_Slice_State == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1330 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1331
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1332 LDR r1,[r3, #0] @ Pickup time slice state flag
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1333 CMP r1,#0 @ Compare with active value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1334 BNE TCT_No_Stop_TS_2 @ If non-active, don't disable
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1335
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1336 @ Insure that the next time the task runs it gets a fresh time
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1337 @ slice.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1338 @ REG_Thread_Ptr -> tc_cur_time_slice = REG_Thread_Ptr -> tc_time_slice;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1339
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1340 LDR r1,[r0, #0x40] @ Pickup original time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1341
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1342 @ Clear any active time slice by setting the state to NOT_ACTIVE.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1343 @ TMD_Time_Slice_State = 1;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1344
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1345 MOV r2,#1 @ Build disable value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1346 STR r2,[r3, #0] @ Disable time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1347 STR r1,[r0, #0x20] @ Reset current time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1348 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1349 TCT_No_Stop_TS_2:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1350
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1351 @ Switch back to the saved stack. The saved stack pointer was saved
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1352 @ before the signal frame was built.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1353 @ REG_Thread_Ptr -> tc_stack_pointer =
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1354 @ REG_Thread_Ptr -> tc_saved_stack_ptr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1355
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1356 LDR r1,[r0, #0x3c] @ Pickup saved stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1357 STR r1,[r0, #0x2c] @ Place in current stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1358
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1359 @ Clear the task's current protection.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1360 @ (REG_Thread_Ptr -> tc_current_protect) -> tc_tcb_pointer = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1361 @ REG_Thread_Ptr -> tc_current_protect = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1362
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1363 LDR r1,[r0, #0x38] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1364 MOV r2,#0 @ Build NU_NULL value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1365 STR r2,[r0, #0x38] @ Clear the protect pointer field
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1366 STR r2,[r1, #0] @ Release the actual protection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1367
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1368 @ Switch to the system stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1369 @ REG_Stack_Ptr = (BYTE_PTR) TCD_System_Stack;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1370
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1371 LDR r1, System_Stack @ Pickup address of stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1372 LDR r2, System_Limit @ Pickup address of stack limit ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1373 LDR r13,[r1, #0] @ Switch to system stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1374 LDR r10,[r2, #0] @ Setup system stack limit
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1375
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1376 @ Finished, return to the scheduling loop.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1377
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1378 B TCT_Schedule @ Return to scheduling loop
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1379 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1380
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1381 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1382 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1383 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1384 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1385 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1386 * TCT_Current_Thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1387 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1388 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1389 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1390 * This function returns the current thread pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1391 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1392 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1393 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1394 * Application
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1395 * System Components
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1396 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1397 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1398 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1399 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1400 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1401 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1402 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1403 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1404 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1405 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1406 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1407 * Pointer to current thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1408 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1409 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1410 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1411 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1412 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1413 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1414 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1415 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1416 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1417 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1418
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1419 @VOID *TCT_Current_Thread(void)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1420 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1421
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1422 .globl TCT_Current_Thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1423 TCT_Current_Thread:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1424
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1425 @ Return the current thread pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1426 @ return(TCD_Current_Thread);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1427
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1428 LDR r0, Current_Thread @ Pickup address of thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1429 LDR r0,[r0, #0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1430
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1431 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1432
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1433 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1434
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1435 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1436 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1437 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1438 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1439 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1440 * TCT_Set_Execute_Task
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1441 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1442 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1443 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1444 * This function sets the current task to execute variable under
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1445 * protection against interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1446 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1447 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1448 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1449 * TCC Scheduling Routines
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1450 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1451 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1452 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1453 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1454 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1455 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1456 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1457 * task Pointer to task control block
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1458 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1459 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1460 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1461 * TCD_Execute_Task Modified variable
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1462 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1463 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1464 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1465 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1466 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1467 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1468 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1469 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1470 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1471 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1472
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1473 @VOID TCT_Set_Execute_Task(TC_TCB *task)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1474 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1475
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1476 .globl TCT_Set_Execute_Task
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1477 TCT_Set_Execute_Task:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1478
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1479 @ Now setup the TCD_Execute_Task pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1480 @ TCD_Execute_Task = task;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1481
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1482 LDR r1, Execute_Task @ Pickup execute task ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1483 STR r0,[r1,#0] @ Setup new task to execute
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1484
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1485 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1486
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1487 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1488
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1489 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1490 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1491 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1492 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1493 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1494 * TCT_Protect
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1495 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1496 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1497 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1498 * This function protects against multiple thread access.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1499 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1500 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1501 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1502 * Application
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1503 * System Components
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1504 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1505 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1506 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1507 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1508 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1509 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1510 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1511 * protect Pointer to protection block
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1512 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1513 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1514 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1515 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1516 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1517 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1518 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1519 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1520 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1521 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1522 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1523 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1524 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1525 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1526
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1527 @VOID TCT_Protect(TC_PROTECT *protect)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1528 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1529
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1530 .globl TCT_Protect
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1531 TCT_Protect:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1532
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1533 @ Determine if the caller is in a task or HISR thread.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1534 @ if (TCD_Current_Thread)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1535 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1536
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1537 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1538 LDR r3,[r1, #0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1539 CMP r3,#0 @ Check to see if it is non-NULL
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1540 BEQ TCT_Skip_Protect @ If NULL, skip protection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1541
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1542 @ Lockout interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1543
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1544 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1545 ORR r1,r1,#LOCKOUT @ Place lockout value in
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1546 MSR CPSR,r1 @ Lockout interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1547
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1548 @ Wait until the protect structure is available.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1549 @ while (protect -> tc_tcb_pointer != NU_NULL)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1550 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1551
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1552 TCT_Protect_Loop:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1553 LDR r1,[r0, #0] @ Pickup protection owner field
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1554 CMP r1,#0 @ Is there any protection?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1555 BEQ TCT_Protect_Available @ If NU_NULL, no current protection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1556
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1557 @ Protection structure is not available.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1558
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1559 @ Indicate that another thread is waiting.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1560 @ protect -> tc_thread_waiting = 1;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1561
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1562 MOV r2,#1 @ Build thread waiting flag
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1563 STR r2,[r0, #4] @ Set waiting field
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1564
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1565 @ Directly schedule the thread waiting.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1566 @ TCT_Schedule_Protected(protect -> tc_tcb_pointer);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1567
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1568 STR r0,[r13, #-4]! @ Save r0 on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1569 STR r14,[r13, #-4]! @ Save r14 on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1570 MOV r0,r3 @ Place current thread into r0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1571 BL TCT_Schedule_Protected @ Call routine to schedule the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1572 @ owner of the thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1573
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1574 LDR r14,[r13], #4 @ Recover saved r14
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1575 LDR r0,[r13], #4 @ Recover saved r0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1576
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1577 @ Lockout interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1578
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1579 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1580 LDR r3,[r1, #0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1581 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1582 ORR r1,r1,#LOCKOUT @ Place lockout value in
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1583 MSR CPSR,r1 @ Lockout interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1584 B TCT_Protect_Loop @ Examine protect flags again
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1585 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1586 TCT_Protect_Available:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1587
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1588 @ Protection structure is available.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1589
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1590 @ Indicate that this thread owns the protection.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1591 @ protect -> tc_tcb_pointer = TCD_Current_Thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1592
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1593 STR r3,[r0, #0] @ Indicate calling thread owns this
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1594 @ protection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1595
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1596 @ Clear the thread waiting flag.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1597 @ protect -> tc_thread_waiting = 0;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1598
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1599 MOV r2,#0 @ Clear value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1600 STR r2,[r0, #4] @ Clear the thread waiting flag
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1601
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1602 @ Save the protection pointer in the thread's control block. Note
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1603 @ that both task and HISR threads share the same control block
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1604 @ format.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1605 @ REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1606 @ REG_Thread_Ptr -> tc_current_protect = protect;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1607
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1608 STR r0,[r3, #0x38] @ Setup current protection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1609
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1610 @ Restore interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1611
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1612 LDR r2,Int_Level @ Pickup address of interrupt level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1613 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1614 LDR r3,[r2, #0] @ Pickup interrupt lockout level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1615 BIC r1,r1,#LOCK_MSK @ Clear lockout bits
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1616 ORR r1,r1,r3 @ Build new interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1617 MSR CPSR,r1 @ Setup CPSR appropriately
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1618 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1619
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1620 TCT_Skip_Protect:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1621
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1622 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1623
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1624 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1625
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1626 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1627 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1628 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1629 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1630 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1631 * TCT_Unprotect
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1632 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1633 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1634 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1635 * This function releases protection of the currently active
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1636 * thread. If the caller is not an active thread, then this
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1637 * request is ignored.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1638 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1639 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1640 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1641 * Application
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1642 * System Components
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1643 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1644 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1645 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1646 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1647 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1648 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1649 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1650 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1651 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1652 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1653 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1654 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1655 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1656 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1657 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1658 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1659 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1660 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1661 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1662 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1663 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1664 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1665
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1666 @VOID TCT_Unprotect(void)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1667 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1668
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1669 .globl TCT_Unprotect
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1670 TCT_Unprotect:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1671
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1672
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1673 @ Determine if the caller is in a task or HISR thread.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1674 @ if (TCD_Current_Thread)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1675 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1676
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1677 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1678 LDR r3,[r1, #0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1679 CMP r3,#0 @ Check to see if it is non-NULL
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1680 BEQ TCT_Skip_Unprotect @ If NULL, skip unprotection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1681
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1682 @ Setup a thread control block pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1683 @ REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1684
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1685 @ Determine if there is a currently active protection.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1686 @ if (REG_Thread_Ptr -> tc_current_protect)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1687 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1688
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1689 LDR r0,[r3, #0x38] @ Pickup current protect field
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1690 CMP r0,#0 @ Is there a protection in force?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1691 BEQ TCT_Skip_Unprotect @ If not, nothing is protected
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1692
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1693 @ Lockout interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1694
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1695 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1696 ORR r1,r1,#LOCKOUT @ Place lockout value in
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1697 MSR CPSR,r1 @ Lockout interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1698
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1699 @ Yes, this thread still has this protection structure.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1700 @ REG_Protect_Ptr = REG_Thread_Ptr -> tc_current_protect;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1701
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1702 @ Is there a higher priority thread waiting for the protection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1703 @ structure?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1704 @ if (REG_Protect_Ptr -> tc_thread_waiting)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1705
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1706 LDR r2,[r0, #4] @ Pickup thread waiting flag
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1707 CMP r2,#0 @ Are there any threads waiting?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1708 BEQ TCT_Not_Waiting_Unpr @ If not, just release protection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1709
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1710 @ Transfer control to the system. Note that this
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1711 @ automatically clears the current protection and it returns
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1712 @ to the caller of this routine instead of this routine.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1713 @ TCT_Control_To_System();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1714
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1715 B TCT_Control_To_System @ Return control to the system
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1716
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1717 @ else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1718 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1719 TCT_Not_Waiting_Unpr:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1720
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1721 @ Clear the protection.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1722 @ REG_Thread_Ptr -> tc_current_protect = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1723 @ REG_Protect_Ptr -> tc_tcb_pointer = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1724
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1725 MOV r2,#0 @ Build NU_NULL value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1726 STR r2,[r0, #0] @ Release the protection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1727 STR r2,[r3, #0x38] @ Clear protection pointer in the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1728 @ control block
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1729
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1730 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1731
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1732 TCT_Not_Protected:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1733 @ Restore interrupts again.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1734
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1735 LDR r2,Int_Level @ Pickup address of interrupt level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1736 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1737 LDR r3,[r2, #0] @ Pickup interrupt lockout level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1738 BIC r1,r1,#LOCK_MSK @ Clear lockout bits
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1739 ORR r1,r1,r3 @ Build new interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1740 MSR CPSR,r1 @ Setup CPSR appropriately
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1741
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1742 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1743 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1744 TCT_Skip_Unprotect:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1745
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1746 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1747
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1748 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1749
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1750 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1751 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1752 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1753 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1754 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1755 * TCT_Unprotect_Specific
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1756 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1757 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1758 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1759 * This function releases a specific protection structure.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1760 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1761 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1762 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1763 * Application
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1764 * System Components
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1765 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1766 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1767 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1768 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1769 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1770 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1771 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1772 * protect Pointer to protection block
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1773 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1774 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1775 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1776 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1777 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1778 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1779 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1780 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1781 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1782 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1783 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1784 * C. Meredith 03-01-1994 Corrected problem in time-slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1785 * reset logic, corrected bug
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1786 * using protect ptr, resulting
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1787 * in version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1788 * D. Lamie 03-18-1994 Verified version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1789 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1790 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1791 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1792
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1793 @VOID Specific(TC_PROTECT *protect)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1794 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1795
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1796 .globl TCT_Unprotect_Specific
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1797 TCT_Unprotect_Specific:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1798
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1799 @ Determine if the caller is in a task or HISR thread.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1800 @ if (TCD_Current_Thread)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1801 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1802
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1803 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1804 LDR r3,[r1, #0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1805 CMP r3,#0 @ Check to see if it is non-NULL
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1806 BEQ TCT_Skip_Unprot_Spec @ If NULL, skip unprotect specific
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1807
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1808 @ Lockout interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1809
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1810 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1811 ORR r1,r1,#LOCKOUT @ Place lockout value in
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1812 MSR CPSR,r1 @ Lockout interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1813
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1814 @ Clear the protection pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1815 @ protect -> tc_tcb_pointer = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1816
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1817 MOV r2,#0 @ Build NU_NULL value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1818 STR r2,[r0, #0] @ Clear protection ownership
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1819
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1820 @ Determine if a thread is waiting.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1821 @ if (protect -> tc_thread_waiting)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1822 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1823
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1824 LDR r1,[r0, #4] @ Pickup the waiting field
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1825 CMP r1,#0 @ Is there another thread waiting?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1826 BEQ TCT_Not_Waiting_Unspec @ No, restore interrupts and return
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1827
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1828 @ A higher-priority thread is waiting.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1829
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1830 @ Save a minimal context of the thread.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1831
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1832 STMDB r13!,{r4-r12,r14} @ Save minimal context of thread on
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1833 @ the current stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1834
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1835 #if 1 /* was .if THUMB */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1836 MOV r2,r14 @ Determine what state the caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1837 MOV r2,r2,LSL #31 @ was in and build an
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1838 MOV r2,r2,LSR #26 @ appropriate state mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1839 STR r2,[r13, #-4]! @ Place it on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1840 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1841
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1842 MOV r2,#0 @ Build solicited stack type value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1843 @ and NU_NULL value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1844 STR r2,[r13, #-4]! @ Place it on the top of the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1845
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1846 @ Setup a pointer to the thread control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1847 @ REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1848
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1849 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1850 LDR r0,[r1, #0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1851
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1852 @ Clear the current thread control block pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1853 @ TCD_Current_Thread = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1854
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1855 LDR r3,Slice_State @ Pickup time slice state address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1856 STR r2,[r1, #0] @ Set current thread pointer to
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1857 @ NU_NULL
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1858
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1859 @ Check to see if a time slice is active. If so, copy the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1860 @ original time slice into the current time slice field of the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1861 @ thread's control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1862 @ if (TMD_Time_Slice_State == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1863 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1864
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1865 LDR r1,[r3, #0] @ Pickup time slice state flag
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1866 CMP r1,#0 @ Compare with active value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1867 BNE TCT_No_Stop_TS_3 @ If non-active, don't disable
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1868
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1869 @ Insure that the next time the task runs it gets a fresh time
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1870 @ slice.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1871 @ REG_Thread_Ptr -> tc_cur_time_slice =
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1872 @ REG_Thread_Ptr -> tc_time_slice;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1873
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1874 LDR r1,[r0, #0x40] @ Pickup original time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1875
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1876 @ Clear any active time slice by setting the state to
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1877 @ NOT_ACTIVE.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1878 @ TMD_Time_Slice_State = 1;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1879
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1880 MOV r2,#1 @ Build disable value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1881 STR r2,[r3, #0] @ Disable time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1882 STR r1,[r0, #0x20] @ Reset current time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1883 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1884
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1885 TCT_No_Stop_TS_3:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1886
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1887 @ Save off the current stack pointer in the control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1888 @ REG_Thread_Ptr -> tc_stack_pointer = (VOID *) REG_Stack_Ptr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1889
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1890 STR r13,[r0, #0x2c] @ Save the thread's stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1891
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1892 @ Switch to the system stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1893 @ REG_Stack_Ptr = TCD_System_Stack;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1894
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1895 LDR r1,System_Stack @ Pickup address of stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1896 LDR r2,System_Limit @ Pickup address of stack limit ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1897 LDR r13,[r1, #0] @ Switch to system stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1898 LDR r10,[r2, #0] @ Setup system stack limit
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1899
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1900 @ Finished, return to the scheduling loop.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1901
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1902 B TCT_Schedule @ Return to scheduling loop
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1903
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1904 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1905 @ else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1906 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1907 TCT_Not_Waiting_Unspec:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1908
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1909 @ No higher-priority thread is waiting.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1910
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1911 @ Restore interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1912
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1913 LDR r2,Int_Level @ Pickup address of interrupt level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1914 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1915 LDR r3,[r2, #0] @ Pickup interrupt lockout level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1916 BIC r1,r1,#LOCK_MSK @ Clear lockout bits
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1917 ORR r1,r1,r3 @ Build new interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1918 MSR CPSR,r1 @ Setup CPSR appropriately
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1919
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1920 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1921 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1922
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1923 TCT_Skip_Unprot_Spec:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1924
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1925 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1926
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1927 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1928
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1929 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1930 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1931 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1932 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1933 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1934 * TCT_Set_Current_Protect
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1935 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1936 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1937 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1938 * This function sets the current protection field of the current
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1939 * thread's control block to the specified protection pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1940 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1941 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1942 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1943 * TCC_Resume_Task Resume task function
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1944 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1945 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1946 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1947 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1948 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1949 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1950 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1951 * protect Pointer to protection block
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1952 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1953 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1954 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1955 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1956 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1957 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1958 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1959 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1960 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1961 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1962 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1963 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1964 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1965 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1966
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1967 @VOID TCT_Set_Current_Protect(TC_PROTECT *protect)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1968 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1969
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1970 .globl TCT_Set_Current_Protect
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1971 TCT_Set_Current_Protect:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1972
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1973 @ Determine if the caller is in a task or HISR thread.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1974 @ if (TCD_Current_Thread)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1975 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1976
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1977 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1978 LDR r3,[r1, #0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1979 CMP r3,#0 @ Check to see if a thread is
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1980 @ active
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1981
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1982 @ Point at the current thread control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1983 @ REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1984
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1985 @ Modify the current protection.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1986 @ REG_Thread_Ptr -> tc_current_protect = protect;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1987
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1988 STRNE r0,[r3, #0x38] @ Setup new protection
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1989 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1990
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1991
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1992 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1993
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1994 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1995
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1996 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1997 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1998 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1999 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2000 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2001 * TCT_Protect_Switch
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2002 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2003 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2004 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2005 * This function waits until a specific task no longer has any
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2006 * protection associated with it. This is necessary since task's
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2007 * cannot be suspended or terminated unless they have released all
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2008 * of their protection.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2009 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2010 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2011 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2012 * System Components
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2013 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2014 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2015 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2016 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2017 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2018 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2019 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2020 * thread Pointer to thread control blk
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2021 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2022 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2023 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2024 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2025 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2026 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2027 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2028 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2029 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2030 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2031 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2032 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2033 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2034 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2035
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2036 @VOID TCT_Protect_Switch(VOID *thread)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2037 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2038
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2039 .globl TCT_Protect_Switch
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2040 TCT_Protect_Switch:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2041
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2042 @ Lockout interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2043
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2044 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2045 ORR r1,r1,#LOCKOUT @ Place lockout value in
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2046 MSR CPSR,r1 @ Lockout interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2047
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2048 @ REG_Thread_Ptr = (TC_TCB *) thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2049
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2050 @ Wait until the specified task has no protection associated with it.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2051 @ while (REG_Thread_Ptr -> tc_current_protect)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2052 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2053
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2054 LDR r1,[r0, #0x38] @ Pickup protection of specified
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2055 @ thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2056 CMP r1,#0 @ Does the specified thread have
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2057 @ an active protection?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2058 BEQ TCT_Switch_Done @ If not, protect switch is done
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2059
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2060 @ Let the task run again in an attempt to clear its protection.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2061
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2062 @ Indicate that a higher priority thread is waiting.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2063 @ (REG_Thread_Ptr -> tc_current_protect) -> tc_thread_waiting = 1;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2064
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2065 MOV r2,#1 @ Build waiting flag value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2066 STR r2,[r1, #4] @ Set waiting flag of the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2067 @ protection owned by the other
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2068 @ thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2069
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2070 @ Directly schedule the thread waiting.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2071 @ TCT_Schedule_Protected((REG_Thread_Ptr -> tc_current_protect)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2072 @ -> tc_tcb_pointer);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2073
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2074 LDR r2,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2075 STR r0,[r13, #-4]! @ Save r0 on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2076 STR r14,[r13, #-4]! @ Save r14 on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2077 MOV r1,r0 @ Move new thread into r1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2078 LDR r0,[r2, #0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2079 BL TCT_Schedule_Protected @ Call routine to schedule the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2080 @ owner of the thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2081
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2082 LDR r14,[r13], #4 @ Recover saved r14
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2083 LDR r0,[r13], #4 @ Recover saved r0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2084
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2085 @ Lockout interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2086
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2087 B TCT_Protect_Switch @ Branch to top of routine and
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2088 @ start over
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2089 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2090 TCT_Switch_Done:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2091
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2092 @ Restore interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2093
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2094 LDR r2,Int_Level @ Pickup address of interrupt level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2095 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2096 LDR r3,[r2, #0] @ Pickup interrupt lockout level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2097 BIC r1,r1,#LOCK_MSK @ Clear lockout bits
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2098 ORR r1,r1,r3 @ Build new interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2099 MSR CPSR,r1 @ Setup CPSR appropriately
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2100
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2101
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2102 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2103
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2104 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2105
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2106 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2107 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2108 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2109 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2110 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2111 * TCT_Schedule_Protected
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2112 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2113 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2114 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2115 * This function saves the minimal context of the thread and then
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2116 * directly schedules the thread that has protection over the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2117 * the thread that called this routine.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2118 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2119 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2120 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2121 * TCT_Protect
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2122 * TCT_Protect_Switch
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2123 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2124 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2125 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2126 * TCT_Control_To_Thread Transfer control to protected
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2127 * thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2128 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2129 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2130 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2131 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2132 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2133 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2134 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2135 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2136 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2137 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2138 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2139 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2140 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2141 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2142 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2143 * C. Meredith 03-01-1994 Corrected problem in time-slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2144 * reset logic, resulting in
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2145 * version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2146 * D. Lamie 03-18-1994 Verified version 1.1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2147 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2148 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2149 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2150
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2151 @VOID TCT_Schedule_Protected(VOID *thread)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2152 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2153
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2154 .globl TCT_Schedule_Protected
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2155 TCT_Schedule_Protected:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2156
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2157 @ Interrupts are already locked out by the caller.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2158
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2159 @ Save minimal context required by the system.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2160
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2161 STMDB r13!,{r4-r12,r14} @ Save minimal context of thread on
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2162 @ the current stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2163
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2164 #if 1 /* was .if THUMB */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2165 MOV r2,r14 @ Determine what state the caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2166 MOV r2,r2,LSL #31 @ was in and build an
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2167 MOV r2,r2,LSR #26 @ appropriate state mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2168 STR r2,[r13, #-4]! @ Place it on the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2169 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2170
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2171 MOV r2,#0 @ Build solicited stack type value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2172 @ and NU_NULL value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2173 STR r2,[r13, #-4]! @ Place it on the top of the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2174 MOV r4,r1 @ Save thread to schedule
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2175
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2176 @ Setup a pointer to the thread control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2177 @ REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2178
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2179 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2180
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2181 @ Clear the current thread control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2182 @ TCD_Current_Thread = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2183
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2184 LDR r3,Slice_State @ Pickup time slice state address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2185 STR r2,[r1, #0] @ Set current thread pointer to
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2186 @ NU_NULL
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2187
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2188 @ Check to see if a time slice is active. If so, copy the original time
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2189 @ slice into the current time slice field of the task's control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2190 @ if (TMD_Time_Slice_State == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2191 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2192
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2193 LDR r1,[r3, #0] @ Pickup time slice state flag
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2194 CMP r1,#0 @ Compare with active value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2195 BNE TCT_No_Stop_TS_4 @ If non-active, don't disable
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2196
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2197 @ Insure that the next time the task runs it gets a fresh time
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2198 @ slice.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2199 @ REG_Thread_Ptr -> tc_cur_time_slice = REG_Thread_Ptr -> tc_time_slice;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2200
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2201 LDR r1,[r0, #0x40] @ Pickup original time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2202
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2203 @ Clear any active time slice by setting the state to NOT_ACTIVE.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2204 @ TMD_Time_Slice_State = 1;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2205
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2206 MOV r2,#1 @ Build disable value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2207 STR r2,[r3, #0] @ Disable time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2208 STR r1,[r0, #0x20] @ Reset current time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2209
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2210 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2211 TCT_No_Stop_TS_4:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2212
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2213 @ Save off the current stack pointer in the control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2214 @ REG_Thread_Ptr -> tc_stack_pointer = (VOID *) REG_Stack_Ptr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2215
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2216 STR r13,[r0, #0x2c] @ Save the thread's stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2217
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2218 @ Switch to the system stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2219 @ TCD_System_Stack = (VOID *) REG_Stack_Ptr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2220
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2221 LDR r1,System_Stack @ Pickup address of stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2222 LDR r2,System_Limit @ Pickup address of stack limit ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2223 LDR r13,[r1, #0] @ Switch to system stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2224 LDR r10,[r2, #0] @ Setup system stack limit
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2225
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2226 @ Transfer control to the specified thread directly.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2227 @ TCT_Control_To_Thread(thread);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2228
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2229 LDR r2,Int_Level @ Pickup address of interrupt level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2230 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2231 LDR r3,[r2, #0] @ Pickup interrupt lockout level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2232 BIC r1,r1,#LOCK_MSK @ Clear lockout bits
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2233 ORR r1,r1,r3 @ Build new interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2234 MOV r0,r4 @ Indicate thread to schedule
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2235 MSR CPSR,r1 @ Setup CPSR appropriately
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2236 ORR r1,r1,#LOCKOUT @ Build lockout value again
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2237 MSR CPSR,r1 @ Lockout interrupts again
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2238 B TCT_Control_To_Thread @ Schedule the thread indirectly
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2239 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2240
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2241 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2242 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2243 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2244 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2245 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2246 * TCT_Interrupt_Context_Save
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2247 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2248 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2249 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2250 * This function saves the interrupted thread's context. Nested
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2251 * interrupts are also supported. If a task or HISR thread was
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2252 * interrupted, the stack pointer is switched to the system stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2253 * after the context is saved.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2254 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2255 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2256 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2257 * Application ISRs Assembly language ISRs
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2258 * INT_Interrupt_Shell Interrupt handler shell
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2259 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2260 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2261 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2262 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2263 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2264 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2265 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2266 * vector Interrupt's vector number
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2267 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2268 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2269 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2270 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2271 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2272 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2273 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2274 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2275 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2276 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2277 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2278 * D. Driscoll 01-04-2002 Released version 1.13.3.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2279 * Updated to handle nested /
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2280 * prioritized IRQs
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2281 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2282 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2283
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2284 @VOID TCT_Interrupt_Context_Save(INT vector)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2285 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2286
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2287 .globl TCT_Interrupt_Context_Save
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2288 TCT_Interrupt_Context_Save:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2289 @ Determine if this is a nested interrupt.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2290 LDR r1,Int_Count @ Pickup address of interrupt count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2291 LDR r2,[r1, #0] @ Pickup interrupt counter
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2292 ADD r2,r2,#1 @ Add 1 to interrupt counter
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2293 STR r2,[r1, #0] @ Store new interrupt counter value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2294 CMP r2,#1 @ Is it nested?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2295 BEQ TCT_Not_Nested_Save @ No
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2296
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2297 @ Nested interrupt. Save complete context on the current stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2298 TCT_Nested_Save:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2299
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2300 /* No longer needed in the FreeCalypso version, as we can use r0 instead. */
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2301 #if 0
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2302 @ 1. Save another register on the exception stack so we have enough to work with
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2303 STMDB r13!,{r5}
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2304 #endif
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2305
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2306 @ 2. Save the necessary exception registers into r1-r3
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2307 MOV r1,r13 @ Put the exception r13 into r1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2308 MOV r2,r14 @ Move the return address for the caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2309 @ of this function into r2
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2310 MRS r3,spsr @ Put the exception spsr into r3
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2311
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2312 @ 3. Adjust the exception stack pointer for future exceptions
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2313 ADD r13,r13,#20 @ r13 reset to pre-interrupt value
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2314
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2315 @ 4. Switch CPU modes to save context on system stack
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2316 MRS r0,CPSR @ Pickup the current CPSR
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2317 BIC r0,r0,#MODE_MASK @ Clear the mode bits
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2318
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2319 ORR r0,r0,#SUP_MODE @ Change to supervisor mode (SVD)
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2320
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2321 MSR CPSR,r0 @ Switch modes (IRQ->SVC)
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2322
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2323 @ 5. Store the SVC r13 into r5 so the r13 can be saved as is.
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2324 @ FreeCalyspo: using r0 instead
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2325 MOV r0,r13
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2326
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2327 @ 6. Save the exception return address on the stack (r15).
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2328 STMDB r0!,{r4}
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2329
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2330 @ 7. Save r5-r14 on stack (used to be r6-r14)
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2331 STMDB r0!,{r5-r14}
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2332
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2333 @ 8. Switch back to using r13 now that the original r13 has been saved.
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2334 MOV r13,r0
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2335
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2336 /* no longer relevant */
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2337 #if 0
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2338 @ 9. Get r5 and exception enable registers off of exception stack and
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2339 @ save r5 (stored in r4) back to the system stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2340 LDMIA r1!,{r4-r5}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2341 STMDB r13!,{r4}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2342 MOV r4,r5 @ Put exception enable value into r4
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2343 #endif
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2344
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2345 @ 10. Get the rest of the registers off the exception stack and
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2346 @ save them onto the system stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2347 LDMIA r1!,{r5-r8,r11} @ Get r0-r4 off exception stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2348 STMDB r13!,{r5-r8,r11} @ Put r0-r4 on system stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2349
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2350 /* no longer relevant */
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2351 #if 0
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2352 @ 11. Store the exception enable value back on the exception stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2353 STMDB r1,{r4}
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2354 #endif
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2355
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2356 @ 12. Save the SPSR on the system stack (CPSR)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2357 STMDB r13!,{r3}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2358
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2359 /* TI's approach to interrupt handling does not support re-enabling here */
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2360 #if 0
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2361 @ 13. Re-enable interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2362 MRS r1,CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2363 BIC r1,r1,#(IRQ_BIT_OR_FIQ_BIT)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2364 MSR CPSR,r1
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2365 #endif
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2366
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2367 BX r2 @ Return to calling ISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2368 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2369 @ else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2370 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2371 TCT_Not_Nested_Save:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2372
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2373 @ Determine if a thread was interrupted.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2374 @ if (TCD_Current_Thread)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2375 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2376
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2377 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2378 LDR r1,[r1, #0] @ Pickup the current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2379 CMP r1,#0 @ Is it NU_NULL?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2380 BEQ TCT_Idle_Context_Save @ If no, no real save is necessary
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2381
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2382
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2383 @ Yes, a thread was interrupted. Save complete context on the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2384 @ thread's stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2385
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2386 /* No longer needed in the FreeCalypso version, as we can use r0 instead. */
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2387 #if 0
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2388 @ 1. Save another register on the exception stack so we have enough to work with
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2389 STMDB r13!,{r5}
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2390 #endif
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2391
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2392 @ 2. Save the necessary exception registers into r1-r3
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2393 MOV r1,r13 @ Put the exception r13 into r1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2394 MOV r2,r14 @ Move the return address for the caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2395 @ of this function into r2
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2396 MRS r3,spsr @ Put the exception spsr into r3
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2397
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2398 @ 3. Adjust the exception stack pointer for future exceptions
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2399 ADD r13,r13,#20 @ r13 reset to pre-interrupt value
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2400
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2401 @ 4. Switch CPU modes to save context on system stack
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2402 MRS r0,CPSR @ Pickup the current CPSR
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2403 BIC r0,r0,#MODE_MASK @ Clear the mode bits
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2404
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2405 ORR r0,r0,#SUP_MODE @ Change to supervisor mode (SVD)
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2406
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2407 MSR CPSR,r0 @ Switch modes (IRQ->SVC)
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2408
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2409 @ 5. Store the SVC r13 into r5 so the r13 can be saved as is.
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2410 @ FreeCalyspo: using r0 instead
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2411 MOV r0,r13
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2412
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2413 @ 6. Save the exception return address on the stack (r15).
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2414 STMDB r0!,{r4}
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2415
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2416 @ 7. Save r5-r14 on stack (used to be r6-r14)
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2417 STMDB r0!,{r5-r14}
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2418
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2419 @ 8. Switch back to using r13 now that the original r13 has been saved.
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2420 MOV r13,r0
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2421
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2422 /* no longer relevant */
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2423 #if 0
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2424 @ 9. Get r5 and exception enable registers off of exception stack and
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2425 @ save r5 (stored in r4) back to the system stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2426 LDMIA r1!,{r4-r5}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2427 STMDB r13!,{r4}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2428 MOV r4,r5 @ Put exception enable value into r4
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2429 #endif
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2430
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2431 @ 10. Get the rest of the registers off the exception stack and
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2432 @ save them onto the system stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2433 LDMIA r1!,{r5-r8,r11} @ Get r0-r4 off exception stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2434 STMDB r13!,{r5-r8,r11} @ Put r0-r4 on system stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2435
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2436 /* no longer relevant */
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2437 #if 0
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2438 @ 11. Store the exception enable value back on the exception stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2439 STMDB r1,{r4}
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2440 #endif
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2441
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2442 @ 12. Save the SPSR on the system stack (CPSR)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2443 STMDB r13!,{r3}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2444
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2445 @ 13. Save stack type to the task stack (1=interrupt stack)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2446 MOV r1,#1 @ Interrupt stack type
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2447 STMDB r13!,{r1}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2448
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2449 @ Save the thread's stack pointer in the control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2450 @ REG_Thread_Ptr = (TC_TCB *) TCD_Current_Thread
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2451 @ REG_Thread_Ptr -> tc_stack_pointer = (VOID *) REG_Stack_Ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2452
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2453 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2454 LDR r3,[r1, #0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2455 STR r13,[r3, #TC_STACK_POINTER] @ Save stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2456
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2457 @ Switch to the system stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2458 @ REG_Stack_Ptr = TCD_System_Stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2459
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2460 LDR r1,System_Stack @ Pickup address of stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2461 LDR r3,System_Limit @ Pickup address of stack limit ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2462 LDR r13,[r1, #0] @ Switch to system stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2463 LDR r10,[r3, #0] @ Setup system stack limit
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2464
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2465 /* TI's approach to interrupt handling does not support re-enabling here */
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2466 #if 0
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2467 @ Re-enable interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2468 MRS r1,CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2469 BIC r1,r1,#(IRQ_BIT_OR_FIQ_BIT)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2470 MSR CPSR,r1
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2471 #endif
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2472
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2473 @ Return to caller ISR.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2474
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2475 BX r2 @ Return to caller ISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2476
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2477 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2478
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2479 TCT_Idle_Context_Save:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2480
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2481 MOV r2,r14 @ Save r14 in r2
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2482 @ LDR r3,[r13] @ Get exception enable value from stack
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2483 ADD r13,r13,#20 @ Adjust exception r13 for future interrupts
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2484 @ STR r3,[r13] @ Put exception enable value back on stack
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2485
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2486 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2487 BIC r1,r1,#MODE_MASK @ Clear the current mode
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2488 @ BIC r1,r1,#(IRQ_BIT_OR_FIQ_BIT) @ Re-enable interrupts
79 947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2489
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2490 ORR r1,r1,#SUP_MODE @ Prepare to switch to supervisor
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2491 @ mode (SVC)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2492 MSR CPSR,r1 @ Switch to supervisor mode (SVC)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2493
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2494 BX r2 @ Return to caller ISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2495
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2496 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2497 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2498
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2499 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2500 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2501 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2502 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2503 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2504 * TCT_Interrupt_Context_Restore
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2505 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2506 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2507 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2508 * This function restores the interrupt context if a nested
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2509 * interrupt condition is present. Otherwise, this routine
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2510 * transfers control to the scheduling function.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2511 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2512 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2513 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2514 * Application ISRs Assembly language ISRs
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2515 * INT_Interrupt_Shell Interrupt handler shell
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2516 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2517 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2518 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2519 * TCT_Schedule Thread scheduling function
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2520 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2521 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2522 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2523 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2524 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2525 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2526 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2527 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2528 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2529 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2530 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2531 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2532 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2533 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2534 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2535 * D. Driscoll 01-04-2002 Released version 1.13.3.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2536 * Updated to handle nested /
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2537 * prioritized IRQs
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2538 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2539 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2540 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2541
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2542 @VOID TCT_Interrupt_Context_Restore(void)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2543 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2544
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2545 .globl TCT_Interrupt_Context_Restore
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2546 TCT_Interrupt_Context_Restore:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2547 @ It is assumed that anything pushed on the stack by ISRs has been
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2548 @ removed upon entry into this routine.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2549
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2550 @ Decrement and check for nested interrupt conditions.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2551 @ if (--TCD_Interrupt_Count)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2552 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2553
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2554 LDR r1,Int_Count @ Pickup address of interrupt count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2555 LDR r2,[r1, #0] @ Pickup interrupt counter
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2556 SUB r2,r2,#1 @ Decrement interrupt counter
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2557 STR r2,[r1, #0] @ Store interrupt counter
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2558 CMP r2,#0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2559 BEQ TCT_Not_Nested_Restore
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2560
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2561 @ Restore previous context.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2562
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2563 LDR r1,[r13], #4 @ Pickup the saved CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2564
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2565 MSR SPSR,r1 @ Place into saved SPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2566 LDMIA r13,{r0-r15}^ @ Return to the point of interrupt
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2567
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2568 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2569 @ else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2570 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2571
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2572 TCT_Not_Nested_Restore:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2573
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2574 @ Determine if a thread is active.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2575 @ if (TCD_Current_Thread)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2576 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2577
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2578 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2579 LDR r0,[r1, #0] @ Pickup current thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2580 CMP r0,#0 @ Determine if a thread is active
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2581 BEQ TCT_Idle_Context_Restore @ If not, idle system restore
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2582
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2583 @ Clear the current thread pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2584 @ TCD_Current_Thread = NU_NULL
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2585
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2586 MOV r2,#0 @ Build NU_NULL value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2587 STR r2,[r1, #0] @ Set current thread ptr to NU_NULL
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2588
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2589 @ Determine if a time slice is active. If so, the remaining
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2590 @ time left on the time slice must be saved in the task's
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2591 @ control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2592 @ if (TMD_Time_Slice_State == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2593 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2594
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2595 LDR r3,Slice_State @ Pickup time slice state address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2596 LDR r1,[r3, #0] @ Pickup time slice state
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2597 CMP r1,#0 @ Determine if time slice active
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2598 BNE TCT_Idle_Context_Restore @ If not, skip time slice reset
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2599
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2600 @ Pickup the remaining portion of the time slice and save it
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2601 @ in the task's control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2602 @ REG_Thread_Ptr -> tc_cur_time_slice = TMD_Time_Slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2603 @ TMD_Time_Slice_State = 1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2604
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2605 LDR r2,Time_Slice @ Pickup address of time slice left
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2606 MOV r1,#1 @ Build disable time slice value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2607 LDR r2,[r2, #0] @ Pickup remaining time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2608 STR r1,[r3, #0] @ Disable time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2609 STR r2,[r0, #TC_CUR_TIME_SLICE] @ Store remaining time slice
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2610
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2611 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2612 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2613 TCT_Idle_Context_Restore:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2614
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2615 @ Reset the system stack pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2616 LDR r1,System_Stack @ Pickup address of stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2617 LDR r2,System_Limit @ Pickup address of stack limit ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2618 LDR r13,[r1, #0] @ Switch to system stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2619 LDR r10,[r2, #0] @ Setup system stack limit
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2620
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2621 @ Return to scheduler.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2622
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2623 B TCT_Schedule @ Return to scheduling loop
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2624
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2625 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2626 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2627
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2628 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2629 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2630 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2631 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2632 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2633 * TCT_Activate_HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2634 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2635 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2636 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2637 * This function activates the specified HISR. If the HISR is
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2638 * already activated, the HISR's activation count is simply
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2639 * incremented. Otherwise, the HISR is placed on the appropriate
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2640 * HISR priority list in preparation for execution.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2641 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2642 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2643 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2644 * Application LISRs
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2645 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2646 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2647 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2648 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2649 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2650 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2651 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2652 * hisr Pointer to HISR to activate
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2653 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2654 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2655 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2656 * NU_SUCCESS Successful completion
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2657 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2658 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2659 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2660 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2661 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2662 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2663 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2664 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2665 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2666 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2667
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2668 @STATUS TCT_Activate_HISR(TC_HCB *hisr)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2669 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2670
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2671 .globl TCT_Activate_HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2672 TCT_Activate_HISR:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2673
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2674 @INT priority;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2675
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2676
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2677 @ Lockout interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2678
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2679 STR r4,[r13, #-4]! @ Save r4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2680 MRS r4,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2681 ORR r1,r4,#LOCKOUT @ Build interrupt lockout value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2682 MSR CPSR,r1 @ Lockout interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2683
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2684 @ Determine if the HISR is already active.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2685 @ if (hisr -> tc_activation_count)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2686 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2687
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2688 LDR r1,[r0,#0x40] @ Pickup current activation count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2689 CMP r1,#0 @ Is it the first activation?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2690 BEQ TCT_First_Activate @ Yes, place it on the correct list
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2691
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2692 @ Increment the activation count. Make sure that it does not go
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2693 @ to zero.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2694 @ hisr -> tc_activation_count++;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2695
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2696 ADDS r1,r1,#1 @ Increment the activation count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2697 STR r1,[r0,#0x40] @ Store new activation count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2698
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2699 @ if (hisr -> tc_activation_count == 0)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2700
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2701 @ hisr -> tc_activation_count = 0xFFFFFFFFUL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2702
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2703 MVNEQ r1,#0 @ If counter rolled-over reset
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2704 STREQ r1,[r0,#0x40] @ Store all ones count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2705 B TCT_Activate_Done @ Finished with activation
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2706 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2707 @ else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2708 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2709 TCT_First_Activate:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2710
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2711
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2712 @ Set the activation count to 1.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2713 @ hisr -> tc_activation_count = 1;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2714
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2715 MOV r1,#1 @ Initial activation count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2716 STR r1,[r0,#0x40] @ Store initial activation count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2717
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2718 @ Pickup the HISR's priority.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2719 @ priority = hisr -> tc_priority;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2720
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2721 @ Determine if there is something in the given priority list.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2722 @ if (TCD_Active_HISR_Tails[priority])
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2723 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2724
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2725 LDRB r1,[r0,#0x1a] @ Pickup priority of HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2726 LDR r2,HISR_Tails @ Pickup tail pointer base
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2727 LDR r3,[r2,r1,LSL #2] @ Pickup tail pointer for priority
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2728 CMP r3,#0 @ Is this first HISR at priority?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2729 BEQ TCT_First_HISR @ No, append to end of HISR list
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2730
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2731 @ Something is already on this list. Add after the tail.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2732 @ (TCD_Active_HISR_Tails[priority]) -> tc_active_next = hisr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2733 @ TCD_Active_HISR_Tails[priority] = hisr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2734
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2735 STR r0,[r3,#0x3c] @ Setup the active next pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2736 STR r0,[r2,r1,LSL #2] @ Setup the tail pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2737 B TCT_Activate_Done @ Finished with activate processing
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2738 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2739 @ else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2740 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2741 TCT_First_HISR:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2742
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2743 @ Nothing is on this list.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2744 @ TCD_Active_HISR_Heads[priority] = hisr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2745 @ TCD_Active_HISR_Tails[priority] = hisr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2746
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2747 LDR r3,HISR_Heads @ Pickup address of head pointers
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2748 STR r0,[r2,r1,LSL #2] @ Set tail pointer to this HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2749 STR r0,[r3,r1,LSL #2] @ Set head pointer to this HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2750
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2751 @ Determine the highest priority HISR.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2752 @ if (TCD_Active_HISR_Heads[0])
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2753 @ TCD_Execute_HISR = TCD_Active_HISR_Heads[0];
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2754 @ else if (TCD_Active_HISR_Heads[1])
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2755 @ TCD_Execute_HISR = TCD_Active_HISR_Heads[1];
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2756 @ else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2757 @ TCD_Execute_HISR = TCD_Active_HISR_Heads[2];
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2758
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2759 LDR r1,[r3,#0] @ Pickup priority 0 head pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2760 LDR r0,Execute_HISR @ Build address to execute HISR ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2761 CMP r1,#0 @ Is priority 0 active?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2762 LDREQ r1,[r3,#4] @ If not, pickup priority 1 head
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2763 CMPEQ r1,#0 @ Is priority 1 active?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2764 LDREQ r1,[r3,#8] @ Else, must be priority 2 active
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2765 STR r1,[r0,#0] @ Store which ever priority is the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2766 @ active one
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2767 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2768 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2769 TCT_Activate_Done:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2770
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2771 MSR CPSR,r4 @ Restore interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2772 LDR r4,[r13], #4 @ Restore corrupted r4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2773
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2774 @ return(NU_SUCCESS);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2775
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2776 MOV r0,#0 @ Always return NU_SUCCESS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2777
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2778 BX r14 @ Return to caller
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2779
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2780 @}
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2781
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2782 /*
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2783 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2784 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2785 * FUNCTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2786 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2787 * TCT_HISR_Shell
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2788 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2789 * DESCRIPTION
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2790 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2791 * This function is the execution shell of each and every HISR. If
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2792 * the HISR has completed its processing, this shell routine exits
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2793 * back to the system. Otherwise, it sequentially calls the HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2794 * routine until the activation count goes to zero.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2795 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2796 * CALLED BY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2797 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2798 * HISR Scheduling
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2799 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2800 * CALLS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2801 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2802 * hisr -> tc_entry Actual entry function of HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2803 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2804 * INPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2805 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2806 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2807 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2808 * OUTPUTS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2809 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2810 * None
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2811 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2812 * HISTORY
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2813 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2814 * NAME DATE REMARKS
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2815 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2816 * W. Lamie 02-15-1994 Created initial version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2817 * D. Lamie 02-15-1994 Verified version 1.0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2818 *
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2819 ************************************************************************
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2820 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2821
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2822 @VOID TCT_HISR_Shell(void)
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2823 @{
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2824 .globl TCT_HISR_Shell
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2825 TCT_HISR_Shell:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2826
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2827 @ Point at the HISR.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2828 @ REG_HISR_Ptr = (TC_HCB *) TCD_Current_Thread;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2829
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2830 LDR r0,Current_Thread @ Build address of thread pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2831 LDR r5,[r0, #0] @ Pickup control block pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2832
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2833 @ do
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2834 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2835 TCT_HISR_Loop:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2836
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2837 @ Call the HISR's entry routine.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2838 @ (*(REG_HISR_Ptr -> tc_entry)) ();
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2839
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2840 /* old TMS470 code:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2841
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2842 .if THUMB = 0
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2843
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2844 MOV r14,r15 ; Setup return value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2845 LDR r15,[r5,#44h] ; Call HISR entry function
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2846 .else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2847 LDR r4,[r5,#44h] ; Get HISR entry function
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2848 TST r4,#1 ; See if calling Thumb or ARM
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2849 BNE Thumbsec
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2850 MOV r14,r15 ; Setup return value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2851 BX r4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2852 B ARMCODE
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2853 Thumbsec:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2854 ADD r14, r15, #1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2855 BX r4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2856 .state16
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2857 ThumbAfterHisr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2858 MOV r1, r15
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2859 BX r1
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2860 .state32
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2861 .endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2862 */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2863
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2864 /* new code for the GNU style of ARM/Thumb interworking */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2865 ldr r4, [r5, #TC_HISR_ENTRY]
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2866 mov lr, pc
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2867 bx r4
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2868
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2869 @ Lockout interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2870
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2871 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2872 ORR r1,r1,#LOCKOUT @ Build interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2873 MSR CPSR,r1 @ Lockout interrupts
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2874
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2875 @ On return, decrement the activation count and check to see if
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2876 @ it is 0. Once it reaches 0, the HISR should be made inactive.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2877 @ REG_HISR_Ptr -> tc_activation_count--;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2878
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2879
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2880 LDR r0,[r5, #0x40] @ Pickup current activation count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2881 SUBS r0,r0,#1 @ Subtract and set condition codes
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2882 STR r0,[r5, #0x40] @ Store new activation count
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2883 BEQ TCT_HISR_Finished @ Finished processing HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2884
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2885 @ Restore interrupts.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2886
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2887 LDR r2,Int_Level @ Pickup address of interrupt level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2888 MRS r1,CPSR @ Pickup current CPSR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2889 LDR r3,[r2, #0] @ Pickup interrupt lockout level
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2890 BIC r1,r1,#LOCK_MSK @ Clear lockout bits
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2891 ORR r1,r1,r3 @ Build new interrupt lockout
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2892 MSR CPSR,r1 @ Setup CPSR appropriately
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2893 B TCT_HISR_Loop @ Return to HISR loop
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2894 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2895 @ while (REG_HISR_Ptr -> tc_activation_count);
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2896
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2897 TCT_HISR_Finished:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2898
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2899 @ At this point, the HISR needs to be made inactive.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2900
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2901 @ Determine if this is the only HISR on the given priority list.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2902 @ if (REG_HISR_Ptr == TCD_Active_HISR_Tails[REG_HISR_Ptr -> tc_priority])
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2903 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2904
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2905 LDR r14,HISR_Tails @ Pickup tail pointers address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2906 LDRB r3,[r5,#0x1a] @ Pickup priority
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2907 LDR r6,[r14,r3,LSL #2] @ Pickup this priority tail pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2908 LDR r2,Execute_HISR @ Build address to execute HISR ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2909 MOV r12,#0 @ Clear r12
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2910 LDR r1,HISR_Heads @ Pickup head pointers address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2911 CMP r6,r5 @ Is this priority tail the same as
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2912 @ the current HISR?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2913 BNE TCT_More_HISRs @ If not, more HISRs at this
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2914 @ priority
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2915
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2916 @ The only HISR on the list. Clean up the list and check for the
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2917 @ highest priority HISR.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2918 @ TCD_Active_HISR_Heads[REG_HISR_Ptr -> tc_priority] = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2919 @ TCD_Active_HISR_Tails[REG_HISR_Ptr -> tc_priority] = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2920
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2921 STR r12,[r1,r3,LSL #2] @ Set head pointer to NU_NULL
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2922 STR r12,[r14,r3,LSL #2] @ Set tail pointer to NU_NULL
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2923
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2924 @ Determine the highest priority HISR.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2925 @ if (TCD_Active_HISR_Heads[0])
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2926 @ TCD_Execute_HISR = TCD_Active_HISR_Heads[0];
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2927 @ else if (TCD_Active_HISR_Heads[1])
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2928 @ TCD_Execute_HISR = TCD_Active_HISR_Heads[1];
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2929 @ else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2930 @ TCD_Execute_HISR = TCD_Active_HISR_Heads[2];
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2931
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2932 LDR r3,[r1,#0] @ Pickup priority 0 head pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2933 CMP r3,#0 @ Is there an HISR active?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2934 LDREQ r3,[r1,#4] @ If not, pickup priority 1 pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2935 CMPEQ r3,#0 @ Is there an HISR active?
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2936 LDREQ r3,[r1,#8] @ If not, pickup priority 2 pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2937 STR r3,[r2,#0] @ Setup execute HISR pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2938 B TCT_HISR_Exit @ Exit HISR processing
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2939 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2940 @ else
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2941 @ {
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2942
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2943 TCT_More_HISRs:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2944
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2945 @ Move the head pointer to the next HISR in the list.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2946 @ TCD_Active_HISR_Heads[REG_HISR_Ptr -> tc_priority] =
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2947 @ REG_HISR_Ptr -> tc_active_next;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2948
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2949 @ Also set the TCD_Execute_HISR pointer.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2950 @ TCD_Execute_HISR = REG_HISR_Ptr -> tc_active_next;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2951
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2952 LDR r14,[r5,#0x3c] @ Pickup next HISR to activate
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2953 STR r14,[r1,r3,LSL #2] @ Setup new head pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2954 STR r14,[r2, #0] @ Setup execute HISR pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2955 @ }
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2956
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2957 TCT_HISR_Exit:
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2958
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2959 @ Build fake return to the top of this loop. The next time the HISR
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2960 @ is activated, it will return to the top of this function.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2961
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2962 LDR r14,HISR_Shell @ Pickup address of shell entry
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2963 STMDB r13!,{r4-r12,r14} @ Save minimal context of thread on
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2964 @ the current stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2965 MOV r2,#0 @ Build solicited stack type value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2966 @ and NU_NULL value
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2967 #if 1 /* was .if THUMB */
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2968 STR r2,[r13, #-4]! @ Save state mask
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2969 #endif
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2970 STR r2,[r13, #-4]! @ Place it on the top of the stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2971
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2972 @ Clear the current thread control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2973 @ TCD_Current_Thread = NU_NULL;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2974
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2975 LDR r1,Current_Thread @ Pickup current thread ptr address
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2976 STR r2,[r1, #0] @ Set current thread pointer to
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2977 @ NU_NULL
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2978
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2979 @ Save off the current stack pointer in the control block.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2980 @ REG_HISR_Ptr -> tc_stack_pointer = (VOID *) REG_Stack_Ptr;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2981
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2982
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2983 STR r13,[r5, #0x2c] @ Save the thread's stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2984
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2985
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2986 @ Switch to the system stack.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2987 @ REG_Stack_Ptr = (BYTE_PTR) TCD_System_Stack;
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2988
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2989 LDR r1,System_Stack @ Pickup address of stack pointer
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2990 LDR r2,System_Limit @ Pickup address of stack limit ptr
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2991 LDR r13,[r1, #0] @ Switch to system stack
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2992 LDR r10,[r2, #0] @ Setup system stack limit
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2993
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2994 @ Transfer control to the main scheduling loop.
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2995
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2996 B TCT_Schedule @ Return to main scheduling loop
947b1f473960 beginning of nuc-fw Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2997 @}
132 2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2998
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	2999 /* FreeCalypso addition, used by riviera/rvf/rvf_task.c: */
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	3000 .globl INT_Check_IRQ_Mask
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	3001 INT_Check_IRQ_Mask:
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	3002 MRS r0,CPSR
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	3003 BX lr
2c5160a9d652 nuc-fw: switched from nucdemo to Riviera, got some serial output Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 79 diff changeset	3004

FreeCalypso > hg > freecalypso-sw

annotate gsm-fw/nucleus/tct.S @ 810:47a9c4eadf7f