u-boot-megous/common/board_r.c

/*
 * Copyright (c) 2011 The Chromium OS Authors.
 * (C) Copyright 2002-2006
 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 *
 * (C) Copyright 2002
 * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
 * Marius Groeger <mgroeger@sysgo.de>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
/* TODO: can we just include all these headers whether needed or not? */
#if defined(CONFIG_CMD_BEDBUG)
#include <bedbug/type.h>
#endif
#ifdef CONFIG_HAS_DATAFLASH
#include <dataflash.h>
#endif
#include <dm.h>
#include <environment.h>
#include <fdtdec.h>
#if defined(CONFIG_CMD_IDE)
#include <ide.h>
#endif
#include <initcall.h>
#ifdef CONFIG_PS2KBD
#include <keyboard.h>
#endif
#if defined(CONFIG_CMD_KGDB)
#include <kgdb.h>
#endif
#include <logbuff.h>
#include <malloc.h>
#ifdef CONFIG_BITBANGMII
#include <miiphy.h>
#endif
#include <mmc.h>
#include <nand.h>
#include <onenand_uboot.h>
#include <scsi.h>
#include <serial.h>
#include <spi.h>
#include <stdio_dev.h>
#include <trace.h>
#include <watchdog.h>
#ifdef CONFIG_ADDR_MAP
#include <asm/mmu.h>
#endif
#include <asm/sections.h>
#ifdef CONFIG_X86
#include <asm/init_helpers.h>
#endif
#include <dm/root.h>
#include <linux/compiler.h>
#include <linux/err.h>
#include <fdt_support.h>

#if defined(CONFIG_ALLWINNER)
#include <private_uboot.h>
#include <sunxi_board.h>
#include <sys_partition.h>
#include <sys_config.h>
#include <sys_config_old.h>
#include <smc.h>
#include <securestorage.h>
#include <arisc.h>

#if defined(CONFIG_BOOT_PARAMETER)
#include <sunxi_bootparam.h>
#endif

#ifdef CONFIG_SUNXI_MULITCORE_BOOT
#include <asm/arch/platsmp.h>
#include <cputask.h>
#endif
#endif
#include "sunxi_bmp.h"

DECLARE_GLOBAL_DATA_PTR;

ulong monitor_flash_len;

unsigned long secondary_cpu_data_groups[4] __attribute__((section(".data")));
unsigned long secondary_cpu_mode_stack[4] __attribute__((section(".data")));



int __attribute__((weak)) get_disp_para_mode(void)
{
	return -1;
}

int __board_flash_wp_on(void)
{
	/*
	 * Most flashes can't be detected when write protection is enabled,
	 * so provide a way to let U-Boot gracefully ignore write protected
	 * devices.
	 */
	return 0;
}

int board_flash_wp_on(void)
	__attribute__ ((weak, alias("__board_flash_wp_on")));

#ifdef CONFIG_SUNXI_DISPLAY
int initr_sunxi_display(void);
#endif

#ifdef CONFIG_SUNXI_MULITCORE_BOOT

__attribute__((section(".data")))
uint * p_spin_lock_uart = NULL;

__attribute__((section(".data")))
uint * p_spin_lock_heap = NULL;

__attribute__((section(".data")))
volatile int flash_init_flag;

static inline void set_sunxi_flash_init_flag(void)
{
	flash_init_flag = 1;
}
static inline int get_sunxi_flash_init_flag(void)
{
	return flash_init_flag;
}

uint * request_spin_lock(void)
{
	uint *p_spin_lock = NULL;
	p_spin_lock = malloc_noncache(4);
	if(p_spin_lock == NULL)
	{
		return NULL;
	}
	*p_spin_lock = 0;
	return p_spin_lock;
}

void cpu_secondary_init_r(void)
{
	secondary_cpu_data_groups[0] = gd->arch.tlb_addr;
	secondary_cpu_data_groups[1] = (unsigned long)gd;

	secondary_cpu_mode_stack[0] = gd->secondary_cpu_svc_sp[1];	//cpu1 svc sp
	secondary_cpu_mode_stack[1] = gd->secondary_cpu_irq_sp[1];  //cpu1 irq sp
	secondary_cpu_mode_stack[2] = gd->secondary_cpu_svc_sp[2];  //cpu2 svc sp

	flush_cache((long unsigned int)secondary_cpu_data_groups, 16);
	flush_cache((long unsigned int)secondary_cpu_mode_stack, 16);

	p_spin_lock_uart = request_spin_lock();
	if(p_spin_lock_uart == NULL)
	{
		printf("error:p_spin_lock_uart is NULL: %s %d\n",__func__,__LINE__);
		return;
	}
	p_spin_lock_heap = request_spin_lock();
	if(p_spin_lock_heap == NULL)
	{
		printf("error:p_spin_lock_heap is NULL: %s %d\n",__func__,__LINE__);
		return;
	}

	asm volatile("isb");
	asm volatile("dmb");

	tick_printf("power on cpu1\n");
	sunxi_set_cpu_on(1,(uint)secondary_cpu_start);
	udelay(10000);
	tick_printf("power on cpu2\n");
	sunxi_set_cpu_on(2, (uint)third_cpu_start);
}

