git.sur5r.net Git - freertos/blob - Demo/ARM7_LPC2106_GCC/boot.s

   1         /* Sample initialization file */\r
   2 \r
   3         .extern main\r
   4         .extern exit\r
   5 \r
   6         .text\r
   7         .code 32\r
   8 \r
   9 \r
  10         .align  0\r
  11 \r
  12         .extern __bss_beg__\r
  13         .extern __bss_end__\r
  14         .extern __stack_end__\r
  15         .extern __data_beg__\r
  16         .extern __data_end__\r
  17         .extern __data+beg_src__\r
  18 \r
  19         .global start\r
  20         .global endless_loop\r
  21 \r
  22         /* Stack Sizes */\r
  23     .set  UND_STACK_SIZE, 0x00000004\r
  24     .set  ABT_STACK_SIZE, 0x00000004\r
  25     .set  FIQ_STACK_SIZE, 0x00000004\r
  26     .set  IRQ_STACK_SIZE, 0X00000400\r
  27     .set  SVC_STACK_SIZE, 0x00000400\r
  28 \r
  29         /* Standard definitions of Mode bits and Interrupt (I & F) flags in PSRs */\r
  30     .set  MODE_USR, 0x10            /* User Mode */\r
  31     .set  MODE_FIQ, 0x11            /* FIQ Mode */\r
  32     .set  MODE_IRQ, 0x12            /* IRQ Mode */\r
  33     .set  MODE_SVC, 0x13            /* Supervisor Mode */\r
  34     .set  MODE_ABT, 0x17            /* Abort Mode */\r
  35     .set  MODE_UND, 0x1B            /* Undefined Mode */\r
  36     .set  MODE_SYS, 0x1F            /* System Mode */\r
  37 \r
  38     .equ  I_BIT, 0x80               /* when I bit is set, IRQ is disabled */\r
  39     .equ  F_BIT, 0x40               /* when F bit is set, FIQ is disabled */\r
  40 \r
  41 \r
  42 start:\r
  43 _start:\r
  44 _mainCRTStartup:\r
  45 \r
  46         /* Setup a stack for each mode - note that this only sets up a usable stack\r
  47         for system/user, SWI and IRQ modes.   Also each mode is setup with\r
  48         interrupts initially disabled. */\r
  49     ldr   r0, .LC6\r
  50     msr   CPSR_c, #MODE_UND|I_BIT|F_BIT /* Undefined Instruction Mode */\r
  51     mov   sp, r0\r
  52     sub   r0, r0, #UND_STACK_SIZE\r
  53     msr   CPSR_c, #MODE_ABT|I_BIT|F_BIT /* Abort Mode */\r
  54     mov   sp, r0\r
  55     sub   r0, r0, #ABT_STACK_SIZE\r
  56     msr   CPSR_c, #MODE_FIQ|I_BIT|F_BIT /* FIQ Mode */\r
  57     mov   sp, r0\r
  58     sub   r0, r0, #FIQ_STACK_SIZE\r
  59     msr   CPSR_c, #MODE_IRQ|I_BIT|F_BIT /* IRQ Mode */\r
  60     mov   sp, r0\r
  61     sub   r0, r0, #IRQ_STACK_SIZE\r
  62     msr   CPSR_c, #MODE_SVC|I_BIT|F_BIT /* Supervisor Mode */\r
  63     mov   sp, r0\r
  64     sub   r0, r0, #SVC_STACK_SIZE\r
  65     msr   CPSR_c, #MODE_SYS|I_BIT|F_BIT /* System Mode */\r
  66     mov   sp, r0\r
  67 \r
  68         /* We want to start in supervisor mode.  Operation will switch to system\r
  69         mode when the first task starts. */\r
  70         msr   CPSR_c, #MODE_SVC|I_BIT|F_BIT\r
  71 \r
  72         /* Clear BSS. */\r
  73 \r
  74         mov     a2, #0                  /* Fill value */\r
  75         mov             fp, a2                  /* Null frame pointer */\r
  76         mov             r7, a2                  /* Null frame pointer for Thumb */\r
  77 \r
  78         ldr             r1, .LC1                /* Start of memory block */\r
  79         ldr             r3, .LC2                /* End of memory block */\r
  80         subs    r3, r3, r1      /* Length of block */\r
  81         beq             .end_clear_loop\r
  82         mov             r2, #0\r
  83 \r
  84 .clear_loop:\r
  85         strb    r2, [r1], #1\r
  86         subs    r3, r3, #1\r
  87         bgt             .clear_loop\r
  88 \r
  89 .end_clear_loop:\r
  90 \r
  91         /* Initialise data. */\r
  92 \r
  93         ldr             r1, .LC3                /* Start of memory block */\r
  94         ldr             r2, .LC4                /* End of memory block */\r
  95         ldr             r3, .LC5\r
  96         subs    r3, r3, r1              /* Length of block */\r
  97         beq             .end_set_loop\r
  98 \r
  99 .set_loop:\r
 100         ldrb    r4, [r2], #1\r
 101         strb    r4, [r1], #1\r
 102         subs    r3, r3, #1\r
 103         bgt             .set_loop\r
 104 \r
 105 .end_set_loop:\r
 106 \r
 107         mov             r0, #0          /* no arguments  */\r
 108         mov             r1, #0          /* no argv either */\r
 109 \r
 110         bl              main\r
 111 \r
 112 endless_loop:\r
 113         b               endless_loop\r
 114 \r
 115 \r
 116         .align 0\r
 117 \r
 118         .LC1:\r
 119         .word   __bss_beg__\r
 120         .LC2:\r
 121         .word   __bss_end__\r
 122         .LC3:\r
 123         .word   __data_beg__\r
 124         .LC4:\r
 125         .word   __data_beg_src__\r
 126         .LC5:\r
 127         .word   __data_end__\r
 128         .LC6:\r
 129         .word   __stack_end__\r
 130 \r
 131 \r
 132         /* Setup vector table.  Note that undf, pabt, dabt, fiq just execute\r
 133         a null loop. */\r
 134 \r
 135 .section .startup,"ax"\r
 136          .code 32\r
 137          .align 0\r
 138 \r
 139         b     _start                                            /* reset - _start                       */\r
 140         ldr   pc, _undf                                         /* undefined - _undf            */\r
 141         ldr   pc, _swi                                          /* SWI - _swi                           */\r
 142         ldr   pc, _pabt                                         /* program abort - _pabt        */\r
 143         ldr   pc, _dabt                                         /* data abort - _dabt           */\r
 144         nop                                                                     /* reserved                                     */\r
 145         ldr   pc, [pc,#-0xFF0]                          /* IRQ - read the VIC           */\r
 146         ldr   pc, _fiq                                          /* FIQ - _fiq                           */\r
 147 \r
 148 _undf:  .word __undf                    /* undefined                            */\r
 149 _swi:   .word vPortYieldProcessor       /* SWI                                          */\r
 150 _pabt:  .word __pabt                    /* program abort                        */\r
 151 _dabt:  .word __dabt                    /* data abort                           */\r
 152 _fiq:   .word __fiq                     /* FIQ                                          */\r
 153 \r
 154 __undf: b     .                         /* undefined                            */\r
 155 __pabt: b     .                         /* program abort                        */\r
 156 __dabt: b     .                         /* data abort                           */\r
 157 __fiq:  b     .                         /* FIQ                                          */\r