Update cmsis_os2.c

[cmsis-freertos] / Demo / ARM9_STR91X_IAR / 91x_init_IAR.s

;******************** (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/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.
;******************************************************************************/

; Depending in Your Application, Disable or Enable the following Define

;         #define  BUFFERED_Mode       ; Work on Buffered mode, when enabling this define
                               ; just enable the Buffered define on 91x_conf.h

; --- 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

;--- BASE ADDRESSES
; System memory locations

SRAM_Base               EQU     0x04000000
SRAM_Limit              EQU     0x04018000                      ; at the top of 96 KB SRAM

SVC_Stack           DEFINE     SRAM_Limit       ; 512 byte SVC stack at
                                                         ; top of memory - used by kernel.
IRQ_Stack           DEFINE     SVC_Stack-512    ; followed by IRQ stack
USR_Stack           DEFINE     IRQ_Stack-512    ; followed by USR stack.  Tasks run in
                                                ; system mode but task stacks are allocated
                                                ; when the task is created.
FIQ_Stack           DEFINE     USR_Stack-8      ; followed by FIQ stack
ABT_Stack           DEFINE     FIQ_Stack-8      ; followed by ABT stack
UND_Stack               DEFINE     ABT_Stack-8      ; followed by UNDEF stack

                                        EXTERN main

; STR9X register specific definition

FMI_BBSR_AHB_UB                 EQU                     0x54000000
FMI_BBADR_AHB_UB                EQU                     0x5400000C
FMI_NBBSR_AHB_UB                EQU                     0x54000004
FMI_NBBADR_AHB_UB               EQU                     0x54000010

SCU_SCRO_APB1_UB                EQU                     0x4C002034
SCRO_AHB_UNB    EQU     0x5C002034



;---------------------------------------------------------------
; ?program_start
;---------------------------------------------------------------
                MODULE  ?program_start
                RSEG    ICODE:CODE(2)
                IMPORT    LINK
                PUBLIC  __program_start
                EXTERN  ?main
                CODE32
                

__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
                ldr r0,=LINK    ; to include the vector table inside the final executable.



; --- 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, =0x54000000
        LDR R7, =0x4
        STR R7, [R6]

        LDR R6, =0x54000004
        LDR R7, =0x3
        STR R7, [R6]

        LDR R6, =0x5400000C
        LDR R7, =0x0
        STR R7, [R6]

        LDR R6, =0x54000010
        LDR R7, =0x20000
        STR R7, [R6]

        LDR R6, =0x54000018
        LDR R7, =0x18
        STR R7, [R6]
        
; --- Enable 96K RAM
        LDR     R0, = SCRO_AHB_UNB
        LDR     R1, = 0x0196
        STR     R1, [R0]


        /* Setup a stack for each mode - note that this only sets up a usable stack
        for system/user, SWI and IRQ modes.   Also each mode is setup with
        interrupts initially disabled. */

        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_UND|I_Bit|F_Bit   ; No interrupts
        LDR     SP, =UND_Stack

        MSR     CPSR_c, #Mode_SVC|I_Bit|F_Bit   ; No interrupts
        LDR     SP, =SVC_Stack

        MSR     CPSR_c, #Mode_SYS|I_Bit|F_Bit   ; No interrupts
        LDR     SP, =USR_Stack

        /* We want to start in supervisor mode.  Operation will switch to system
        mode when the first task starts. */
        MSR   CPSR_c, #Mode_SVC|I_Bit|F_Bit


; --- Set bits 17-18 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****