124 lines
3.4 KiB
C
124 lines
3.4 KiB
C
/*
|
||
**********************************************************************************************************************
|
||
*
|
||
* the Embedded Secure Bootloader System
|
||
*
|
||
*
|
||
* Copyright(C), 2006-2014, Allwinnertech Co., Ltd.
|
||
* All Rights Reserved
|
||
*
|
||
* File :
|
||
*
|
||
* By :
|
||
*
|
||
* Version : V2.00
|
||
*
|
||
* Date :
|
||
*
|
||
* Descript:
|
||
**********************************************************************************************************************
|
||
*/
|
||
#include "common.h"
|
||
#include <asm/io.h>
|
||
#include <asm/arch/spc.h>
|
||
#include <asm/arch/smc.h>
|
||
#include <asm/arch/mmc_boot0.h>
|
||
#include <private_toc.h>
|
||
#include <private_uboot.h>
|
||
#include "asm/arch/platform.h"
|
||
|
||
extern sbrom_toc0_config_t *toc0_config;
|
||
|
||
void secure_switch_unsecure(u32 run_addr, u32 para_addr);
|
||
void secure_switch_other(u32 run_addr, u32 para_addr);
|
||
static void boot0_jmp_monitor(unsigned int addr);
|
||
|
||
unsigned int go_exec (u32 run_addr, u32 para_addr, int out_secure)
|
||
{
|
||
if(out_secure)
|
||
{
|
||
//切换到非安全模式
|
||
asm volatile("stmfd sp!, {r0, r1}");
|
||
|
||
struct spare_boot_head_t *bfh = (struct spare_boot_head_t *)para_addr;
|
||
toc0_private_head_t *toc0 = (toc0_private_head_t *)CONFIG_SBROMSW_BASE;
|
||
int boot_type = toc0->platform[0];
|
||
uint dram_size;
|
||
|
||
|
||
if(!boot_type)
|
||
{
|
||
boot_type = 1;
|
||
}
|
||
else if(boot_type == 1)
|
||
{
|
||
boot_type = 0;
|
||
}else if(boot_type == 2){
|
||
//char storage_data[384]; // 0-159,存储nand信息；160-255,存放卡信息^M
|
||
set_mmc_para(2,(void *)(toc0_config->storage_data+160));
|
||
}
|
||
|
||
printf("storage_type=%d\n", boot_type);
|
||
bfh->boot_data.storage_type = boot_type;
|
||
if(out_secure == SECURE_SWITCH_NORMAL)
|
||
{
|
||
bfh->boot_data.secureos_exist = 1;
|
||
sunxi_spc_set_to_ns(0);
|
||
}
|
||
dram_size = toc0_config->dram_para[4] & 0xffff;
|
||
if(out_secure == SECURE_SWITCH_NORMAL)
|
||
{
|
||
printf("dram =%d M, reserved size = %d M\n", dram_size, toc0_config->secure_dram_mbytes);
|
||
sunxi_smc_config(dram_size, toc0_config->secure_dram_mbytes);
|
||
printf("switch to ns\n");
|
||
memcpy(bfh->boot_data.dram_para, toc0_config->dram_para, 32 * 4);
|
||
bfh->boot_data.dram_para[4] -= toc0_config->secure_dram_mbytes;
|
||
}
|
||
else
|
||
{
|
||
printf("still in secure world \n");
|
||
printf("dram = %d M \n",dram_size);
|
||
bfh->boot_data.secureos_exist = 0;
|
||
memcpy(bfh->boot_data.dram_para, toc0_config->dram_para, 32 * 4);
|
||
}
|
||
asm volatile("ldmfd sp!, {r0, r1}");
|
||
//if(out_secure == SECURE_SWITCH_NORMAL)
|
||
//asm volatile("bx %0"::"r" (secure_switch_unsecure));
|
||
// else
|
||
asm volatile("blx %0"::"r" (secure_switch_other));
|
||
}
|
||
else
|
||
{
|
||
boot0_jmp_monitor(run_addr);
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
static void boot0_jmp_monitor(unsigned int addr)
|
||
{
|
||
// jmp to AA64
|
||
//set the cpu boot entry addr:
|
||
writel(addr,RVBARADDR0_L);
|
||
writel(0,RVBARADDR0_H);
|
||
|
||
//*(volatile unsigned int*)0x40080000 =0x14000000; //
|
||
//note: warm reset to 0x40080000 when run on fpga,
|
||
//*(volatile unsigned int*)0x40080000 =0xd61f0060; //hard code: br x3
|
||
//asm volatile("ldr r3, =(0x7e000000)"); //set r3
|
||
|
||
//asm volatile("ldr r0, =(0x7f000200)");
|
||
//asm volatile("ldr r1, =(0x12345678)");
|
||
|
||
//set cpu to AA64 execution state when the cpu boots into after a warm reset
|
||
asm volatile("MRC p15,0,r2,c12,c0,2");
|
||
asm volatile("ORR r2,r2,#(0x3<<0)");
|
||
asm volatile("DSB");
|
||
asm volatile("MCR p15,0,r2,c12,c0,2");
|
||
asm volatile("ISB");
|
||
__LOOP:
|
||
asm volatile("WFI");
|
||
goto __LOOP;
|
||
|
||
}
|