/*
 * must copy sram data + text segment BEFORE setting up the kernel stack,
 * as init_thread_union may reside in this section
 */
__copy_sram_datatext:
    mov r5, __sram_datatext_start
    mov r6, __sram_datatext_end
    mov r7, __sram_load_addr

__copy_sram_datatext_loop:
    ld.ab r3, [r7, 4]
    st.ab r3, [r5, 4]
    brlt  r5, r6, __copy_sram_datatext_loop

    ;; Flush and invalidate dcache
    ; Set flush mode for invalidate operation
    lr   r3, [0x48] ; DC_CTRL register
    bset r3, r3, 0x6
    sr   r3, [0x48] ; DC_CTRL register
    ; Start operation
    mov  r3, 0x1
    sr   r3, [0x47] ; DC_IVDC register
    ; Wait operation completion
__dcache_flush_continue:
    lr   r3, [0x48] ; DC_CTRL register
    and  r3, r3, 0x100
    brne r3, 0x0, __dcache_flush_continue

    ;; Invalidate icache
    mov r3, 0x1
    sr  r3, [0x10] ; IC_IVIC