static int initr_secondary_cpu(void)
{
	/*
	 * after non-volatile devices & environment is setup and cpu code have
	 * another round to deal with any initialization that might require
	 * full access to the environment or loading of some image (firmware)
	 * from a non-volatile device
	 */
	/* TODO: maybe define this for all archs? */
	gd->logo_status_multiboot=IDLE_STATUS;
	if (uboot_spare_head.boot_data.work_mode != WORK_MODE_BOOT)
	{
		initr_sunxi_display();
		return 0;
	}
	cpu_secondary_init_r();

	return 0;
}
#endif

static int initr_trace(void)
{
#ifdef CONFIG_TRACE
	trace_init(gd->trace_buff, CONFIG_TRACE_BUFFER_SIZE);
#endif

	return 0;
}

static int initr_reloc(void)
{
	set_working_fdt_addr((void*)gd->fdt_blob);

	gd->flags |= GD_FLG_RELOC;	/* tell others: relocation done */
	bootstage_mark_name(BOOTSTAGE_ID_START_UBOOT_R, "board_init_r");
	return 0;
}

#ifdef CONFIG_ARM
/*
 * Some of these functions are needed purely because the functions they
 * call return void. If we change them to return 0, these stubs can go away.
 */
static int initr_caches(void)
{
	/* Enable caches */
	enable_caches();
	return 0;
}
#endif

__weak int fixup_cpu(void)
{
	return 0;
}

static int initr_reloc_global_data(void)
{
#ifdef __ARM__

	//ulong head_align_size = get_spare_head_size();
	monitor_flash_len = _end - __image_copy_start;// + head_align_size;

#elif !defined(CONFIG_SANDBOX)
	monitor_flash_len = (ulong)&__init_end - gd->relocaddr;
#endif
#if defined(CONFIG_MPC85xx) || defined(CONFIG_MPC86xx)
	/*
	 * The gd->cpu pointer is set to an address in flash before relocation.
	 * We need to update it to point to the same CPU entry in RAM.
	 * TODO: why not just add gd->reloc_ofs?
	 */
	gd->arch.cpu += gd->relocaddr - CONFIG_SYS_MONITOR_BASE;

	/*
	 * If we didn't know the cpu mask & # cores, we can save them of
	 * now rather than 'computing' them constantly
	 */
	fixup_cpu();
#endif
#ifdef CONFIG_SYS_EXTRA_ENV_RELOC
	/*
	 * Some systems need to relocate the env_addr pointer early because the
	 * location it points to will get invalidated before env_relocate is
	 * called.  One example is on systems that might use a L2 or L3 cache
	 * in SRAM mode and initialize that cache from SRAM mode back to being
	 * a cache in cpu_init_r.
	 */
	gd->env_addr += gd->relocaddr - CONFIG_SYS_MONITOR_BASE;
#endif
	return 0;
}

static int initr_serial(void)
{
	serial_initialize();
	return 0;
}

#ifdef CONFIG_AUTO_UPDATE
extern int auto_update_check(void);
#endif
extern int sunxi_widevine_keybox_install(void);
extern void mem_noncache_malloc_init(uint noncache_start, uint noncache_size);
static int initr_malloc(void)
{
	ulong malloc_start;

	malloc_start = gd->relocaddr - TOTAL_MALLOC_LEN;
	mem_malloc_init((ulong)map_sysmem(malloc_start, TOTAL_MALLOC_LEN),
			TOTAL_MALLOC_LEN);
	debug("malloc start addr is %lx, size %dk \n",malloc_start,TOTAL_MALLOC_LEN>>10 );

#ifdef  CONFIG_NONCACHE_MEMORY
{
	mem_noncache_malloc_init(gd->malloc_noncache_start, CONFIG_NONCACHE_MEMORY_SIZE);
	debug("no cache malloc start addr is %lx, size %dk \n",gd->malloc_noncache_start,TOTAL_MALLOC_LEN>>10 );
}
#endif

	return 0;
}

__weak int power_init_board(void)
{
#ifdef CONFIG_SUNXI_AXP
	extern int axp_reinit(void);
	axp_reinit();
#endif
	return 0;
}

