FC3000 >> Assembly

Watchdog


參考資料:
1. pdf
2. lichee
3. mangopi_r
4. allwinner

Work Flow


暫存器


main.s

  .global _start
   
  .equiv PIO_BASE,   0x01c20800
  .equiv TIMER_BASE, 0x01c20c00

  .equiv PD,        (0x24 * 3)
  .equiv PE,        (0x24 * 4)
  .equiv PIO_CFG0,  0x00
  .equiv PIO_CFG1,  0x04
  .equiv PIO_CFG2,  0x08
  .equiv PIO_DATA,  0x10
   
  .equiv PORT_CFG0, 0x00
  .equiv PORT_DATA, 0x10
   
  .equiv WDOG_IRQ_EN_REG,  0xa0
  .equiv WDOG_IRQ_STA_REG, 0xa4
  .equiv WDOG_CTRL_REG,    0xb0
  .equiv WDOG_CFG_REG,     0xb4
  .equiv WDOG_MODE_REG,    0xb8

  .equiv LCD_CS,    (1 << 21)
  .equiv LCD_RD,    (1 << 20)
  .equiv LCD_RS,    (1 << 19)
  .equiv LCD_WR,    (1 << 18)
  .equiv LCD_RST,   (1 << 11)
  .equiv LCD_BL,    (1 << 6)
   
  .arm
  .text
_start:
  .long 0xea000016
  .byte 'e', 'G', 'O', 'N', '.', 'B', 'T', '0'
  .long 0, __spl_size
  .byte 'S', 'P', 'L', 2
  .long 0, 0
  .long 0, 0, 0, 0, 0, 0, 0, 0
  .long 0, 0, 0, 0, 0, 0, 0, 0
      
_vector:
  b reset
  b .
  b .
  b .
  b .
  b .
  b .
  b .
      
