source: trunk/platform/g7/sub/100i/boot.c @ 521

#include "lolevel.h"
#include "platform.h"
#include "core.h"

const char * const new_sa = &_end;

/* Ours stuff */
extern long wrs_kernel_bss_start;
extern long wrs_kernel_bss_end;
extern void createHook (void *pNewTcb);
extern void deleteHook (void *pTcb);


void boot();

/* "relocated" functions */
void __attribute__((naked,noinline)) h_usrInit();
void __attribute__((naked,noinline)) h_usrKernelInit();
void __attribute__((naked,noinline)) h_usrRoot();



void boot()
{
    long *canon_data_src = (void*)0xFFBB1AC0;
    long *canon_data_dst = (void*)0x1900;
    long canon_data_len = 0xD610;
    long *canon_bss_start = (void*)0xEF10; // just after data
    long canon_bss_len = 0xA7910 - 0xEF10;
    long i;

    asm volatile (
        "MRC     p15, 0, R0,c1,c0\n"
        "ORR     R0, R0, #0x1000\n"
        "ORR     R0, R0, #4\n"
        "ORR     R0, R0, #1\n"
        "MCR     p15, 0, R0,c1,c0\n"
    :::"r0");

    for(i=0;i<canon_data_len/4;i++)
        canon_data_dst[i]=canon_data_src[i];

    for(i=0;i<canon_bss_len/4;i++)
        canon_bss_start[i]=0;

    asm volatile (
        "MRC     p15, 0, R0,c1,c0\n"
        "ORR     R0, R0, #0x1000\n"
        "BIC     R0, R0, #4\n"
        "ORR     R0, R0, #1\n"
        "MCR     p15, 0, R0,c1,c0\n"
    :::"r0");

    h_usrInit();
}


void h_usrInit()
{
    asm volatile (
        "STR     LR, [SP,#-4]!\n"
        "BL      sub_FF811968\n"
        "MOV     R0, #2\n"
        "MOV     R1, R0\n"
        "BL      sub_FFB98600\n"
        "BL      sub_FFB8ACAC\n"
        "BL      sub_FF8111C4\n"
        "BL      sub_FF811728\n"
        "LDR     LR, [SP],#4\n"
        "B       h_usrKernelInit\n"
    );
}

void  h_usrKernelInit()
{
    asm volatile (
        "STMFD   SP!, {R4,LR}\n"
        "SUB     SP, SP, #8\n"
        "BL      sub_FFB98B00\n"
        "BL      sub_FFBAB8E8\n"
        "LDR     R3, =0xDF30\n"
        "LDR     R2, =0xA3DA0\n"
        "LDR     R1, [R3]\n"
        "LDR     R0, =0xA72D0\n"
        "MOV     R3, #0x100\n"
        "BL      sub_FFBA49F8\n"
        "LDR     R3, =0xDEF0\n"
        "LDR     R0, =0xE738\n"
        "LDR     R1, [R3]\n"
        "BL      sub_FFBA49F8\n"
        "LDR     R3, =0xDFAC\n"
        "LDR     R0, =0xA72A4\n"
        "LDR     R1, [R3]\n"
        "BL      sub_FFBA49F8\n"
        "BL      sub_FFBAFCA4\n"
        "BL      sub_FF8112AC\n"
        "MOV     R4, #0\n"
        "MOV     R3, R0\n"
        "MOV     R12, #0x800\n"
        "LDR     R0, =h_usrRoot\n"
        "MOV     R1, #0x4000\n"
    );    
//      "LDR     R2, =0xE7910\n"        // 0xA7910 + 0x40000
    asm volatile (
        "LDR     R2, =new_sa\n"
        "LDR     R2, [R2]\n"
    );
    asm volatile (
        "STR     R12, [SP]\n"
        "STR     R4, [SP,#4]\n"
        "BL      sub_FFBA8B28\n"
        "ADD     SP, SP, #8\n"
        "LDMFD   SP!, {R4,PC}\n"
    );
}

static long drv_struct[16];
 
static long dh_err()
{
    return -1;
}

static void drv_self_hide()
{
    long drvnum;
    
    drvnum = _iosDrvInstall(dh_err,dh_err,dh_err,dh_err,dh_err,dh_err,dh_err);
    if (drvnum >= 0)
        _iosDevAdd(drv_struct, "A/DISKBOOT.BIN", drvnum);
}


void  h_usrRoot()
{
    asm volatile (
        "STMFD   SP!, {R4,R5,LR}\n"
        "MOV     R5, R0\n"
        "MOV     R4, R1\n"
        "BL      sub_FF8119D0\n"
        "MOV     R1, R4\n"
        "MOV     R0, R5\n"
        "BL      sub_FFB9D794\n"
        "MOV     R1, R4\n"
        "MOV     R0, R5\n"
        "BL      sub_FFB9E20C\n"
        "BL      sub_FF8117E8\n"
        "BL      sub_FF811704\n"
        "BL      sub_FF811A0C\n"
        "BL      sub_FF8119F0\n"
        "BL      sub_FF811A38\n"
        "BL      sub_FF8119C4\n"
    );

    _taskCreateHookAdd(createHook);
    _taskDeleteHookAdd(deleteHook);

    drv_self_hide();

    asm volatile (
        "LDMFD   SP!, {R4,R5,LR}\n"
        "B       sub_FF81136C\n"
    );
}