static int initr_announce(void)
{
	debug("Now running in RAM - U-Boot at: %08lx\n", gd->relocaddr);
	return 0;
}



#ifdef CONFIG_GENERIC_MMC
int initr_mmc(void)
{
	puts("MMC:   ");
	mmc_initialize(gd->bd);
	return 0;
}
#endif


/*
 * Tell if it's OK to load the environment early in boot.
 *
 * If CONFIG_OF_CONFIG is defined, we'll check with the FDT to see
 * if this is OK (defaulting to saying it's OK).
 *
 * NOTE: Loading the environment early can be a bad idea if security is
 *       important, since no verification is done on the environment.
 *
 * @return 0 if environment should not be loaded, !=0 if it is ok to load
 */
static int should_load_env(void)
{
#ifdef CONFIG_OF_CONTROL
	return fdtdec_get_config_int(gd->fdt_blob, "load-environment", 1);
#elif defined CONFIG_DELAY_ENVIRONMENT
	return 0;
#else
	return 1;
#endif
}

static int initr_env(void)
{
	/* initialize environment */
	if (should_load_env())
		env_relocate();
	else
		set_default_env(NULL);

	/* Initialize from environment */
	load_addr = getenv_ulong("loadaddr", 16, load_addr);
	return 0;
}

static int initr_jumptable(void)
{
	jumptable_init();
	return 0;
}


/* enable exceptions */
#ifdef CONFIG_ARM
static int initr_enable_interrupts(void)
{
	enable_interrupts();
	return 0;
}
#endif


static int run_main_loop(void)
{
	pr_msg("inter uboot shell\n");
	/* main_loop() can return to retry autoboot, if so just run it again */
	for (;;)
		main_loop();
	return 0;
}

extern int script_init(void);
extern int parameter_init(void);
extern int PowerCheck(void);
extern int sunxi_keydata_burn_by_usb(void);
#if defined(CONFIG_BOX_STANDBY)
extern int do_box_standby(void);
#endif
extern int detect_part_back_work(void);

static int initr_sunxi_base(void)
{
	board_late_init();
	return 0;
}

static int detect_part_back_work_base(void)
{
#ifdef CONFIG_BACKUP_PARTITION
	detect_part_back_work();
#endif
	return 0;
}

static int sunxi_burn_key(void)
{
	pr_msg("try to burn key\n");
#ifdef CONFIG_SUNXI_KEY_BURN
	sunxi_keydata_burn_by_usb();
#endif
	return 0;
}

#ifdef CONFIG_SUNXI_MULITCORE_BOOT
static int sunxi_load_logo_multiboot(void)
{
	int ret,advert_enable;
	if(uboot_spare_head.boot_data.work_mode != WORK_MODE_BOOT)
	{
		return 0;
	}
	ret = script_parser_fetch("target", "advert_enable", (int *)&advert_enable, sizeof(int) / 4);
	if(ret || !advert_enable)
		return 0;
    while(gd->logo_status_multiboot == IDLE_STATUS);
	printf("cpu1 disp init ok\n");
#ifdef CONFIG_BOOT_GUI
	ret=sunxi_bmp_load("bootlogo.bmp");
        if(!ret)
        {
            gd->logo_status_multiboot = DISPLAY_LOGO_LOAD_OK;
        }
        else
        {
            gd->logo_status_multiboot = DISPLAY_LOGO_LOAD_FAIL;
        }
#endif
	return 0;
}
#endif

#ifdef  CONFIG_SUNXI_DISPLAY
extern int sunxi_hdcp_keybox_install(void);

#ifdef CONFIG_SUNXI_HDCP_IN_SECURESTORAGE
static int display_for_hdcp (void)
{
        if(uboot_spare_head.boot_data.work_mode != WORK_MODE_BOOT)
        {
                return 0;
        }

	int hdcpkey_enable=0;
	int ret = 0;
	sunxi_secure_storage_info_t secure_object;

	ret = script_parser_fetch("hdmi", "hdmi_hdcp_enable", &hdcpkey_enable, 1);
	if((ret) || (hdcpkey_enable != 1))
	{
		printf("hdmi hdcp not enable!\n");
		return 0;
	}

	memset(&secure_object, 0, sizeof(secure_object));

#ifdef CONFIG_SUNXI_MULITCORE_BOOT
	while (!get_sunxi_flash_init_flag());
#endif
	ret = sunxi_secure_storage_init();
	if(ret)
	{
		printf("sunxi init secure storage failed\n");
		return -1;
	}

	ret = sunxi_secure_object_up("hdcpkey",(void*)&secure_object,sizeof(secure_object));
	if(ret)
	{
		printf("probe hdcp key failed\n");
		return -1;
	}

#if 0
        printf("***** hdcpdata:\n");
        sunxi_dump(secure_object.key_data, 288);
#endif

	ret = smc_tee_keybox_store("hdcpkey", (void*)&secure_object, sizeof(secure_object));
	if (ret) {
		printf("ssk encrypt failed\n");

		return -1;
	}

	ret = smc_aes_rssk_decrypt_to_keysram();
	if(ret)
	{
		printf("push hdcp key failed\n");
		return -1;
	}

	printf("push hdcp key finish!\n");
	return 0;
}
#endif

