mirror of
https://github.com/FreeRTOS/FreeRTOS-Kernel.git
synced 2025-08-20 01:58:32 -04:00
Add FreeRTOS-Plus directory.
This commit is contained in:
parent
7bd5f21ad5
commit
f508a5f653
6798 changed files with 134949 additions and 19 deletions
242
FreeRTOS/Demo/ARM9_STR91X_IAR/91x_init.s
Normal file
242
FreeRTOS/Demo/ARM9_STR91X_IAR/91x_init.s
Normal file
|
@ -0,0 +1,242 @@
|
|||
;******************** (C) COPYRIGHT 2006 STMicroelectronics ********************
|
||||
;* File Name : 91x_init.s
|
||||
;* Author : MCD Application Team
|
||||
;* Date First Issued : 05/18/2006 : Version 1.0
|
||||
;* Description : This module performs:
|
||||
;* - FLASH/RAM initialization,
|
||||
;* - Stack pointer initialization for each mode ,
|
||||
;* - Branches to ?main in the C library (which eventually
|
||||
;* calls main()).
|
||||
;*
|
||||
;* On reset, the ARM core starts up in Supervisor (SVC) mode,
|
||||
;* in ARM state,with IRQ and FIQ disabled.
|
||||
;*******************************************************************************
|
||||
;* 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.
|
||||
;******************************************************************************/
|
||||
|
||||
; At power up, the CPU defaults to run on the oscillator clock, so Depending
|
||||
; of your Application, Disable or Enable the following Define
|
||||
|
||||
#define PLL_Clock ; Use PLL as the default clock source @ 96 MHz only with
|
||||
; Bank 0 @ 0x0 and Bank 1 @ 0x80000
|
||||
; #define RTC_Clock ; Use RTC as the default clock source
|
||||
; #define OSC_Clock ; Use OSC as the default clock source
|
||||
|
||||
|
||||
; --- Standard definitions of mode bits and interrupt (I & F) flags in PSRs
|
||||
|
||||
Mode_USR EQU 0x10
|
||||
Mode_FIQ EQU 0x11
|
||||
Mode_IRQ EQU 0x12
|
||||
Mode_SVC EQU 0x13
|
||||
Mode_ABT EQU 0x17
|
||||
Mode_UND EQU 0x1B
|
||||
Mode_SYS EQU 0x1F ; available on ARM Arch 4 and later
|
||||
|
||||
I_Bit EQU 0x80 ; when I bit is set, IRQ is disabled
|
||||
F_Bit EQU 0x40 ; when F bit is set, FIQ is disabled
|
||||
|
||||
|
||||
|
||||
; --- STR9X SCU specific definitions
|
||||
|
||||
SCU_BASE_Address EQU 0x5C002000 ; SCU Base Address
|
||||
SCU_CLKCNTR_OFST EQU 0x00000000 ; Clock Control register Offset
|
||||
SCU_PLLCONF_OFST EQU 0x00000004 ; PLL Configuration register Offset
|
||||
SCU_SYSSTATUS_OFST EQU 0x00000008 ; System Status Register Offset
|
||||
SCU_SCR0_OFST EQU 0x00000034 ; System Configuration Register 0 Offset
|
||||
|
||||
; --- STR9X FMI specific definitions
|
||||
|
||||
FMI_BASE_Address EQU 0x54000000 ; FMI Base Address
|
||||
FMI_BBSR_OFST EQU 0x00000000 ; Boot Bank Size Register
|
||||
FMI_NBBSR_OFST EQU 0x00000004 ; Non-boot Bank Size Register
|
||||
FMI_BBADR_OFST EQU 0x0000000C ; Boot Bank Base Address Register
|
||||
FMI_NBBADR_OFST EQU 0x00000010 ; Non-boot Bank Base Address Register
|
||||
FMI_CR_OFST EQU 0x00000018 ; Control Register
|
||||
|
||||
;---------------------------------------------------------------
|
||||
; ?program_start
|
||||
;---------------------------------------------------------------
|
||||
MODULE ?program_start
|
||||
|
||||
SECTION IRQ_STACK:DATA:NOROOT(3)
|
||||
SECTION FIQ_STACK:DATA:NOROOT(3)
|
||||
SECTION UND_STACK:DATA:NOROOT(3)
|
||||
SECTION ABT_STACK:DATA:NOROOT(3)
|
||||
SECTION SVC_STACK:DATA:NOROOT(3)
|
||||
SECTION CSTACK:DATA:NOROOT(3)
|
||||
SECTION .icode:CODE:NOROOT(2)
|
||||
PUBLIC __iar_program_start
|
||||
EXTERN ?main
|
||||
CODE32
|
||||
|
||||
__iar_program_start:
|
||||
LDR pc, =NextInst
|
||||
|
||||
|
||||
NextInst
|
||||
|
||||
|
||||
NOP ; execute some instructions to access CPU registers after wake
|
||||
NOP ; up from Reset, while waiting for OSC stabilization
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
|
||||
|
||||
; BUFFERED_Mode
|
||||
; ------------------------------------------------------------------------------
|
||||
; Description : Enable the Buffered mode.
|
||||
; Just enable the buffered define on the 91x_conf.h
|
||||
; http://www.arm.com/pdfs/DDI0164A_966E_S.pdf
|
||||
; ------------------------------------------------------------------------------
|
||||
|
||||
MRC p15, 0, r0, c1, c0, 0 ; Read CP15 register 1 into r0
|
||||
ORR r0, r0, #0x8 ; Enable Write Buffer on AHB
|
||||
MCR p15, 0, r0, c1, c0, 0 ; Write CP15 register 1
|
||||
|
||||
|
||||
|
||||
; --- Remap Flash Bank 0 at address 0x0 and Bank 1 at address 0x80000,
|
||||
; when the bank 0 is the boot bank, then enable the Bank 1.
|
||||
|
||||
LDR R6, =FMI_BASE_Address
|
||||
|
||||
LDR R7, = 0x4 ; BOOT BANK Size = 512KB
|
||||
STR R7, [R6, #FMI_BBSR_OFST] ; (2^4) * 32 = 512KB
|
||||
|
||||
LDR R7, = 0x2 ; NON BOOT BANK Size = 32KB
|
||||
STR R7, [R6, #FMI_NBBSR_OFST] ; (2^2) * 8 = 32KB
|
||||
|
||||
LDR R7, = 0x0 ; BOOT BANK Address = 0x0
|
||||
STR R7, [R6, #FMI_BBADR_OFST]
|
||||
|
||||
LDR R7, = 0x20000 ; NON BOOT BANK Address = 0x80000
|
||||
STR R7, [R6, #FMI_NBBADR_OFST] ; need to put 0x20000 because FMI
|
||||
; bus on A[25:2] of CPU bus
|
||||
|
||||
LDR R7, = 0x18 ; Enable CS on both banks
|
||||
STR R7, [R6, #FMI_CR_OFST] ; LDR R7, = 0x19 ;in RevD
|
||||
; to enable 8 words PFQ deepth
|
||||
|
||||
; --- Enable 96K RAM, PFQBC enabled, DTCM & AHB wait-states disabled
|
||||
LDR R0, = SCU_BASE_Address
|
||||
LDR R1, = 0x0191
|
||||
STR R1, [R0, #SCU_SCR0_OFST]
|
||||
|
||||
; ------------------------------------------------------------------------------
|
||||
; --- System clock configuration
|
||||
; ------------------------------------------------------------------------------
|
||||
|
||||
#ifdef PLL_Clock ; Use 96 MHZ PLL clock as the default frequency
|
||||
|
||||
; --- wait states Flash confguration
|
||||
|
||||
LDR R6, = 0x00080000 ;Write a Write Flash Configuration
|
||||
LDR R7, =0x60 ;Register command (60h) to any word
|
||||
STRH R7, [R6] ;address in Bank 1.
|
||||
|
||||
LDR R6, = 0x00083040 ;Write a Write Flash Configuration
|
||||
LDR R7, = 0x3 ;Register Confirm command (03h)
|
||||
STRH R7, [R6] ;2Wstaites in read,PWD,LVD enabled,
|
||||
;High BUSCFG.
|
||||
; --- PLL configuration
|
||||
LDR R1, = 0x00020002 ;Set OSC as clock source
|
||||
STR R1, [R0, #SCU_CLKCNTR_OFST ]
|
||||
|
||||
|
||||
NOP ; Wait for OSC stabilization
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
NOP
|
||||
|
||||
|
||||
|
||||
|
||||
LDR R1, = 0x000ac019 ;Set PLL ENABLE, to 96Mhz
|
||||
STR R1, [R0, #SCU_PLLCONF_OFST]
|
||||
|
||||
Wait_Loop
|
||||
LDR R1,[R0, #SCU_SYSSTATUS_OFST] ;Wait until PLL is Locked
|
||||
ANDS R1, R1, #0x01
|
||||
BEQ Wait_Loop
|
||||
|
||||
LDR R1, = 0x00020080 ;Set PLL as clock source after pll
|
||||
STR R1, [R0, #SCU_CLKCNTR_OFST ] ;is locked and FMICLK=RCLK,
|
||||
;PCLK=RCLK/2
|
||||
#endif
|
||||
|
||||
#ifdef RTC_Clock ;Use RTC as the default clock source
|
||||
LDR R1, = 0x00020001 ;Set RTC as clock source and
|
||||
STR R1, [R0, #SCU_CLKCNTR_OFST ] ;FMICLK=RCLK, PCLK=RCLK
|
||||
#endif
|
||||
|
||||
#ifdef OSC_Clock ;Use Osc as the default clock source
|
||||
LDR R1, = 0x00020002 ;Set OSC as clock source and
|
||||
STR R1, [R0, #SCU_CLKCNTR_OFST ] ;FMICLK=RCLK, PCLK=RCLK
|
||||
#endif
|
||||
|
||||
|
||||
; --- 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, =SFE(FIQ_STACK)
|
||||
|
||||
MSR CPSR_c, #Mode_IRQ|I_Bit|F_Bit ; No interrupts
|
||||
LDR SP, = SFE(IRQ_STACK)
|
||||
|
||||
MSR CPSR_c, #Mode_ABT|I_Bit|F_Bit ; No interrupts
|
||||
LDR SP, = SFE(ABT_STACK)
|
||||
|
||||
MSR CPSR_c, #Mode_UND|I_Bit|F_Bit ; No interrupts
|
||||
LDR SP, = SFE(UND_STACK)
|
||||
|
||||
MSR CPSR_c, #Mode_SYS ; IRQs & FIQs are now enabled
|
||||
LDR SP, = SFE(CSTACK)
|
||||
|
||||
MSR CPSR_c, #Mode_SVC|I_Bit|F_Bit ; No interrupts
|
||||
LDR SP, = SFE(SVC_STACK)
|
||||
|
||||
; --- Set bits 17-18(DTCM/ITCM order bits)of the Core Configuration Control
|
||||
; Register
|
||||
MOV r0, #0x60000
|
||||
MCR p15,0x1,r0,c15,c1,0
|
||||
|
||||
; --- Now enter the C code
|
||||
B ?main ; Note : use B not BL, because an application will
|
||||
; never return this way
|
||||
|
||||
LTORG
|
||||
|
||||
|
||||
END
|
||||
;******************* (C) COPYRIGHT 2006 STMicroelectronics *****END OF FILE****
|
||||
|
||||
|
||||
|
||||
|
Loading…
Add table
Add a link
Reference in a new issue