reset:
  bl lcd_init
   
  ldr r0, =TIMER_BASE
  ldr r1, =(0xa57 << 1) | 1
  str r1, [r0, #WDOG_CTRL_REG]
  ldr r1, =1
  str r1, [r0, #WDOG_CFG_REG]
  ldr r1, =(3 << 4) | 1
  str r1, [r0, #WDOG_MODE_REG]
  b .

delay:
  push {lr}
0:
  subs r0, #1
  bne 0b
  pop {pc}
    
lcd_rst:
  push {r4, r5, lr}
  ldr r4, =PIO_BASE + PE
  ldr r5, =0xffffffff
    
  bic r5, #LCD_RST
  str r5, [r4, #PIO_DATA]
  ldr r0, =10000
  bl delay
    
  orr r5, #LCD_RST
  str r5, [r4, #PIO_DATA]
  ldr r0, =10000
  bl delay
  pop {r4, r5, pc}
    
lcd_wr:
  push {r4, r5, lr}
  ldr r4, =PIO_BASE + PD
    
  and r2, r0, #0x00ff
  and r3, r0, #0xff00
  lsl r2, #1
  lsl r3, #2
    
  eor r5, r5
  orr r5, r1
  orr r5, r2
  orr r5, r3
  orr r5, #LCD_RD
  str r5, [r4, #PIO_DATA]
    
  orr r5, #LCD_WR
  str r5, [r4, #PIO_DATA]
  pop {r4, r5, pc}
    
lcd_dat:
  push {lr}
  mov r1, #LCD_RS
  bl lcd_wr
  pop {pc}
    
lcd_cmd:
  push {lr}
  mov r1, #0
  bl lcd_wr
  pop {pc}
   
lcd_color:
  push {r4, r5, lr}
  ldr r4, =320*240
  mov r5, r0
0:
  mov r0, r5
  bl lcd_dat
  subs r4, #1
  bne 0b
  pop {r4, r5, pc}
    
lcd_init:
  push {r4, lr}
  ldr r4, =PIO_BASE + PD
  ldr r1, [r4, #PIO_CFG0]
  bic r1, #0xfffffff0
  ldr r2, =0x11111110
  orr r1, r2
  str r1, [r4, #PIO_CFG0]
   
  ldr r1, [r4, #PIO_CFG1]
  bic r1, #0xffffff0f
  ldr r2, =0x11111101
  orr r1, r2
  str r1, [r4, #PIO_CFG1]
   
  ldr r1, [r4, #PIO_CFG2]
  bic r1, #0x00ffffff
  ldr r2, =0x00111111
  orr r1, r2
  str r1, [r4, #PIO_CFG2]
    
  ldr r4, =PIO_BASE + PE
  ldr r1, [r4, #PIO_CFG0]
  bic r1, #0x0f000000
  orr r1, #0x01000000
  str r1, [r4, #PIO_CFG0]
    
  ldr r1, [r4, #PIO_CFG1]
  bic r1, #0x0000f000
  orr r1, #0x00001000
  str r1, [r4, #PIO_CFG1]
    
  ldr r4, =PIO_BASE + PD
  ldr r1, [r4, #PIO_DATA]
  ldr r2, =0x003ffdfe
  orr r1, r2
  str r1, [r4, #PIO_DATA]
    
  ldr r4, =PIO_BASE + PE
  ldr r1, [r4, #PIO_DATA]
  orr r1, #(1 << 11) | (1 << 6)
  str r1, [r4, #PIO_DATA]
    
  bl lcd_rst
    
  ldr r0, =0x800
  bl lcd_cmd
  ldr r0, =0x100
  bl lcd_dat
  ldr r0, =0x1000
  bl lcd_cmd
  ldr r0, =0x700
  bl lcd_dat
  ldr r0, =0x1800
  bl lcd_cmd
  ldr r0, =0xc002
  bl lcd_dat
  ldr r0, =0x2000
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x4000
  bl lcd_cmd
  ldr r0, =0x1200
  bl lcd_dat
  ldr r0, =0x4800
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x5000
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x6000
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x6800
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x7800
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x8000
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x8800
  bl lcd_cmd
  ldr r0, =0x3800
  bl lcd_dat
  ldr r0, =0x9000
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x9800
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x3800
  bl lcd_cmd
  ldr r0, =0x800
  bl lcd_dat
  ldr r0, =0x8000
  bl lcd_cmd
  ldr r0, =0x8682
  bl lcd_dat
  ldr r0, =0x8800
  bl lcd_cmd
  ldr r0, =0x3e60
  bl lcd_dat
  ldr r0, =0x9000
  bl lcd_cmd
  ldr r0, =0xc080
  bl lcd_dat
  ldr r0, =0x9800
  bl lcd_cmd
  ldr r0, =0x603
  bl lcd_dat
  ldr r0, =0x4820
  bl lcd_cmd
  ldr r0, =0xf000
  bl lcd_dat
  ldr r0, =0x5820
  bl lcd_cmd
  ldr r0, =0x7000
  bl lcd_dat
  ldr r0, =0x20
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x820
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x8020
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x8820
  bl lcd_cmd
  ldr r0, =0x3d00
  bl lcd_dat
  ldr r0, =0x9020
  bl lcd_cmd
  ldr r0, =0x2000
  bl lcd_dat
  ldr r0, =0xa820
  bl lcd_cmd
  ldr r0, =0x2a00
  bl lcd_dat
  ldr r0, =0xb020
  bl lcd_cmd
  ldr r0, =0x2000
  bl lcd_dat
  ldr r0, =0xb820
  bl lcd_cmd
  ldr r0, =0x3b00
  bl lcd_dat
  ldr r0, =0xc020
  bl lcd_cmd
  ldr r0, =0x1000
  bl lcd_dat
  ldr r0, =0xc820
  bl lcd_cmd
  ldr r0, =0x3f00
  bl lcd_dat
  ldr r0, =0xe020
  bl lcd_cmd
  ldr r0, =0x1500
  bl lcd_dat
  ldr r0, =0xe820
  bl lcd_cmd
  ldr r0, =0x2000
  bl lcd_dat
  ldr r0, =0x8040
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x8840
  bl lcd_cmd
  ldr r0, =0x78e0
  bl lcd_dat
  ldr r0, =0x9040
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x9840
  bl lcd_cmd
  ldr r0, =0xf920
  bl lcd_dat
  ldr r0, =0x60
  bl lcd_cmd
  ldr r0, =0x714
  bl lcd_dat
  ldr r0, =0x860
  bl lcd_cmd
  ldr r0, =0x800
  bl lcd_dat
  ldr r0, =0x5060
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x80
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x880
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x1080
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x1880
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x2080
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x2880
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x8080
  bl lcd_cmd
  ldr r0, =0x8000
  bl lcd_dat
  ldr r0, =0x9080
  bl lcd_cmd
  ldr r0, =0x600
  bl lcd_dat
  ldr r0, =0x1800
  bl lcd_cmd
  ldr r0, =0x4020
  bl lcd_dat
  ldr r0, =0x3800
  bl lcd_cmd
  ldr r0, =0x9920
  bl lcd_dat
  ldr r0, =0x8040
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x8840
  bl lcd_cmd
  ldr r0, =0x78e0
  bl lcd_dat
  ldr r0, =0x9040
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x9840
  bl lcd_cmd
  ldr r0, =0xf920
  bl lcd_dat
  ldr r0, =0x20
  bl lcd_cmd
  ldr r0, =0x78e0
  bl lcd_dat
  ldr r0, =0x820
  bl lcd_cmd
  ldr r0, =0x0
  bl lcd_dat
  ldr r0, =0x1020
  bl lcd_cmd
  pop {r4, pc} 
  .end

P.S. 點亮屏後,等待Watchdog(1秒)去重啟系統,達到閃屏的效果

完成


返回上一頁