int initr_sunxi_display(void)
{

	int workmode = uboot_spare_head.boot_data.work_mode;
	if(!((workmode == WORK_MODE_BOOT) ||
		(workmode == WORK_MODE_CARD_PRODUCT) ||
		(workmode == WORK_MODE_SPRITE_RECOVERY)))
	{
		return 0;
	}

	if(get_disp_para_mode())
		return 0;

	tick_printf("start\n");
	drv_disp_init();

#ifndef CONFIG_ARCH_HOMELET
	#ifdef CONFIG_SUNXI_HDCP_IN_SECURESTORAGE
	display_for_hdcp();
	#endif

	#ifndef CONFIG_BOOT_GUI
	board_display_device_open();
	board_display_layer_request();
	#else
	disp_devices_open();
	fb_init();
	#endif
#else
	#ifdef CONFIG_SUNXI_HDCP_IN_SECURESTORAGE
	display_for_hdcp();
	#endif

	#ifndef CONFIG_BOOT_GUI
	board_display_device_open();
	board_display_layer_request();
	#else
	disp_devices_open();
	fb_init();
	#endif

#endif
	tick_printf("end\n");
	return 0;
}
#ifndef CONFIG_SUNXI_MULITCORE_BOOT
static int initr_sunxi_display_ex(void)
{

	int workmode = uboot_spare_head.boot_data.work_mode;
	if(!((workmode == WORK_MODE_BOOT) ||
		(workmode == WORK_MODE_CARD_PRODUCT) ||
		(workmode == WORK_MODE_SPRITE_RECOVERY)))
	{
		return 0;
	}

	if(!get_disp_para_mode())
		return 0;

	pr_msg("display init start\n");
	drv_disp_init();

#ifndef CONFIG_ARCH_HOMELET
	#ifdef CONFIG_SUNXI_HDCP_IN_SECURESTORAGE
	display_for_hdcp();
	#else
	#ifndef CONFIG_BOOT_GUI
	board_display_device_open();
	board_display_layer_request();
	#else
	disp_devices_open();
	fb_init();
	#endif
	#endif
#else
	#ifdef CONFIG_SUNXI_HDCP_IN_SECURESTORAGE
        display_for_hdcp();
	#endif

	#ifndef CONFIG_BOOT_GUI
	board_display_device_open();
	board_display_layer_request();
	#else
	disp_devices_open();
	fb_init();
	#endif

#endif
	pr_msg("display init end\n");
	return 0;
}
#endif
#endif

extern int sunxi_led_init(void);
extern int sunxi_led_exit(int status);

static int initr_sunxi_flash(void)
{
	int ret = 0;

	ret = sunxi_flash_handle_init();
	if(!ret)
	{
#ifdef CONFIG_SUNXI_UBIFS
		sunxi_nand_mtd_init();
#endif
		sunxi_partition_init();
	}

        sunxi_led_exit(ret);
#ifdef CONFIG_SUNXI_MULITCORE_BOOT
	set_sunxi_flash_init_flag();
#endif

	return ret;

}
static int platform_dma_init(void)
{
#ifdef CONFIG_SUNXI_DMA
	extern void sunxi_dma_init(void);
	sunxi_dma_init();
#endif
	return 0;
}
static int usb_net_init(void)
{
#if defined(CONFIG_CMD_NET)
	puts("Net:   ");
	eth_initialize(gd->bd);
#if defined(CONFIG_RESET_PHY_R)
	debug("Reset Ethernet PHY\n");
	reset_phy();
#endif
#endif
	return 0;
}
__weak int show_platform_info(void)
{
	return 0;
}

/*
 * Over time we hope to remove these functions with code fragments and
 * stub funtcions, and instead call the relevant function directly.
 *
 * We also hope to remove most of the driver-related init and do it if/when
 * the driver is later used.
 *
 * TODO: perhaps reset the watchdog in the initcall function after each call?
 */
