@ Steps 4g..4h
        adr     r0,MemTable2
        bl      reginit
        @ Done with memory setup


        @ Check if we return from Sleep Mode via RCSR (3-33)
        ldr     r0, rcsr_addr
        ldr     r1, [r0]
        and     r1,r1,#0xf                      @ mask RCSR_HWR|RCSR_WDR|RCSR_SMR|RCSR_GPR
        str     r1, [r0]                        @ clear Reset Controll State Register
        teq     r1, #4                          @ RCSR_SMR (Sleep Mode)
        beq     WakeUp

        @ Issue Frequency Change Sequence
freqchange:
        mov     r0, #3
        mcr     p14, 0, r0, c6, c0, 0
        mov     pc, r11