# HG changeset patch # User Michael Spacefalcon # Date 1382582834 0 # Node ID 17b0511b243c4635202a6d1901fc5db6d5aebd0a # Parent 3b2e941043d8c76c056fe4058ce1c4484f953f68 nuc-fw: continuing lowest-level BSP integration diff -r 3b2e941043d8 -r 17b0511b243c nuc-fw/bsp/Makefile --- a/nuc-fw/bsp/Makefile Sun Oct 20 21:12:41 2013 +0000 +++ b/nuc-fw/bsp/Makefile Thu Oct 24 02:47:14 2013 +0000 @@ -4,9 +4,9 @@ AR= arm-elf-ar RANLIB= arm-elf-ranlib -IOBJS= armio.o inth.o niq32.o +IOBJS= niq32.o -XTOBJS= clkm.o niq.o +XTOBJS= armio.o clkm.o inth.o niq.o timer.o timer1.o timer2.o XOBJS= ${XTOBJS} AOBJS= ${IOBJS} diff -r 3b2e941043d8 -r 17b0511b243c nuc-fw/bsp/timer.c --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/nuc-fw/bsp/timer.c Thu Oct 24 02:47:14 2013 +0000 @@ -0,0 +1,267 @@ +/******************************************************************************* + TEXAS INSTRUMENTS INCORPORATED PROPRIETARY INFORMATION + + Property of Texas Instruments -- For Unrestricted Internal Use Only + Unauthorized reproduction and/or distribution is strictly prohibited. This + product is protected under copyright law and trade secret law as an + unpublished work. Created 1987, (C) Copyright 1997 Texas Instruments. All + rights reserved. + + + Filename : timer.c + + Description : timer.c + + Project : drivers + + Author : pmonteil@tif.ti.com Patrice Monteil. + + Version number : 1.3 + + Date and time : 07/23/98 16:25:32 + Previous delta : 07/23/98 16:25:32 + + SCCS file : /db/gsm_asp/db_ht96/dsp_0/gsw/rel_0/mcu_l1/release1.5/mod/emu/EMU_MCMP/eva3_drivers/source/SCCS/s.timer.c + + Sccs Id (SID) : '@(#) timer.c 1.3 07/23/98 16:25:32 ' + + +*****************************************************************************/ + +#include "../include/sys_types.h" + +#include "mem.h" +#include "iq.h" +#include "timer.h" + + +/*-------------------------------------------------------------- + * TIMER_Read() + *-------------------------------------------------------------- + * Parameters : num of the register to be read + * Return :value of the timer register read + * Functionality : read one of the TIMER register + *--------------------------------------------------------------*/ +SYS_UWORD16 TIMER_Read (unsigned short regNum) +{ + SYS_UWORD16 timerReg; + + switch (regNum) { + case 0: + timerReg = ( * (volatile SYS_UWORD16 *) TIMER_CNTL_REG) & TIMER_CNTL_MASK; + break; + case 1: + timerReg = *(volatile SYS_UWORD16 *) TIMER_READ_REG; + break; + case 2: + timerReg = ( * (volatile SYS_UWORD16 *) TIMER_MODE_REG) & TIMER_MODE_MASK; + break; + default: + break; + } + return(timerReg); +} +/*-------------------------------------------------------------- + * TM_ResetTimer() + *-------------------------------------------------------------- + * Parameters : timer number (1 or 2) + * timer value, reload yes or not, scale + * Return : none + * Functionality : Give the timewr state + *--------------------------------------------------------------*/ +void TM_ResetTimer (SYS_UWORD16 timerNum, SYS_UWORD16 countValue, + SYS_UWORD16 autoReload, SYS_UWORD16 clockScale) +{ + volatile SYS_UWORD16 *cntl; + + if (timerNum == 1) + { + cntl = (volatile SYS_UWORD16 *) TIMER1_CNTL; + + *cntl &= ~(START_STOP | PTV); /* stop and reset values */ + + (autoReload) ? (*cntl |= AR) : (*cntl &= ~AR); + + *cntl |= (clockScale << 2 ); + + /*load the value */ + *(volatile SYS_UWORD16 *) TIMER1_LOAD_TIM = countValue; + + *cntl |= START_STOP; + } + else + { + cntl = (volatile SYS_UWORD16 *) TIMER2_CNTL; + + *cntl &= ~(START_STOP | PTV); /* stop and reset values */ + + (autoReload) ? (*cntl |= AR) : (*cntl &= ~AR); + + *cntl |= (clockScale << 2 ); + + /*load the value */ + *(volatile SYS_UWORD16 *) TIMER2_LOAD_TIM = countValue; + + *cntl |= START_STOP; + } +} + +/* + * TM_StopTimer + * + * Parameters : timer number (1 or 2) + */ +void TM_StopTimer (int timerNum) +{ + volatile SYS_UWORD16 *cntl; + + if (timerNum == 1) + { + cntl = (volatile SYS_UWORD16 *) TIMER1_CNTL; + } + else + { + cntl = (volatile SYS_UWORD16 *) TIMER2_CNTL; + } + *cntl &= ~START_STOP; +} + +/* + * TM_ReadTimer + * + * Returns current timer value + * + * Parameters : timer number (1 or 2) + * + */ +SYS_UWORD16 TM_ReadTimer (int timerNum) +{ + if (timerNum == 1) + { + return (* (SYS_UWORD16 *) TIMER1_READ_TIM); + } + else + { + return (* (SYS_UWORD16 *) TIMER2_READ_TIM); + } +} + + +/* + * TM_StartTimer + * + * Parameters : timer number (1 or 2) + * + */ +void TM_StartTimer (int timerNum) +{ + volatile SYS_UWORD16 *cntl; + + if (timerNum == 1) + { + cntl = (volatile SYS_UWORD16 *) TIMER1_CNTL; + } + else + { + cntl = (volatile SYS_UWORD16 *) TIMER2_CNTL; + } + *cntl |= START_STOP; +} + +void TM_DisableWatchdog (void) +{ + /* volatile variable needed due C to optimization */ + volatile SYS_UWORD16 *reg = (volatile SYS_UWORD16 *) TIMER_MODE_REG; + + *reg = 0xf5; + *reg = 0xa0; +} + + + /* + * TM_EnableWatchdog + * + */ +void TM_EnableWatchdog(void) +{ + * ((volatile SYS_UWORD16 *) TIMER_MODE_REG) = TIMER_WDOG; +} + +/* + * TM_ResetWatchdog + * + * Parameter : Tick count + * Use a different value each time, otherwise watchdog bites + */ +void TM_ResetWatchdog(SYS_UWORD16 count) +{ + * ((volatile SYS_UWORD16 *) TIMER_LOAD_REG) = count; +} + +/* +* TM_EnableTimer (int TimerNum) +* +* Parameter : TimerNum : timer to enable (timer1 or timer2) +* +*/ +void TM_EnableTimer (int TimerNum) +{ + volatile SYS_UWORD16 *cntl; + + if (TimerNum == 1) + { + cntl = (volatile SYS_UWORD16 *) TIMER1_CNTL; + } + else + { + cntl = (volatile SYS_UWORD16 *) TIMER2_CNTL; + } + *cntl |= TIMER_CLK_EN; +} + +/* +* TM_DisableTimer (int TimerNum) +* +* Parameter : TimerNum : timer to enable (timer1 or timer2) +* +*/ +void TM_DisableTimer (int TimerNum) +{ + volatile SYS_UWORD16 *cntl; + + if (TimerNum == 1) + { + cntl = (volatile SYS_UWORD16 *) TIMER1_CNTL; + } + else + { + cntl = (volatile SYS_UWORD16 *) TIMER2_CNTL; + } + *cntl &= ~TIMER_CLK_EN; +} + +/*-------------------------------------------------------------- + * TIMER_ReadValue() + *-------------------------------------------------------------- + * Parameters : none + * Return : none + * Functionality : Read timer value + *--------------------------------------------------------------*/ + +unsigned short TIMER_ReadValue (void) +{ + return(* (SYS_UWORD16 *) TIMER_READ_REG); +} + +/*-------------------------------------------------------------- + * TIMER_WriteValue() + *-------------------------------------------------------------- + * Parameters : none + * Return : none + * Functionality : Write timer value + *--------------------------------------------------------------*/ + +void TIMER_WriteValue (SYS_UWORD16 value) +{ + * (SYS_UWORD16 *) TIMER_LOAD_REG = value; /*load the value */ +} diff -r 3b2e941043d8 -r 17b0511b243c nuc-fw/bsp/timer1.c --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/nuc-fw/bsp/timer1.c Thu Oct 24 02:47:14 2013 +0000 @@ -0,0 +1,180 @@ +/****************************************************************************** + TEXAS INSTRUMENTS INCORPORATED PROPRIETARY INFORMATION + + Property of Texas Instruments -- For Unrestricted Internal Use Only + Unauthorized reproduction and/or distribution is strictly prohibited. This + product is protected under copyright law and trade secret law as an + unpublished work. Created 1987, (C) Copyright 1997 Texas Instruments. All + rights reserved. + + + Filename : timer1.c + + Description : Set of useful functions for TIMER module test cases + + Project : drivers + + Author : pmonteil@tif.ti.com Patrice Monteil. + + Version number : 1.4 + + Date and time : 08/18/00 14:42:35 + + Previous delta : 06/30/00 11:40:43 + + SCCS file : /db/gsm_asp/db_ht96/dsp_0/gsw/rel_0/mcu_l1/release_gprs/RELEASE_GPRS/drivers1/common/SCCS/s.timer1.c + + Sccs Id (SID) : '@(#) timer1.c 1.4 08/18/00 14:42:35 ' + + +*****************************************************************************/ + +#include "../include/sys_types.h" + +#include "mem.h" +#include "timer1.h" + +/*--------------------------------------------------------------*/ +/* Dtimer1_Get_cntlreg() */ +/*--------------------------------------------------------------*/ +/* Parameters : none */ +/* Return : none */ +/* Functionality : read one of the TIMER register */ +/*--------------------------------------------------------------*/ + +SYS_UWORD16 Dtimer1_Get_cntlreg(void) +{ + SYS_UWORD16 timerReg; + + timerReg = (( * (volatile SYS_UWORD16 *) D_TIMER_CNTL) & D_TIMER_CNTL_MASK); + return(timerReg); +} + + +/*--------------------------------------------------------------*/ +/* Dtimer_Init_cntl() */ +/*--------------------------------------------------------------*/ +/* Parameters :start/stop,reload yes/no,pre scale,ext clk on/off*/ +/* Return : none */ +/* Functionality : initialize the timer start, autoreload, Ptv */ +/* and clock enable */ +/*--------------------------------------------------------------*/ + +void Dtimer1_Init_cntl (SYS_UWORD16 St, SYS_UWORD16 Reload, SYS_UWORD16 clockScale, SYS_UWORD16 clkon) +{ + SYS_UWORD16 cntl = * (volatile SYS_UWORD16 *) D_TIMER_CNTL; + + + cntl &= ~(D_TIMER_ST | D_TIMER_PTV); /* stop and reset values */ + + (Reload) ? (cntl |= D_TIMER_AR) : (cntl &= ~D_TIMER_AR); + + cntl |= (clockScale << 2 ); + + cntl |= ( clkon << 5 ); + + + * (volatile SYS_UWORD16 *) D_TIMER_LOAD = St; + + * (volatile SYS_UWORD16 *) D_TIMER_CNTL = cntl; + } + +/*--------------------------------------------------------------*/ +/* Dtimer1_AR() */ +/*--------------------------------------------------------------*/ +/* Parameters :start/stop,reload yes/no,pre scale,ext clk on/off*/ +/* Return : none */ +/* Functionality : set the AR bit Ar = 0 | 1 */ +/*--------------------------------------------------------------*/ + +void Dtimer1_AR(SYS_UWORD16 Ar) +{ +SYS_UWORD16 cntl = * (volatile SYS_UWORD16 *) D_TIMER_CNTL; + + cntl &= ~(D_TIMER_ST); /* stop the timer */ + + cntl &= ~(D_TIMER_AR); + + cntl |= ( Ar << 1 ); + + * (volatile SYS_UWORD16 *) D_TIMER_CNTL = cntl; +} + +/*--------------------------------------------------------------*/ +/* Dtimer1_PTV() */ +/*--------------------------------------------------------------*/ +/* Parameters : pre scale */ +/* Return : none */ +/* Functionality : set the Ptv bits Ptv = 0 => 7 */ +/*--------------------------------------------------------------*/ + +void Dtimer1_PTV(SYS_UWORD16 Ptv) +{ +SYS_UWORD16 cntl = * (volatile SYS_UWORD16 *) D_TIMER_CNTL; + + cntl &= ~(D_TIMER_ST); /* stop the timer */ + + cntl &= ~(D_TIMER_PTV); /* Ptv[4:0] set to 0 */ + + cntl |= ( Ptv << 2 ); + + * (volatile SYS_UWORD16 *) D_TIMER_CNTL = cntl; +} + +/*--------------------------------------------------------------*/ +/* Dtimer1_Clken() */ +/*--------------------------------------------------------------*/ +/* Parameters : ext clk on/off */ +/* Return : none */ +/* Functionality : set the clock_enable bit En = 0 | 1 */ +/*--------------------------------------------------------------*/ + +void Dtimer1_Clken(SYS_UWORD16 En) +{ +SYS_UWORD16 cntl = * (volatile SYS_UWORD16 *) D_TIMER_CNTL; + + cntl &= ( ~D_TIMER_CLK_EN); + + cntl |= ( En << 5 ); + + * (volatile SYS_UWORD16 *) D_TIMER_CNTL = cntl; +} + + + +/*--------------------------------------------------------------*/ +/* Dtimer_Start() */ +/*--------------------------------------------------------------*/ +/* Parameters : on/off */ +/* Return : none */ +/* Functionality : Start or stop the timer */ +/*--------------------------------------------------------------*/ + +void Dtimer1_Start (SYS_UWORD16 startStop) +{ + (startStop == D_TIMER_ST) ? + ((* (SYS_UWORD16 *) D_TIMER_CNTL) |= D_TIMER_ST) : /* condition vrai */ + ((* (SYS_UWORD16 *) D_TIMER_CNTL) &= ~D_TIMER_ST); /* condition fausse */ +} + +/*--------------------------------------------------------------*/ +/* Dtimer_ReadValue() */ +/*--------------------------------------------------------------*/ +/* Parameters : on/off */ +/* Return : none */ +/* Functionality : Read timer value */ +/*--------------------------------------------------------------*/ +SYS_UWORD16 Dtimer1_ReadValue (void) +{ + return(* (SYS_UWORD16 *) D_TIMER_READ); +} + +/*--------------------------------------------------------------*/ +/* Parameters : on/off */ +/* Return : none */ +/* Functionality : Write timer value */ +/*--------------------------------------------------------------*/ +void Dtimer1_WriteValue (SYS_UWORD16 value) +{ + (* (SYS_UWORD16 *) D_TIMER_LOAD) = value; +} diff -r 3b2e941043d8 -r 17b0511b243c nuc-fw/bsp/timer2.c --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/nuc-fw/bsp/timer2.c Thu Oct 24 02:47:14 2013 +0000 @@ -0,0 +1,182 @@ +/****************************************************************************** + TEXAS INSTRUMENTS INCORPORATED PROPRIETARY INFORMATION + + Property of Texas Instruments -- For Unrestricted Internal Use Only + Unauthorized reproduction and/or distribution is strictly prohibited. This + product is protected under copyright law and trade secret law as an + unpublished work. Created 1987, (C) Copyright 1997 Texas Instruments. All + rights reserved. + + + Filename : timer2.c + + Description : Set of useful functions for TIMER module test cases + + Project : drivers + + Author : pmonteil@tif.ti.com Patrice Monteil. + Version number : 1.3 + + Date and time : 08/18/00 14:42:39 + + Previous delta : 07/10/00 16:15:18 + + SCCS file : /db/gsm_asp/db_ht96/dsp_0/gsw/rel_0/mcu_l1/release_gprs/RELEASE_GPRS/drivers1/common/SCCS/s.timer2.c + + Sccs Id (SID) : '@(#) timer2.c 1.3 08/18/00 14:42:39 ' + + + +*****************************************************************************/ + +#include "../include/sys_types.h" + +#include "mem.h" +#include "timer2.h" + +/*--------------------------------------------------------------*/ +/* Dtimer2_Get_cntlreg() */ +/*--------------------------------------------------------------*/ +/* Parameters : none */ +/* Return : none */ +/* Functionality : read one of the TIMER register */ +/*--------------------------------------------------------------*/ + +SYS_UWORD16 Dtimer2_Get_cntlreg(void) +{ + SYS_UWORD16 timerReg; + + timerReg = (( * (volatile SYS_UWORD16 *) D_TIMER_CNTL) & D_TIMER_CNTL_MASK); + return(timerReg); +} + + +/*--------------------------------------------------------------*/ +/* Dtimer2_Init_cntl() */ +/*--------------------------------------------------------------*/ +/* Parameters :start/stop,reload yes/no,pre scale,ext clk on/off*/ +/* Return : none */ +/* Functionality : initialize the timer start, autoreload, Ptv */ +/* and clock enable */ +/*--------------------------------------------------------------*/ + +void Dtimer2_Init_cntl (SYS_UWORD16 St, SYS_UWORD16 Reload, SYS_UWORD16 clockScale, SYS_UWORD16 clkon) +{ + SYS_UWORD16 cntl = * (volatile SYS_UWORD16 *) D_TIMER_CNTL; + + + cntl &= ~(D_TIMER_ST | D_TIMER_PTV); /* stop and reset values */ + + (Reload) ? (cntl |= D_TIMER_AR) : (cntl &= ~D_TIMER_AR); + + cntl |= (clockScale << 2 ); + + cntl |= ( clkon << 5 ); + + + * (volatile SYS_UWORD16 *) D_TIMER_LOAD = St; + + * (volatile SYS_UWORD16 *) D_TIMER_CNTL = cntl; + } + +/*--------------------------------------------------------------*/ +/* Dtimer2_AR() */ +/*--------------------------------------------------------------*/ +/* Parameters :start/stop,reload yes/no,pre scale,ext clk on/off*/ +/* Return : none */ +/* Functionality : set the AR bit Ar = 0 | 1 */ +/*--------------------------------------------------------------*/ + +void Dtimer2_AR(SYS_UWORD16 Ar) +{ +SYS_UWORD16 cntl = * (volatile SYS_UWORD16 *) D_TIMER_CNTL; + + cntl &= ~(D_TIMER_ST); /* stop the timer */ + + cntl &= ~(D_TIMER_AR); + + cntl |= ( Ar << 1 ); + + * (volatile SYS_UWORD16 *) D_TIMER_CNTL = cntl; +} + +/*--------------------------------------------------------------*/ +/* Dtimer2_PTV() */ +/*--------------------------------------------------------------*/ +/* Parameters : pre scale */ +/* Return : none */ +/* Functionality : set the Ptv bits Ptv = 0 => 7 */ +/*--------------------------------------------------------------*/ + +void Dtimer2_PTV(SYS_UWORD16 Ptv) +{ +SYS_UWORD16 cntl = * (volatile SYS_UWORD16 *) D_TIMER_CNTL; + + cntl &= ~(D_TIMER_ST); /* stop the timer */ + + cntl &= ~(D_TIMER_PTV); /* Ptv[4:0] set to 0 */ + + cntl |= ( Ptv << 2 ); + + * (volatile SYS_UWORD16 *) D_TIMER_CNTL = cntl; +} + +/*--------------------------------------------------------------*/ +/* Dtimer1_Clken() */ +/*--------------------------------------------------------------*/ +/* Parameters : ext clk on/off */ +/* Return : none */ +/* Functionality : set the clock_enable bit En = 0 | 1 */ +/*--------------------------------------------------------------*/ + +void Dtimer2_Clken(SYS_UWORD16 En) +{ +SYS_UWORD16 cntl = * (volatile SYS_UWORD16 *) D_TIMER_CNTL; + + cntl &= ( ~D_TIMER_CLK_EN); + + cntl |= ( En << 5 ); + + * (volatile SYS_UWORD16 *) D_TIMER_CNTL = cntl; +} + + + +/*--------------------------------------------------------------*/ +/* Dtimer2_Start() */ +/*--------------------------------------------------------------*/ +/* Parameters : on/off */ +/* Return : none */ +/* Functionality : Start or stop the timer */ +/*--------------------------------------------------------------*/ + +void Dtimer2_Start (SYS_UWORD16 startStop) +{ + (startStop == D_TIMER_ST) ? + ((* (SYS_UWORD16 *) D_TIMER_CNTL) |= D_TIMER_ST) : /* condition vrai */ + ((* (SYS_UWORD16 *) D_TIMER_CNTL) &= ~D_TIMER_ST); /* condition fausse */ +} + +/*--------------------------------------------------------------*/ +/* Dtimer2_ReadValue() */ +/*--------------------------------------------------------------*/ +/* Parameters : on/off */ +/* Return : none */ +/* Functionality : Read timer value */ +/*--------------------------------------------------------------*/ + +SYS_UWORD16 Dtimer2_ReadValue (void) +{ + return(* (SYS_UWORD16 *) D_TIMER_READ); +} + +/*--------------------------------------------------------------*/ +/* Parameters : on/off */ +/* Return : none */ +/* Functionality : Write timer value */ +/*--------------------------------------------------------------*/ + +void Dtimer2_WriteValue (SYS_UWORD16 value) +{ + (* (SYS_UWORD16 *) D_TIMER_LOAD) = value; +} diff -r 3b2e941043d8 -r 17b0511b243c nuc-fw/sysglue/Makefile --- a/nuc-fw/sysglue/Makefile Sun Oct 20 21:12:41 2013 +0000 +++ b/nuc-fw/sysglue/Makefile Thu Oct 24 02:47:14 2013 +0000 @@ -1,7 +1,7 @@ CC= arm-elf-gcc ASFLAGS=-mthumb-interwork -OBJS= sysinit.o +OBJS= irqfiq.o sysinit.o all: ${OBJS} diff -r 3b2e941043d8 -r 17b0511b243c nuc-fw/sysglue/irqfiq.S --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/nuc-fw/sysglue/irqfiq.S Thu Oct 24 02:47:14 2013 +0000 @@ -0,0 +1,73 @@ +/* + * This module contains the assembly shells for IRQ and FIQ, separated + * from the architectured vectors only by some simple unconditional + * branch instructions. + * + * Note that TI's way of handling interrupts sacrifices Nucleus' ability + * to nest interrupts and minimize the IRQ-disabled window: if my (Falcon's) + * understanding is correct, TI's code leaves all further IRQs disabled + * for the full execution duration of an IRQ handler. (IRQ handlers are + * really LISRs, but TI's GSM fw does not use Nucleus' LISR framework.) + */ + + .section iram.text,"ax",%progbits + .code 32 + + .globl _INT_IRQ +_INT_IRQ: + STMDB sp!,{a1-a4} @ Save a1-a4 on temporary IRQ stack + +/* + * Thanks to TI for discovering and documenting this apparent ARM7TDMI bug: + +BUG correction 1st part ------------------- +It looks like there is an issue with ARM7 IRQ masking in the CPSR register +which leads to crashes in Nucleus+ scheduler. +Basically the code below (correct as LOCKOUT = 0xC0) is used in many places by N+ but do not +prevent from having an interrupt after the execution of the third line (I mean execution, not +fetch). + MRS a1,CPSR ; Pickup current CPSR + ORR a1,a1,#LOCKOUT ; Build interrupt lockout value + MSR CPSR,a1 ; Lockout interrupts + * IRQ INTERRUPT ! * + Next instructions... + +SW workaround: +When a task is interrupted at this point an interrupted context is stored on its task and will +be resumed later on at the next instruction but to make a long story short it leads to some +problem as the OS does not expect to be interrupted there. +Further testing tends to show that the CPSR *seems* to be loaded with the proper masking value +but that the IRQ is still triggered (has been hardwarewise requested during the instruction +exectution by the ARM7 core?) +*/ + + MRS a1,spsr @ check for the IRQ bug: + TST a1,#0x80 @ if the I - flag is set, + BNE IRQBUG @ then postpone execution of this IRQ +/* Bug correction 1st part end --------------- */ + + SUB a4,lr,#4 @ Save IRQ's lr (return address) + BL TCT_Interrupt_Context_Save @ Call context save routine + + BL IQ_IRQ_isr @ Call int. service routine + + /* IRQ interrupt processing is complete. Restore context- Never + returns! */ + B TCT_Interrupt_Context_Restore + +/* BUG correction 2nd part ------------------ */ +IRQBUG: LDMFD sp!,{a1-a4} @ return from interrupt + SUBS pc,r14,#4 +/* BUG correction 2nd part end -------------- */ + + .globl _INT_FIQ +_INT_FIQ: + STMDB sp!,{a1-a4} @ Save a1-a4 on temporary FIQ stack + SUB a4,lr,#4 @ Save FIQ's lr (return address) + BL TCT_Interrupt_Context_Save @ Call context save routine + + BL IQ_FIQ_isr @ Call the FIQ ISR + + /* FIQ interrupt processing is complete. Restore context- Never + returns! */ + B TCT_Interrupt_Context_Restore