S3C2440休眠和唤醒流程解析(WinCE 6)(2)

;Check if the boot is caused by the wake-up from SLEEP mode.    ldr r1,=GSTATUS2    ldr r0,[r1]    tst r0,#0x2      ;In case of the wake-up from SLEEP mode, go to SLEEP_WAKEUP handler.    bne WAKEUP_SLEEP            WAKEUP_SLEEP    ;Release SCLKn after wake-up from the SLEEP mode.    ldr r1,=MISCCR    ldr r0,[r1]    bic r0,r0,#(7<<17)  ;SCLK0:0->SCLK, SCLK1:0->SCLK, SCKE:0->=SCKE.    str r0,[r1]       ;Set memory control registers     ldr r0,=SMRDATA    ldr r1,=BWSCON ;BWSCON Address    add r2, r0, #52 ;End address of SMRDATA   0    ldr r3, [r0], #4    str r3, [r1], #4    cmp r2, r0    bne %B0       mov r1,#256   0 subs r1,r1,#1 ;1) wait until the SelfRefresh is released.    bne %B0      ;------------------------------------------------------------------------------   ;   Recover Process : Starting Point   ;   ;   1. Checksum Calculation saved Data   ;; 这里的SLEEPDATA_BASE_PHYSICAL，必须上面的虚拟地址SLEEPDATA_BASE_VIRTUAL映射到相同的物理内存    ldr     r5, =SLEEPDATA_BASE_PHYSICAL    ; pointer to physical address of reserved Sleep mode info data structure     mov     r3, r5                          ; pointer for checksum calculation    ldr     r2, =0x0    ldr     r0, =(SLEEPDATA_SIZE-1)             ; get size of data structure to do checksum on   50     ldr     r1, [r3], #4                    ; pointer to SLEEPDATA    and     r1, r1, #0x1    mov     r1, r1, ROR #31    add     r2, r2, r1    subs    r0, r0, #1                      ; dec the count    bne     %b50                            ; loop till done          ;; 检查校验和，如果不匹配，说明内存中保存的数据有问题，按冷启动执行    ldr     r0,=GSTATUS3    ldr     r3, [r0]                        ; get the Sleep data checksum from the Power Manager Scratch pad register    cmp     r2, r3                          ; compare to what we saved before going to sleep    bne     BringUpWinCE                    ; bad news - do a cold boot         ;   2. MMU Enable    ldr     r10, [r5, #SleepState_MMUDOMAIN] ; load the MMU domain access info    ldr     r9,  [r5, #SleepState_MMUTTB]    ; load the MMU TTB info     ldr     r8,  [r5, #SleepState_MMUCTL]    ; load the MMU control info     ldr     r7,  [r5, #SleepState_WakeAddr ] ; load the LR address    nop             nop    nop    nop    nop      ; if software reset    mov     r1, #0    teq     r1, r7    bne     %f60    b       BringUpWinCE      ; wakeup routine   60 mcr     p15, 0, r10, c3, c0, 0          ; setup access to domain 0    mcr     p15, 0, r9,  c2, c0, 0          ; PT address    mcr     p15, 0, r0,  c8, c7, 0          ; flush I+D TLBs    mcr     p15, 0, r8,  c1, c0, 0          ; restore MMU control      ;   3. Jump to Kernel Image's fw.s (Awake_address)    mov     pc, r7                          ;  jump to new VA (back up Power management stack)    nop      BringUpWinCE    ; bad news, data lose, bring up wince again    mov  r0, #2    ldr  r1, =GSTATUS2    str  r0, [r1]