git.mutantstargoat.com Git - rpikern/blob - src/startup.s

   1         .extern main
   2
   3         .section .startup
   4         .code 32
   5
   6 startup:
   7         @ stop all but one of the cores
   8         mrc p15, 0, r0, c0, c0, 5
   9         ands r0, r0, #0xff
  10         bne exit
  11
  12         @ setup stack
  13         ldr sp, =_stacktop
  14
  15         @ clear bss
  16         ldr r0, =_bss_start
  17         ldr r1, =_bss_size
  18         cmp r1, #0
  19         beq 1f          @ 0-sized bss, skip clear
  20         mov r2, #0
  21 0:      str r2, [r0], #4
  22         subs r1, #4
  23         bne 0b
  24 1:
  25         blx main
  26
  27         .global exit
  28 exit:   wfe
  29         b exit
  30
  31         .global dbgled
  32 dbgled:
  33         ldr r3, =0x3f200000     @ gpio base
  34         ldr r2, =0x9000         @ gpio 24 and 25 -> output
  35         str r2, [r3, #8]        @ store to GPFSEL2
  36         ldr r2, =0x01000000     @ bit 24
  37         tst r0, #1
  38         strne r2, [r3, #0x1c]   @ GPSET0
  39         streq r2, [r3, #0x28]   @ GPCLR0
  40         lsl r2, #1
  41         tst r0, #2
  42         strne r2, [r3, #0x1c]   @ GPSET0
  43         streq r2, [r3, #0x28]   @ GPCLR0
  44         bx lr
  45
  46 @ vi:set filetype=armasm: