arch/arm/mach-meson/board-common.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2016 Beniamino Galvani <[email protected]>
   4  */
   5
   6 #include <common.h>
   7 #include <cpu_func.h>
   8 #include <init.h>
   9 #include <net.h>
  10 #include <asm/arch/boot.h>
  11 #include <env.h>
  12 #include <asm/cache.h>
  13 #include <linux/libfdt.h>
  14 #include <linux/err.h>
  15 #include <asm/arch/mem.h>
  16 #include <asm/arch/sm.h>
  17 #include <asm/armv8/mmu.h>
  18 #include <asm/unaligned.h>
  19 #include <efi_loader.h>
  20 #include <u-boot/crc.h>
  21
  22 #if CONFIG_IS_ENABLED(FASTBOOT)
  23 #include <asm/psci.h>
  24 #include <fastboot.h>
  25 #endif
  26
  27 DECLARE_GLOBAL_DATA_PTR;
  28
  29 __weak int board_init(void)
  30 {
  31         return 0;
  32 }
  33
  34 int dram_init(void)
  35 {
  36         const fdt64_t *val;
  37         int offset;
  38         int len;
  39
  40         offset = fdt_path_offset(gd->fdt_blob, "/memory");
  41         if (offset < 0)
  42                 return -EINVAL;
  43
  44         val = fdt_getprop(gd->fdt_blob, offset, "reg", &len);
  45         if (len < sizeof(*val) * 2)
  46                 return -EINVAL;
  47
  48         /* Use unaligned access since cache is still disabled */
  49         gd->ram_size = get_unaligned_be64(&val[1]);
  50
  51         return 0;
  52 }
  53
  54 __weak int meson_ft_board_setup(void *blob, bd_t *bd)
  55 {
  56         return 0;
  57 }
  58
  59 int ft_board_setup(void *blob, bd_t *bd)
  60 {
  61         meson_init_reserved_memory(blob);
  62
  63         return meson_ft_board_setup(blob, bd);
  64 }
  65
  66 void meson_board_add_reserved_memory(void *fdt, u64 start, u64 size)
  67 {
  68         int ret;
  69
  70         ret = fdt_add_mem_rsv(fdt, start, size);
  71         if (ret)
  72                 printf("Could not reserve zone @ 0x%llx\n", start);
  73
  74         if (IS_ENABLED(CONFIG_EFI_LOADER))
  75                 efi_add_memory_map(start, size, EFI_RESERVED_MEMORY_TYPE);
  76 }
  77
  78 int meson_generate_serial_ethaddr(void)
  79 {
  80         u8 mac_addr[ARP_HLEN];
  81         char serial[SM_SERIAL_SIZE];
  82         u32 sid;
  83         u16 sid16;
  84
  85         if (!meson_sm_get_serial(serial, SM_SERIAL_SIZE)) {
  86                 sid = crc32(0, (unsigned char *)serial, SM_SERIAL_SIZE);
  87                 sid16 = crc16_ccitt(0, (unsigned char *)serial, SM_SERIAL_SIZE);
  88
  89                 /* Ensure the NIC specific bytes of the mac are not all 0 */
  90                 if ((sid & 0xffffff) == 0)
  91                         sid |= 0x800000;
  92
  93                 /* Non OUI / registered MAC address */
  94                 mac_addr[0] = ((sid16 >> 8) & 0xfc) | 0x02;
  95                 mac_addr[1] = (sid16 >>  0) & 0xff;
  96                 mac_addr[2] = (sid >> 24) & 0xff;
  97                 mac_addr[3] = (sid >> 16) & 0xff;
  98                 mac_addr[4] = (sid >>  8) & 0xff;
  99                 mac_addr[5] = (sid >>  0) & 0xff;
 100
 101                 eth_env_set_enetaddr("ethaddr", mac_addr);
 102         } else
 103                 return -EINVAL;
 104
 105         return 0;
 106 }
 107
 108 static void meson_set_boot_source(void)
 109 {
 110         const char *source;
 111
 112         switch (meson_get_boot_device()) {
 113         case BOOT_DEVICE_EMMC:
 114                 source = "emmc";
 115                 break;
 116
 117         case BOOT_DEVICE_NAND:
 118                 source = "nand";
 119                 break;
 120
 121         case BOOT_DEVICE_SPI:
 122                 source = "spi";
 123                 break;
 124
 125         case BOOT_DEVICE_SD:
 126                 source = "sd";
 127                 break;
 128
 129         case BOOT_DEVICE_USB:
 130                 source = "usb";
 131                 break;
 132
 133         default:
 134                 source = "unknown";
 135         }
 136
 137         env_set("boot_source", source);
 138 }
 139
 140 __weak int meson_board_late_init(void)
 141 {
 142         return 0;
 143 }
 144
 145 int board_late_init(void)
 146 {
 147         meson_set_boot_source();
 148
 149         return meson_board_late_init();
 150 }
 151
 152 #if CONFIG_IS_ENABLED(FASTBOOT)
 153 static unsigned int reboot_reason = REBOOT_REASON_NORMAL;
 154
 155 int fastboot_set_reboot_flag()
 156 {
 157         reboot_reason = REBOOT_REASON_BOOTLOADER;
 158
 159         printf("Using reboot reason: 0x%x\n", reboot_reason);
 160
 161         return 0;
 162 }
 163
 164 void reset_cpu(ulong addr)
 165 {
 166         struct pt_regs regs;
 167
 168         regs.regs[0] = ARM_PSCI_0_2_FN_SYSTEM_RESET;
 169         regs.regs[1] = reboot_reason;
 170
 171         printf("Rebooting with reason: 0x%lx\n", regs.regs[1]);
 172
 173         smc_call(&regs);
 174
 175         while (1)
 176                 ;
 177 }
 178 #else
 179 void reset_cpu(ulong addr)
 180 {
 181         psci_system_reset();
 182 }
 183 #endif