/* Re-copy kernel image from given offset in a0 (length a1), and then
 * jump to entry point contained in a2. Copies data to location pointed
 * to in a3
 * Very naive.
 * ------------------------------------------------------------------
 * (c) 2008 Philippe Vachon <philippe@cowpig.ca>
 * Licensed under the GNU General Public License v3. See COPYING in the
 * source distribution for more details.
 */

#include <asm/regdef.h>
#include <asm/asm.h>

#define KSEG0       0x80000000
#define CACHE_SIZE  0x4000

#define ICACHE_INVALIDATE               0x00
#define DCACHE_WRITEBACK_INVALIDATE     0x01

#define CACHE_LINE_LEN          0x4

EXPORT(_start)

LEAF(_start)
    .set noreorder
    .set mips3

1:  lw s0, 0(a0)   # load byte from address pointed to in a0 
    sw s0, 0(a3)    # copy byte to address pointed to in a3

    addiu a0, 4     # next location to read from
    addiu a3, 4     # next location to write to

    bnez a1, 1b     # continue copying
     addi a1, -4     # subtract from remaining bytes to copy

    nop
    
    /* put the stack pointer up at top of memory */
    li a0, 4
    syscall
    nop

    li sp, KSEG0
    add sp, sp, v0
    
    /* invalidate the caches */
    li k0, KSEG0
    addi k1, k0, CACHE_SIZE

2:  cache ICACHE_INVALIDATE, 0(k0)
    cache DCACHE_WRITEBACK_INVALIDATE, 0(k0)

    ble k0, k1, 2b
     addi k0, CACHE_LINE_LEN

    /* jump to the kernel, setting up the firmware args appropriately */
    move a0, v0
    li a1, KSEG0
    li a3, 0
    li v0, 0

    
    jr a2           # jump to kernel entry point
     nop

    END(_start)