URL
https://opencores.org/ocsvn/openrisc/openrisc/trunk
Subversion Repositories openrisc
[/] [openrisc/] [trunk/] [rtos/] [freertos-6.1.1/] [Demo/] [ARM7_STR75x_GCC/] [SystemFiles/] [crt0_STR75x_FreeRTOS.s] - Rev 675
Go to most recent revision | Compare with Previous | Blame | View Log
/* This is the default Startup for STR75x devices for the GNU toolchain It has been designed by ST Microelectronics and modified by Raisonance and FreeRTOS.org. You can use it, modify it, distribute it freely but without any waranty. */ .extern main /*; Depending on Your Application, Disable or Enable the following Defines*/ /*; -------------------------------------------------------------------------- ; SMI Bank0 configuration ; ----------------------------------------------------------------------------*/ .set SMI_Bank0_EN, 0 /*; enable access the SMI Bank0 if 1*/ /*; ---------------------------------------------------------------------------- ; Memory remapping ; ----------------------------------------------------------------------------*/ .set Remap_SRAM, 0 /* remap SRAM at address 0x00 if 1 */ /* ; ---------------------------------------------------------------------------- ; EIC initialization ; ----------------------------------------------------------------------------*/ .set EIC_INIT, 1 /*; Configure and Initialize EIC if 1*/ ;/* the following are useful for initializing the .data section */ .extern _sidata ;/* start address for the initialization values of the .data section. defined in linker script */ .extern _sdata ;/* start address for the .data section. defined in linker script */ .extern _edata ;/* end address for the .data section. defined in linker script */ ;/* the following are useful for initializing the .bss section */ .extern _sbss ;/* start address for the .bss section. defined in linker script */ .extern _ebss ;/* end address for the .bss section. defined in linker script */ ;/* Standard definitions of Mode bits and Interrupt (I & F) flags in PSRs */ .set Mode_USR, 0x10 ;/* User Mode */ .set Mode_FIQ, 0x11 ;/* FIQ Mode */ .set Mode_IRQ, 0x12 ;/* IRQ Mode */ .set Mode_SVC, 0x13 ;/* Supervisor Mode */ .set Mode_ABT, 0x17 ;/* Abort Mode */ .set Mode_UNDEF, 0x1B ;/* Undefined Mode */ .set Mode_SYS, 0x1F ;/* System Mode */ .equ I_Bit, 0x80 ;/* when I bit is set, IRQ is disabled */ .equ F_Bit, 0x40 ;/* when F bit is set, FIQ is disabled */ /*; --- System memory locations */ ;/* init value for the stack pointer. defined in linker script */ .extern _estack ;/* Stack Sizes. The default values are in the linker script, but they can be overriden. */ .extern _UND_Stack_Init .extern _SVC_Stack_Init .extern _ABT_Stack_Init .extern _FIQ_Stack_Init .extern _IRQ_Stack_Init .extern _USR_Stack_Init .extern _UND_Stack_Size .extern _SVC_Stack_Size .extern _ABT_Stack_Size .extern _FIQ_Stack_Size .extern _IRQ_Stack_Size .extern _USR_Stack_Size .extern vTaskSwitchContext .extern ulCriticalNesting SVC_Stack = _SVC_Stack_Init /*_estack*/ /*; 32 byte SVC stack at*/ /*; top of memory */ IRQ_Stack = _IRQ_Stack_Init /*SVC_Stack - 32*/ /*; followed by IRQ stack */ USR_Stack = _USR_Stack_Init /*IRQ_Stack-256*/ /*; followed by USR stack */ FIQ_Stack = _FIQ_Stack_Init /*USR_Stack-256*/ /*; followed by FIQ stack*/ ABT_Stack = _ABT_Stack_Init /*FIQ_Stack-64*/ /*; followed by ABT stack */ UNDEF_Stack = _UND_Stack_Init /*ABT_Stack-0*/ /*; followed by UNDEF stack */ /*; --- System memory locations*/ /*; MRCC Register*/ MRCC_PCLKEN_Addr = 0x60000030 /*; Peripheral Clock Enable register base address*/ /*; CFG Register*/ CFG_GLCONF_Addr = 0x60000010 /*; Global Configuration register base address*/ SRAM_mask = 0x0002 /*; to remap RAM at 0x0*/ /*; GPIO Register*/ GPIOREMAP0R_Addr = 0xFFFFE420 SMI_EN_Mask = 0x00000001 /*; SMI Register*/ SMI_CR1_Addr = 0x90000000 /*; --- Stack Addres for each ARM mode*/ /*; add FIQ_Stack, ABT_Stack, UNDEF_Stack here if you need them*/ /*; --- EIC Registers offsets*/ EIC_base_addr = 0xFFFFF800 /*; EIC base address*/ ICR_off_addr = 0x00 /*; Interrupt Control register offset*/ CICR_off_addr = 0x04 /*; Current Interrupt Channel Register*/ CIPR_off_addr = 0x08 /*; Current Interrupt Priority Register offset*/ IVR_off_addr = 0x18 /*; Interrupt Vector Register offset*/ FIR_off_addr = 0x1C /*; Fast Interrupt Register offset*/ IER_off_addr = 0x20 /*; Interrupt Enable Register offset*/ IPR_off_addr = 0x40 /*; Interrupt Pending Bit Register offset*/ SIR0_off_addr = 0x60 /*; Source Interrupt Register 0*/ /***************************************************************************************/ .globl _start .globl _startup .text _startup: _start: 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 LDR PC, FIQ_Addr Reset_Addr : .long Reset_Handler Undefined_Addr : .long UndefinedHandler SWI_Addr : .long SWIHandler Prefetch_Addr : .long PrefetchAbortHandler Abort_Addr : .long DataAbortHandler .long 0 /*; Reserved vector*/ IRQ_Addr : .long IRQHandler FIQ_Addr : .long FIQHandler .text /*;******************************************************************************* ; Peripherals IRQ handlers address table ;********************************************************************************/ /* execution goes there when an interrupt occurs and there is no associated ISR */ .globl __wrongvector __wrongvector: ldr PC, __wrongvector_Addr __wrongvector_Addr: .long 0 WAKUP_Addr :.long WAKUPIRQHandler TIM2_OC2_Addr :.long TIM2_OC2IRQHandler TIM2_OC1_Addr :.long TIM2_OC1IRQHandler TIM2_IC12_Addr :.long TIM2_IC12IRQHandler TIM2_UP_Addr :.long TIM2_UPIRQHandler TIM1_OC2_Addr :.long TIM1_OC2IRQHandler TIM1_OC1_Addr :.long TIM1_OC1IRQHandler TIM1_IC12_Addr :.long TIM1_IC12IRQHandler TIM1_UP_Addr :.long TIM1_UPIRQHandler TIM0_OC2_Addr :.long TIM0_OC2IRQHandler TIM0_OC1_Addr :.long TIM0_OC1IRQHandler TIM0_IC12_Addr :.long TIM0_IC12IRQHandler TIM0_UP_Addr :.long TIM0_UPIRQHandler PWM_OC123_Addr :.long PWM_OC123IRQHandler PWM_EM_Addr :.long PWM_EMIRQHandler PWM_UP_Addr :.long PWM_UPIRQHandler I2C_Addr :.long I2CIRQHandler SSP1_Addr :.long SSP1IRQHandler SSP0_Addr :.long SSP0IRQHandler UART2_Addr :.long UART2IRQHandler UART1_Addr :.long UART1IRQHandler UART0_Addr :.long vSerialISR CAN_Addr :.long CANIRQHandler USB_LP_Addr :.long USB_LPIRQHandler USB_HP_Addr :.long USB_HPIRQHandler ADC_Addr :.long ADCIRQHandler DMA_Addr :.long DMAIRQHandler EXTIT_Addr :.long EXTITIRQHandler MRCC_Addr :.long MRCCIRQHandler FLASHSMI_Addr :.long FLASHSMIIRQHandler RTC_Addr :.long RTCIRQHandler TB_Addr :.long vPortTickISR /*;******************************************************************************* ; Exception Handlers ;********************************************************************************/ /*;******************************************************************************* ;* FreeRTOS.org macros for saving and restoring a task context ;*******************************************************************************/ .macro portSAVE_CONTEXT MACRO /* ; Push R0 as we are going to use the register. */ STMDB SP!, {R0} /* ; Set R0 to point to the task stack pointer. */ STMDB SP, {SP}^ NOP SUB SP, SP, #4 LDMIA SP!, {R0} /* ; Push the return address onto the stack. */ STMDB R0!, {LR} /* ; Now we have saved LR we can use it instead of R0. */ MOV LR, R0 /* ; Pop R0 so we can save it onto the system mode stack. */ LDMIA SP!, {R0} /* ; Push all the system mode registers onto the task stack. */ STMDB LR, {R0-LR}^ NOP SUB LR, LR, #60 /* ; Push the SPSR onto the task stack. */ MRS R0, SPSR STMDB LR!, {R0} LDR R0, =ulCriticalNesting LDR R0, [R0] STMDB LR!, {R0} /* ; Store the new top of stack for the task. */ LDR R1, =pxCurrentTCB LDR R0, [R1] STR LR, [R0] .endm .macro portRESTORE_CONTEXT MACRO /* ; Set the LR to the task stack. */ LDR R1, =pxCurrentTCB LDR R0, [R1] LDR LR, [R0] /* ; The critical nesting depth is the first item on the stack. ; Load it into the ulCriticalNesting variable. */ LDR R0, =ulCriticalNesting LDMFD LR!, {R1} STR R1, [R0] /* ; Get the SPSR from the stack. */ LDMFD LR!, {R0} MSR SPSR_cxsf, R0 /* ; Restore all system mode registers for the task. */ LDMFD LR, {R0-R14}^ NOP /* ; Restore the return address. */ LDR LR, [LR, #+60] /* ; And return - correcting the offset in the LR to obtain the ; correct address. */ SUBS PC, LR, #4 .endm /*;******************************************************************************* ;* Macro Name : SaveContext ;* Description : This macro used to save the context before entering ; an exception handler. ;* Input : The range of registers to store. ;* Output : none ;********************************************************************************/ .macro SaveContext $r0,$r12 STMFD sp!,{r0-r12,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 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 ;********************************************************************************/ .macro RestoreContext $r0,$r12 LDMFD sp!,{r1} /*; Restore the saved spsr_mode into r1.*/ MSR spsr_cxsf,r1 /*; Restore spsr_mode.*/ LDMFD sp!,{r0-r12,pc}^/*; Return to the instruction following...*/ /*; ...the exception interrupt.*/ .endm /*;******************************************************************************* ;* Function Name : UndefinedHandler ;* Description : This function 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.*/ BL Undefined_Handler/*; Branch to Undefined_Handler*/ RestoreContext r0,r12 /*; Return to the instruction following...*/ /*; ...the undefined instruction.*/ /*;******************************************************************************* ;* Function Name : SWIHandler ;* Description : This function called when SWI instruction executed. ;* Input : none ;* Output : none ;********************************************************************************/ SWIHandler: ADD LR, LR, #4 portSAVE_CONTEXT LDR R0, =vTaskSwitchContext MOV LR, PC BX R0 portRESTORE_CONTEXT /*;******************************************************************************* ;* Function Name : IRQHandler ;* Description : This function called when IRQ exception is entered. ;* Input : none ;* Output : none ;********************************************************************************/ IRQHandler: portSAVE_CONTEXT /*; Save the context of the current task. */ LDR r0, =EIC_base_addr LDR r1, =IVR_off_addr LDR lr, =ReturnAddress /*; Load the return address. */ ADD pc,r0,r1 /*; Branch to the IRQ handler. */ ReturnAddress: LDR r0, =EIC_base_addr LDR r2, [r0, #CICR_off_addr] /*; Get the IRQ channel number. */ MOV r3,#1 MOV r3,r3,LSL r2 STR r3,[r0, #IPR_off_addr] /*; Clear the corresponding IPR bit. */ portRESTORE_CONTEXT /*; Restore the context of the selected task. */ /*;******************************************************************************* ;* Function Name : PrefetchAbortHandler ;* Description : This function called when Prefetch Abort ; exception is entered. ;* Input : none ;* Output : none ;*********************************************************************************/ PrefetchAbortHandler: NOP B PrefetchAbortHandler /*;******************************************************************************* ;* Function Name : DataAbortHandler ;* Description : This function is called when Data Abort ; exception is entered. ;* Input : none ;* Output : none ;********************************************************************************/ DataAbortHandler: NOP NOP B DataAbortHandler /*; ...has generated the data abort exception.*/ /*;******************************************************************************* ;* 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.*/ SaveContext r0,r7 /*; Save the workspace plus the current*/ /*; return address lr_ fiq and spsr_fiq.*/ BL FIQ_Handler /*; Branch to FIQ_Handler.*/ RestoreContext r0,r7 /*; Restore the context and return to the...*/ /*; ...program execution.*/ /*;******************************************************************************* ;* Macro Name : IRQ_to_SYS ;* Description : This macro used to switch form IRQ mode to SYS mode ;* Input : none. ;* Output : none ;*******************************************************************************/ .macro IRQ_to_SYS MSR cpsr_c,#0x1F STMFD sp!,{lr} .endm /*;******************************************************************************* ;* Macro Name : SYS_to_IRQ ;* Description : This macro used to switch from SYS mode to IRQ mode ; then to return to IRQHnadler routine. ;* Input : none. ;* Output : none. ;*******************************************************************************/ .macro SYS_to_IRQ LDMFD sp!,{lr} /*; Restore the link register. */ MSR cpsr_c,#0xD2 /*; Switch to IRQ mode.*/ MOV pc,lr /*; Return to IRQHandler routine to clear the*/ /*; pending bit.*/ .endm /*;******************************************************************************* ;* Function Name : WAKUPIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the WAKUP_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* WAKUP_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ WAKUPIRQHandler: IRQ_to_SYS BL WAKUP_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM2_OC2IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM3_OC2_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM2_OC2_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ TIM2_OC2IRQHandler: IRQ_to_SYS BL TIM2_OC2_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM2_OC1IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM2_OC1_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM2_OC1_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ TIM2_OC1IRQHandler: IRQ_to_SYS BL TIM2_OC1_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM2_IC12IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM2_IC12_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM2_IC12_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ TIM2_IC12IRQHandler: IRQ_to_SYS BL TIM2_IC12_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM2_UPIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM2_UP_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM3_UP_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ TIM2_UPIRQHandler: IRQ_to_SYS BL TIM2_UP_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM1_OC2IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM1_OC2_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM1_OC2_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ TIM1_OC2IRQHandler: IRQ_to_SYS BL TIM1_OC2_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM1_OC1IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM1_OC1_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM1_OC1_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ TIM1_OC1IRQHandler: IRQ_to_SYS BL TIM1_OC1_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM1_IC12IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM1_IC12_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM1_IC12_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ TIM1_IC12IRQHandler: IRQ_to_SYS BL TIM1_IC12_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM1_UPIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM1_UP_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM1_UP_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ TIM1_UPIRQHandler: IRQ_to_SYS BL TIM1_UP_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM0_OC2IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM0_OC2_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM0_OC2_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ TIM0_OC2IRQHandler: IRQ_to_SYS BL TIM0_OC2_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM0_OC1IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM0_OC1_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM0_OC1_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ TIM0_OC1IRQHandler: IRQ_to_SYS BL TIM0_OC1_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM0_IC12IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM0_IC12_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM0_IC12_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ TIM0_IC12IRQHandler: IRQ_to_SYS BL TIM0_IC12_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TIM0_UPIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TIM0_UP_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TIM0_UP_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ TIM0_UPIRQHandler: IRQ_to_SYS BL TIM0_UP_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : PWM_OC123IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the PWM_OC123_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* PWM_OC123_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ PWM_OC123IRQHandler: IRQ_to_SYS BL PWM_OC123_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : PWM_EMIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the PWM_EM_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* PWM_EM_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ PWM_EMIRQHandler: IRQ_to_SYS BL PWM_EM_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : PWM_UPIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the PWM_UP_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* PWM_UP_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ PWM_UPIRQHandler: IRQ_to_SYS BL PWM_UP_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : I2CIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the I2C_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* I2C_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ I2CIRQHandler: IRQ_to_SYS BL I2C_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : SSP1IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the SSP1_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* SSP1_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ SSP1IRQHandler: IRQ_to_SYS BL SSP1_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : SSP0IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the SSP0_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* SSP0_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ SSP0IRQHandler: IRQ_to_SYS BL SSP0_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : UART2IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the UART2_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* UART2_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ UART2IRQHandler: IRQ_to_SYS BL UART2_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : UART1IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the UART1_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* UART1_IRQHandler function termination. ;* Input : none ;* Output : none ;*******************************************************************************/ UART1IRQHandler: IRQ_to_SYS BL UART1_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : UART0IRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the UART0_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* UART0_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ UART0IRQHandler: IRQ_to_SYS BL UART0_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : CANIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the CAN_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* CAN_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ CANIRQHandler: IRQ_to_SYS BL CAN_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : USB_LPIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the USB_LP_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* USB_LP_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ USB_LPIRQHandler: IRQ_to_SYS BL USB_LP_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : USB_HPIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the USB_HP_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* USB_HP_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ USB_HPIRQHandler: IRQ_to_SYS BL USB_HP_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : ADCIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the ADC_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* ADC_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ ADCIRQHandler: IRQ_to_SYS BL ADC_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : DMAIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the DMA_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* DMA_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ DMAIRQHandler: IRQ_to_SYS BL DMA_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : EXTITIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the EXTIT_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* EXTIT_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ EXTITIRQHandler: IRQ_to_SYS BL EXTIT_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : MRCCIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the MRCC_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* MRCC_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ MRCCIRQHandler: IRQ_to_SYS BL MRCC_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : FLASHSMIIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the FLASHSMI_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* FLASHSMI_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ FLASHSMIIRQHandler: IRQ_to_SYS BL FLASHSMI_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : RTCIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the RTC_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* RTC_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ RTCIRQHandler: IRQ_to_SYS BL RTC_IRQHandler SYS_to_IRQ /*;******************************************************************************* ;* Function Name : TBIRQHandler ;* Description : This function used to switch to SYS mode before entering ;* the TB_IRQHandler function located in 75x_it.c. ;* Then to return to IRQ mode after the ;* TB_IRQHandler function termination. ;* Input : none ;* Output : none ;********************************************************************************/ TBIRQHandler: IRQ_to_SYS BL TB_IRQHandler SYS_to_IRQ /*;**********************************************************************************/ Reset_Handler: LDR pc, =NextInst NextInst: /*; Reset all Peripheral Clocks*/ /*; This is usefull only when using debugger to Reset\Run the application*/ .if SMI_Bank0_EN LDR r0, =0x01000000 /*; Disable peripherals clock (except GPIO)*/ .else LDR r0, =0x00000000 /*; Disable peripherals clock*/ .endif LDR r1, =MRCC_PCLKEN_Addr STR r0, [r1] .if SMI_Bank0_EN LDR r0, =0x1875623F /*; Peripherals kept under reset (except GPIO)*/ .else LDR r0, =0x1975623F /*; Peripherals kept under reset*/ .endif STR r0, [r1,#4] MOV r0, #0 NOP /*; Wait*/ NOP NOP NOP STR r0, [r1,#4] /*; Disable peripherals reset*/ /*; Initialize stack pointer registers ; Enter each mode in turn and set up the stack pointer*/ MSR CPSR_c, #Mode_FIQ|I_Bit|F_Bit /*; No interrupts*/ ldr sp, =FIQ_Stack MSR CPSR_c, #Mode_IRQ|I_Bit|F_Bit /*; No interrupts*/ ldr sp, =IRQ_Stack MSR CPSR_c, #Mode_ABT|I_Bit|F_Bit /*; No interrupts*/ ldr sp, =ABT_Stack MSR CPSR_c, #Mode_UNDEF|I_Bit|F_Bit /*; No interrupts*/ ldr sp, =UNDEF_Stack MSR CPSR_c, #Mode_SVC|I_Bit|F_Bit /*; No interrupts*/ ldr sp, =_estack /*; ------------------------------------------------------------------------------ ; Description : Enable SMI Bank0: enable GPIOs clock in MRCC_PCLKEN register, ; enable SMI alternate function in GPIO_REMAP register and enable ; Bank0 in SMI_CR1 register. ; ------------------------------------------------------------------------------*/ .if SMI_Bank0_EN MOV r0, #0x01000000 LDR r1, =MRCC_PCLKEN_Addr STR r0, [r1] /*; Enable GPIOs clock*/ LDR r1, =GPIOREMAP0R_Addr MOV r0, #SMI_EN_Mask LDR r2, [r1] ORR r2, r2, r0 STR r2, [r1] /*; Enable SMI alternate function */ LDR r0, =0x251 /*; SMI Bank0 enabled, Prescaler = 2, Deselect Time = 5*/ LDR r1, =SMI_CR1_Addr STR r0, [r1] /*; Configure CR1 register */ LDR r0, =0x00 STR r0, [r1,#4] /*; Reset CR2 register */ .endif /*; ---------------------------------------------------------------------------- ; Description : Remapping SRAM at address 0x00 after the application has ; started executing. ; ----------------------------------------------------------------------------*/ .if Remap_SRAM MOV r0, #SRAM_mask LDR r1, =CFG_GLCONF_Addr LDR r2, [r1] /*; Read GLCONF Register*/ BIC r2, r2, #0x03 /*; Reset the SW_BOOT bits*/ ORR r2, r2, r0 /*; Change the SW_BOOT bits*/ STR r2, [r1] /*; Write GLCONF Register*/ .endif /*;------------------------------------------------------------------------------- ;Description : Initialize the EIC as following : ; - IRQ disabled ; - FIQ disabled ; - IVR contains the load PC opcode ; - All channels are disabled ; - All channels priority equal to 0 ; - All SIR registers contains offset to the related IRQ table entry ;-------------------------------------------------------------------------------*/ .if EIC_INIT LDR r3, =EIC_base_addr LDR r4, =0x00000000 STR r4, [r3, #ICR_off_addr] /*; Disable FIQ and IRQ*/ STR r4, [r3, #IER_off_addr] /*; Disable all interrupts channels*/ LDR r4, =0xFFFFFFFF STR r4, [r3, #IPR_off_addr] /*; Clear all IRQ pending bits*/ LDR r4, =0x18 STR r4, [r3, #FIR_off_addr] /*; Disable FIQ channels and clear FIQ pending bits*/ LDR r4, =0x00000000 STR r4, [r3, #CIPR_off_addr] /*; Reset the current priority register*/ LDR r4, =0xE59F0000 /*; Write the LDR pc,pc,#offset..*/ STR r4, [r3, #IVR_off_addr] /*; ..instruction code in IVR[31:16]*/ LDR r2,= 32 /*; 32 Channel to initialize*/ LDR r0, =WAKUP_Addr /*; Read the address of the IRQs address table*/ LDR r1, =0x00000FFF AND r0,r0,r1 LDR r5,=SIR0_off_addr /*; Read SIR0 address*/ SUB r4,r0,#8 /*; subtract 8 for prefetch*/ LDR r1, =0xF7E8 /*; add the offset to the 0x00 address..*/ /*; ..(IVR address + 7E8 = 0x00)*/ /*; 0xF7E8 used to complete the LDR pc,offset opcode*/ ADD r1,r4,r1 /*; compute the jump offset*/ EIC_INI: MOV r4, r1, LSL #16 /*; Left shift the result*/ STR r4, [r3, r5] /*; Store the result in SIRx register*/ ADD r1, r1, #4 /*; Next IRQ address*/ ADD r5, r5, #4 /*; Next SIR*/ SUBS r2, r2, #1 /*; Decrement the number of SIR registers to initialize*/ BNE EIC_INI /*; If more then continue*/ .endif /* ;copy the initial values for .data section from FLASH to RAM */ ldr R1, =_sidata ldr R2, =_sdata ldr R3, =_edata _reset_inidata_loop: cmp R2, R3 ldrlO R0, [R1], #4 strlO R0, [R2], #4 blO _reset_inidata_loop ;/* Clear the .bss section */ mov r0,#0 ;/* get a zero */ ldr r1,=_sbss ;/* point to bss start */ ldr r2,=_ebss ;/* point to bss end */ _reset_inibss_loop: cmp r1,r2 ;/* check if some data remains to clear */ strlo r0,[r1],#4 ;/* clear 4 bytes */ blo _reset_inibss_loop ;/* loop until done */ /************************************************************************************************/ /*; --- Now enter the C code */ B main /*; Note : use B not BL, because an application will*/ /*; never return this way*/
Go to most recent revision | Compare with Previous | Blame | View Log