;******************** (C) COPYRIGHT 2006 STMicroelectronics ******************** ;* File Name : 91x_vect.s ;* Author : MCD Application Team ;* Date First Issued : 05/18/2006 : Version 1.0 ;* Description : This File used to initialize the exception and IRQ ;* vectors, and to enter/return to/from exceptions ;* handlers. ;******************************************************************************* * History: * 05/22/2007 : Version 1.2 * 05/24/2006 : Version 1.1 * 05/18/2006 : Version 1.0 ;******************************************************************************* ; THE PRESENT SOFTWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS WITH ; CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME. AS ; A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT, INDIRECT ; OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE CONTENT ; OF SUCH SOFTWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING INFORMATION ; CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS. ;******************************************************************************/ #include "FreeRTOSConfig.h" #include "ISR_Support.h" SECTION .intvec:CODE:ROOT(2) CODE32 VectorAddress EQU 0xFFFFF030 ; VIC Vector address register address. VectorAddressDaisy EQU 0xFC000030 ; Daisy VIC Vector address register I_Bit EQU 0x80 ; when I bit is set, IRQ is disabled F_Bit EQU 0x40 ; when F bit is set, FIQ is disabled ;******************************************************************************* ; Import the __iar_program_start address from 91x_init.s ;******************************************************************************* IMPORT __iar_program_start ;******************************************************************************* ; Import exception handlers ;******************************************************************************* IMPORT Undefined_Handler IMPORT vPortYieldProcessor ; FreeRTOS SWI handler IMPORT Prefetch_Handler IMPORT Abort_Handler IMPORT FIQ_Handler ;******************************************************************************* ; Export Peripherals IRQ handlers table address ;******************************************************************************* ;******************************************************************************* ; Exception vectors ;******************************************************************************* LDR PC, Reset_Addr LDR PC, Undefined_Addr LDR PC, SWI_Addr LDR PC, Prefetch_Addr LDR PC, Abort_Addr NOP ; Reserved vector LDR PC, IRQ_Addr ;******************************************************************************* ;* Function Name : FIQHandler ;* Description : This function is called when FIQ exception is entered. ;* Input : none ;* Output : none ;******************************************************************************* FIQHandler SUB lr,lr,#4 ; Update the link register. STMFD sp!,{r0-r7,lr} ; Save The workspace plus the current return ; address lr_fiq into the FIQ stack. ldr r0,=FIQ_Handler ldr lr,=FIQ_Handler_end bx r0 ;Branch to FIQ_Handler. FIQ_Handler_end: LDMFD sp!,{r0-r7,pc}^; Return to the instruction following... ; ...the exception interrupt. ;******************************************************************************* ; Exception handlers address table ;******************************************************************************* Reset_Addr DCD __iar_program_start Undefined_Addr DCD UndefinedHandler SWI_Addr DCD vPortYieldProcessor Prefetch_Addr DCD PrefetchAbortHandler Abort_Addr DCD DataAbortHandler DCD 0 ; Reserved vector IRQ_Addr DCD IRQHandler ;******************************************************************************* ; MACRO ;******************************************************************************* ;******************************************************************************* ;* Macro Name : SaveContext ;* Description : This macro is used to save the context before entering ; an exception handler. ;* Input : The range of registers to store. ;* Output : none ;******************************************************************************* SaveContext MACRO reg1,reg2 STMFD sp!,{reg1-reg2,lr} ; Save The workspace plus the current return ; address lr_ mode into the stack. MRS r1,spsr ; Save the spsr_mode into r1. STMFD sp!,{r1} ; Save spsr. ENDM ;******************************************************************************* ;* Macro Name : RestoreContext ;* Description : This macro is used to restore the context to return from ; an exception handler and continue the program execution. ;* Input : The range of registers to restore. ;* Output : none ;******************************************************************************* RestoreContext MACRO reg1,reg2 LDMFD sp!,{r1} ; Restore the saved spsr_mode into r1. MSR spsr_cxsf,r1 ; Restore spsr_mode. LDMFD sp!,{reg1-reg2,pc}^; Return to the instruction following... ; ...the exception interrupt. ENDM ;******************************************************************************* ; Exception Handlers ;******************************************************************************* ;******************************************************************************* ;* Function Name : UndefinedHandler ;* Description : This function is called when undefined instruction ; exception is entered. ;* Input : none ;* Output : none ;******************************************************************************* UndefinedHandler SaveContext r0,r12 ; Save the workspace plus the current ; return address lr_ und and spsr_und. ldr r0,=Undefined_Handler ldr lr,=Undefined_Handler_end bx r0 ; Branch to Undefined_Handler. Undefined_Handler_end: RestoreContext r0,r12 ; Return to the instruction following... ; ...the undefined instruction. ;******************************************************************************* ;* Function Name : PrefetchAbortHandler ;* Description : This function is called when Prefetch Abort ; exception is entered. ;* Input : none ;* Output : none ;******************************************************************************* PrefetchAbortHandler SUB lr,lr,#4 ; Update the link register. SaveContext r0,r12 ; Save the workspace plus the current ; return address lr_abt and spsr_abt. ldr r0,=Prefetch_Handler ldr lr,=Prefetch_Handler_end bx r0 ; Branch to Prefetch_Handler. Prefetch_Handler_end: RestoreContext r0,r12 ; Return to the instruction following that... ; ...has generated the prefetch abort exception. ;******************************************************************************* ;* Function Name : DataAbortHandler ;* Description : This function is called when Data Abort ; exception is entered. ;* Input : none ;* Output : none ;******************************************************************************* DataAbortHandler SUB lr,lr,#8 ; Update the link register. SaveContext r0,r12 ; Save the workspace plus the current ; return address lr_ abt and spsr_abt. ldr r0,=Abort_Handler ldr lr,=Abort_Handler_end bx r0 ; Branch to Abort_Handler. Abort_Handler_end: RestoreContext r0,r12 ; Return to the instruction following that... ; ...has generated the data abort exception. ;******************************************************************************* ;* Function Name : IRQHandler ;* Description : This function is called when IRQ exception is entered. ;* Input : none ;* Output : none ;******************************************************************************* IRQHandler portSAVE_CONTEXT ; Save the context of the current task. LDR r0, = VectorAddress LDR r0, [r0] ; Read the routine address LDR r1, = VectorAddressDaisy LDR r1, [r1] MOV lr, pc bx r0 LDR r0, = VectorAddress ; Write to the VectorAddress to clear the STR r0, [r0] ; respective interrupt in the internal interrupt LDR r1, = VectorAddressDaisy ; Write to the VectorAddressDaisy to clear the STR r1,[r1] ; respective interrupt in the internal interrupt portRESTORE_CONTEXT ; Restore the context of the selected task. LTORG END ;******************* (C) COPYRIGHT 2006 STMicroelectronics *****END OF FILE****