190 lines
3.5 KiB
C
190 lines
3.5 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* (C) Copyright 2016 Beniamino Galvani <b.galvani@gmail.com>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <cpu_func.h>
|
|
#include <fastboot.h>
|
|
#include <init.h>
|
|
#include <net.h>
|
|
#include <asm/arch/boot.h>
|
|
#include <env.h>
|
|
#include <asm/cache.h>
|
|
#include <asm/global_data.h>
|
|
#include <asm/ptrace.h>
|
|
#include <linux/libfdt.h>
|
|
#include <linux/err.h>
|
|
#include <asm/arch/mem.h>
|
|
#include <asm/arch/sm.h>
|
|
#include <asm/armv8/mmu.h>
|
|
#include <asm/unaligned.h>
|
|
#include <efi_loader.h>
|
|
#include <u-boot/crc.h>
|
|
|
|
#if CONFIG_IS_ENABLED(FASTBOOT)
|
|
#include <asm/psci.h>
|
|
#include <fastboot.h>
|
|
#endif
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
__weak int board_init(void)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
int dram_init(void)
|
|
{
|
|
const fdt64_t *val;
|
|
int offset;
|
|
int len;
|
|
|
|
offset = fdt_path_offset(gd->fdt_blob, "/memory");
|
|
if (offset < 0)
|
|
return -EINVAL;
|
|
|
|
val = fdt_getprop(gd->fdt_blob, offset, "reg", &len);
|
|
if (len < sizeof(*val) * 2)
|
|
return -EINVAL;
|
|
|
|
/* Use unaligned access since cache is still disabled */
|
|
gd->ram_size = get_unaligned_be64(&val[1]);
|
|
|
|
return 0;
|
|
}
|
|
|
|
__weak int meson_ft_board_setup(void *blob, struct bd_info *bd)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
int ft_board_setup(void *blob, struct bd_info *bd)
|
|
{
|
|
meson_init_reserved_memory(blob);
|
|
|
|
return meson_ft_board_setup(blob, bd);
|
|
}
|
|
|
|
void meson_board_add_reserved_memory(void *fdt, u64 start, u64 size)
|
|
{
|
|
int ret;
|
|
|
|
ret = fdt_add_mem_rsv(fdt, start, size);
|
|
if (ret)
|
|
printf("Could not reserve zone @ 0x%llx\n", start);
|
|
|
|
if (IS_ENABLED(CONFIG_EFI_LOADER))
|
|
efi_add_memory_map(start, size, EFI_RESERVED_MEMORY_TYPE);
|
|
}
|
|
|
|
int meson_generate_serial_ethaddr(void)
|
|
{
|
|
u8 mac_addr[ARP_HLEN];
|
|
char serial[SM_SERIAL_SIZE];
|
|
u32 sid;
|
|
u16 sid16;
|
|
|
|
if (!meson_sm_get_serial(serial, SM_SERIAL_SIZE)) {
|
|
sid = crc32(0, (unsigned char *)serial, SM_SERIAL_SIZE);
|
|
sid16 = crc16_ccitt(0, (unsigned char *)serial, SM_SERIAL_SIZE);
|
|
|
|
/* Ensure the NIC specific bytes of the mac are not all 0 */
|
|
if ((sid & 0xffffff) == 0)
|
|
sid |= 0x800000;
|
|
|
|
/* Non OUI / registered MAC address */
|
|
mac_addr[0] = ((sid16 >> 8) & 0xfc) | 0x02;
|
|
mac_addr[1] = (sid16 >> 0) & 0xff;
|
|
mac_addr[2] = (sid >> 24) & 0xff;
|
|
mac_addr[3] = (sid >> 16) & 0xff;
|
|
mac_addr[4] = (sid >> 8) & 0xff;
|
|
mac_addr[5] = (sid >> 0) & 0xff;
|
|
|
|
eth_env_set_enetaddr("ethaddr", mac_addr);
|
|
} else
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void meson_set_boot_source(void)
|
|
{
|
|
const char *source;
|
|
|
|
switch (meson_get_boot_device()) {
|
|
case BOOT_DEVICE_EMMC:
|
|
source = "emmc";
|
|
break;
|
|
|
|
case BOOT_DEVICE_NAND:
|
|
source = "nand";
|
|
break;
|
|
|
|
case BOOT_DEVICE_SPI:
|
|
source = "spi";
|
|
break;
|
|
|
|
case BOOT_DEVICE_SD:
|
|
source = "sd";
|
|
break;
|
|
|
|
case BOOT_DEVICE_USB:
|
|
source = "usb";
|
|
break;
|
|
|
|
default:
|
|
source = "unknown";
|
|
}
|
|
|
|
env_set("boot_source", source);
|
|
}
|
|
|
|
__weak int meson_board_late_init(void)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
int board_late_init(void)
|
|
{
|
|
meson_set_boot_source();
|
|
|
|
return meson_board_late_init();
|
|
}
|
|
|
|
#if CONFIG_IS_ENABLED(FASTBOOT)
|
|
static unsigned int reboot_reason = REBOOT_REASON_NORMAL;
|
|
|
|
int fastboot_set_reboot_flag(enum fastboot_reboot_reason reason)
|
|
{
|
|
if (reason != FASTBOOT_REBOOT_REASON_BOOTLOADER)
|
|
return -ENOTSUPP;
|
|
|
|
reboot_reason = REBOOT_REASON_BOOTLOADER;
|
|
|
|
printf("Using reboot reason: 0x%x\n", reboot_reason);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void reset_cpu(ulong addr)
|
|
{
|
|
struct pt_regs regs;
|
|
|
|
regs.regs[0] = ARM_PSCI_0_2_FN_SYSTEM_RESET;
|
|
regs.regs[1] = reboot_reason;
|
|
|
|
printf("Rebooting with reason: 0x%lx\n", regs.regs[1]);
|
|
|
|
smc_call(®s);
|
|
|
|
while (1)
|
|
;
|
|
}
|
|
#else
|
|
void reset_cpu(ulong addr)
|
|
{
|
|
psci_system_reset();
|
|
}
|
|
#endif
|