init_fnc_t init_sequence_r[] = {
	initr_trace,
	initr_reloc,
	initr_serial,
	/* TODO: could x86/PPC have this also perhaps? */
#ifdef CONFIG_ARM
	initr_caches,
	board_init,	/* Setup chipselects */
#endif
	/*
	 * TODO: printing of the clock inforamtion of the board is now
	 * implemented as part of bdinfo command. Currently only support for
	 * davinci SOC's is added. Remove this check once all the board
	 * implement this.
	 */
	initr_reloc_global_data,
	initr_announce,
	show_platform_info,
	initr_malloc,
	script_init,
	parameter_init,
	bootstage_relocate,
	power_init_board,
	stdio_init,
	initr_jumptable,
	console_init_r,		/* fully init console as a device */
	interrupt_init,

#if defined(CONFIG_BOX_STANDBY)
	do_box_standby,
#endif

        //will not use multi core when sprite mode(onekey recovery,etc)
	check_physical_key_early, //call the func here for check sprite mode

#ifdef CONFIG_SUNXI_MULITCORE_BOOT
	initr_secondary_cpu,
#endif

#if defined(CONFIG_ARM) || defined(CONFIG_x86)
	initr_enable_interrupts,
#endif
#ifdef CONFIG_SUNXI
	platform_dma_init,
	sunxi_led_init,
#ifdef CONFIG_SUNXI_HDCP_IN_SECURESTORAGE
	initr_sunxi_flash,
#endif


#if defined(CONFIG_SUNXI_DISPLAY)
#ifndef CONFIG_SUNXI_MULITCORE_BOOT
	initr_sunxi_display,
#endif
#endif
//	sunxi_led_init,
//	check_physical_key_early, //call the func here for check sprite mode
#ifndef CONFIG_SUNXI_HDCP_IN_SECURESTORAGE
	initr_sunxi_flash,
#endif
	sunxi_burn_key,
#if defined(CONFIG_SUNXI_DISPLAY)
#ifndef CONFIG_SUNXI_MULITCORE_BOOT
	initr_sunxi_display_ex,
#endif
#endif

#ifdef CONFIG_SUNXI_MULITCORE_BOOT
	sunxi_load_logo_multiboot,
#endif

#ifdef CONFIG_AUTO_UPDATE
	auto_update_check,
#endif
	initr_env,
	detect_part_back_work_base,
	initr_sunxi_base,

#ifdef CONFIG_WIDEVINE_KEY_INSTALL
	sunxi_widevine_keybox_install,
#endif

#ifndef CONFIG_SUNXI_MULITCORE_BOOT
	PowerCheck,
#endif
#endif
	usb_net_init,
	run_main_loop,
};

extern ulong _reset_vec;
extern ulong _undefined_instruction;
extern ulong _software_interrupt;
extern ulong _prefetch_abort;
extern ulong _data_abort;
extern ulong _not_used;
extern ulong _irq;
extern ulong _fiq;

#ifndef CONFIG_ARM64
#ifdef CONFIG_USE_IRQ
void intr_vector_fix(void)
{
	int i = 0;
	ulong * vec_array[8] = {0};
	vec_array[i++] = &_reset_vec;
	vec_array[i++] = &_undefined_instruction;
	vec_array[i++] = &_software_interrupt;
	vec_array[i++] = &_prefetch_abort;
	vec_array[i++] = &_data_abort;
	vec_array[i++] = &_not_used;
	vec_array[i++] = &_irq;
	vec_array[i++] = &_fiq;

	for(i =0; i < 8; i++)
	{
		debug("before fix: vector %d, addr %lx ,value 0x%lx\n", i ,(ulong)vec_array[i], *(vec_array[i]));
		*(vec_array[i]) +=  (gd->reloc_off);
		debug("after  fix: vector %d, addr %lx ,value 0x%lx\n", i ,(ulong)vec_array[i], *(vec_array[i]));
	}
}
#endif
#endif

void board_init_r(gd_t *new_gd, ulong dest_addr)
{

#ifdef CONFIG_NEEDS_MANUAL_RELOC
	int i;
#endif

#ifndef CONFIG_X86
	gd = new_gd;
#endif

#ifdef CONFIG_NEEDS_MANUAL_RELOC
	for (i = 0; i < ARRAY_SIZE(init_sequence_r); i++)
		init_sequence_r[i] += gd->reloc_off;
#endif

#ifndef CONFIG_ARM64
#ifdef CONFIG_USE_IRQ
	intr_vector_fix();
#endif
#endif
	if (initcall_run_list(init_sequence_r))
		hang();

	/* NOTREACHED - run_main_loop() does not return */
	hang();
}