1 /* 2 * (C) Copyright 2017 Rockchip Electronics Co., Ltd. 3 * 4 * SPDX-License-Identifier: GPL-2.0+ 5 */ 6 7 #include <common.h> 8 #include <amp.h> 9 #include <android_ab.h> 10 #include <android_bootloader.h> 11 #include <android_image.h> 12 #include <bidram.h> 13 #include <boot_rkimg.h> 14 #include <cli.h> 15 #include <clk.h> 16 #include <console.h> 17 #include <debug_uart.h> 18 #include <dm.h> 19 #include <dvfs.h> 20 #include <fdt_support.h> 21 #include <io-domain.h> 22 #include <image.h> 23 #include <key.h> 24 #include <memblk.h> 25 #include <misc.h> 26 #include <of_live.h> 27 #include <mtd_blk.h> 28 #include <ram.h> 29 #include <rockchip_debugger.h> 30 #include <syscon.h> 31 #include <sysmem.h> 32 #include <video_rockchip.h> 33 #include <xbc.h> 34 #include <asm/io.h> 35 #include <asm/gpio.h> 36 #include <android_avb/rk_avb_ops_user.h> 37 #include <dm/uclass-internal.h> 38 #include <dm/root.h> 39 #include <power/charge_display.h> 40 #include <power/regulator.h> 41 #include <optee_include/OpteeClientInterface.h> 42 #include <optee_include/OpteeClientApiLib.h> 43 #include <optee_include/tee_api_defines.h> 44 #include <asm/arch/boot_mode.h> 45 #include <asm/arch/clock.h> 46 #include <asm/arch/cpu.h> 47 #include <asm/arch/hotkey.h> 48 #include <asm/arch/param.h> 49 #include <asm/arch/periph.h> 50 #include <asm/arch/resource_img.h> 51 #include <asm/arch/rk_atags.h> 52 #include <asm/arch/vendor.h> 53 #ifdef CONFIG_ROCKCHIP_EINK_DISPLAY 54 #include <rk_eink.h> 55 #endif 56 57 DECLARE_GLOBAL_DATA_PTR; 58 59 __weak int rk_board_late_init(void) 60 { 61 return 0; 62 } 63 64 __weak int rk_board_fdt_fixup(void *blob) 65 { 66 return 0; 67 } 68 69 __weak int soc_clk_dump(void) 70 { 71 return 0; 72 } 73 74 __weak int set_armclk_rate(void) 75 { 76 return 0; 77 } 78 79 __weak int rk_board_init(void) 80 { 81 return 0; 82 } 83 84 #ifdef CONFIG_ROCKCHIP_SET_ETHADDR 85 /* 86 * define serialno max length, the max length is 512 Bytes 87 * The remaining bytes are used to ensure that the first 512 bytes 88 * are valid when executing 'env_set("serial#", value)'. 89 */ 90 #define VENDOR_SN_MAX 513 91 #define CPUID_LEN 0x10 92 #define CPUID_OFF 0x07 93 94 #define MAX_ETHERNET 0x2 95 96 static int rockchip_set_ethaddr(void) 97 { 98 __maybe_unused bool need_write = false; 99 bool randomed = false; 100 char buf[ARP_HLEN_ASCII + 1], mac[16]; 101 u8 ethaddr[ARP_HLEN * MAX_ETHERNET] = {0}; 102 int i, ret = -EINVAL; 103 104 #ifdef CONFIG_ROCKCHIP_VENDOR_PARTITION 105 ret = vendor_storage_read(LAN_MAC_ID, ethaddr, sizeof(ethaddr)); 106 #endif 107 for (i = 0; i < MAX_ETHERNET; i++) { 108 if (ret <= 0 || !is_valid_ethaddr(ðaddr[i * ARP_HLEN])) { 109 if (!randomed) { 110 net_random_ethaddr(ðaddr[i * ARP_HLEN]); 111 randomed = true; 112 } else { 113 if (i > 0) { 114 memcpy(ðaddr[i * ARP_HLEN], 115 ðaddr[(i - 1) * ARP_HLEN], 116 ARP_HLEN); 117 ethaddr[i * ARP_HLEN] |= 0x02; 118 ethaddr[i * ARP_HLEN] += (i << 2); 119 } 120 } 121 122 need_write = true; 123 } 124 125 if (is_valid_ethaddr(ðaddr[i * ARP_HLEN])) { 126 snprintf(buf, ARP_HLEN_ASCII + 1, "%pM", ðaddr[i * ARP_HLEN]); 127 if (i == 0) 128 memcpy(mac, "ethaddr", sizeof("ethaddr")); 129 else 130 sprintf(mac, "eth%daddr", i); 131 env_set(mac, buf); 132 } 133 } 134 135 #ifdef CONFIG_ROCKCHIP_VENDOR_PARTITION 136 if (need_write) { 137 ret = vendor_storage_write(LAN_MAC_ID, 138 ethaddr, sizeof(ethaddr)); 139 if (ret < 0) 140 printf("%s: vendor_storage_write failed %d\n", 141 __func__, ret); 142 } 143 #endif 144 return 0; 145 } 146 #endif 147 148 #ifdef CONFIG_ROCKCHIP_SET_SN 149 static int rockchip_set_serialno(void) 150 { 151 u8 low[CPUID_LEN / 2], high[CPUID_LEN / 2]; 152 u8 cpuid[CPUID_LEN] = {0}; 153 char serialno_str[VENDOR_SN_MAX]; 154 int ret = 0, i; 155 u64 serialno; 156 157 /* Read serial number from vendor storage part */ 158 memset(serialno_str, 0, VENDOR_SN_MAX); 159 160 #ifdef CONFIG_ROCKCHIP_VENDOR_PARTITION 161 ret = vendor_storage_read(SN_ID, serialno_str, (VENDOR_SN_MAX-1)); 162 if (ret > 0) { 163 i = strlen(serialno_str); 164 for (; i > 0; i--) { 165 if ((serialno_str[i] >= 'a' && serialno_str[i] <= 'z') || 166 (serialno_str[i] >= 'A' && serialno_str[i] <= 'Z') || 167 (serialno_str[i] >= '0' && serialno_str[i] <= '9')) 168 break; 169 } 170 171 /* valid character count > 0 */ 172 if (i > 0) { 173 serialno_str[i + 1] = 0x0; 174 env_set("serial#", serialno_str); 175 } 176 } 177 #endif 178 if (!env_get("serial#")) { 179 #if defined(CONFIG_ROCKCHIP_EFUSE) || defined(CONFIG_ROCKCHIP_OTP) 180 struct udevice *dev; 181 182 /* retrieve the device */ 183 if (IS_ENABLED(CONFIG_ROCKCHIP_EFUSE)) 184 ret = uclass_get_device_by_driver(UCLASS_MISC, 185 DM_GET_DRIVER(rockchip_efuse), 186 &dev); 187 else 188 ret = uclass_get_device_by_driver(UCLASS_MISC, 189 DM_GET_DRIVER(rockchip_otp), 190 &dev); 191 192 if (ret) { 193 printf("%s: could not find efuse/otp device\n", __func__); 194 return ret; 195 } 196 197 /* read the cpu_id range from the efuses */ 198 ret = misc_read(dev, CPUID_OFF, &cpuid, sizeof(cpuid)); 199 if (ret) { 200 printf("%s: read cpuid from efuse/otp failed, ret=%d\n", 201 __func__, ret); 202 return ret; 203 } 204 #else 205 /* generate random cpuid */ 206 for (i = 0; i < CPUID_LEN; i++) 207 cpuid[i] = (u8)(rand()); 208 #endif 209 /* Generate the serial number based on CPU ID */ 210 for (i = 0; i < 8; i++) { 211 low[i] = cpuid[1 + (i << 1)]; 212 high[i] = cpuid[i << 1]; 213 } 214 215 serialno = crc32_no_comp(0, low, 8); 216 serialno |= (u64)crc32_no_comp(serialno, high, 8) << 32; 217 snprintf(serialno_str, sizeof(serialno_str), "%llx", serialno); 218 219 env_set("serial#", serialno_str); 220 } 221 222 return ret; 223 } 224 #endif 225 226 #if defined(CONFIG_USB_FUNCTION_FASTBOOT) 227 int fb_set_reboot_flag(void) 228 { 229 printf("Setting reboot to fastboot flag ...\n"); 230 writel(BOOT_FASTBOOT, CONFIG_ROCKCHIP_BOOT_MODE_REG); 231 232 return 0; 233 } 234 #endif 235 236 #ifdef CONFIG_ROCKCHIP_USB_BOOT 237 static int boot_from_udisk(void) 238 { 239 struct blk_desc *desc; 240 char *devtype; 241 char *devnum; 242 243 devtype = env_get("devtype"); 244 devnum = env_get("devnum"); 245 246 /* Booting priority: mmc1 > udisk */ 247 if (!strcmp(devtype, "mmc") && !strcmp(devnum, "1")) 248 return 0; 249 250 if (!run_command("usb start", -1)) { 251 desc = blk_get_devnum_by_type(IF_TYPE_USB, 0); 252 if (!desc) { 253 printf("No usb device found\n"); 254 return -ENODEV; 255 } 256 257 if (!run_command("rkimgtest usb 0", -1)) { 258 rockchip_set_bootdev(desc); 259 env_set("devtype", "usb"); 260 env_set("devnum", "0"); 261 printf("Boot from usb 0\n"); 262 } else { 263 printf("No usb dev 0 found\n"); 264 return -ENODEV; 265 } 266 } 267 268 return 0; 269 } 270 #endif 271 272 static void env_fixup(void) 273 { 274 struct memblock mem; 275 ulong u_addr_r; 276 phys_size_t end; 277 char *addr_r; 278 279 #ifdef ENV_MEM_LAYOUT_SETTINGS1 280 const char *env_addr0[] = { 281 "scriptaddr", "pxefile_addr_r", 282 "fdt_addr_r", "kernel_addr_r", "ramdisk_addr_r", 283 }; 284 const char *env_addr1[] = { 285 "scriptaddr1", "pxefile_addr1_r", 286 "fdt_addr1_r", "kernel_addr1_r", "ramdisk_addr1_r", 287 }; 288 int i; 289 290 /* 128M is a typical ram size for most platform, so as default here */ 291 if (gd->ram_size <= SZ_128M) { 292 /* Replace orignal xxx_addr_r */ 293 for (i = 0; i < ARRAY_SIZE(env_addr1); i++) { 294 addr_r = env_get(env_addr1[i]); 295 if (addr_r) 296 env_set(env_addr0[i], addr_r); 297 } 298 } 299 #endif 300 /* No BL32 ? */ 301 if (!(gd->flags & GD_FLG_BL32_ENABLED)) { 302 /* 303 * [1] Move kernel to lower address if possible. 304 */ 305 addr_r = env_get("kernel_addr_no_low_bl32_r"); 306 if (addr_r) 307 env_set("kernel_addr_r", addr_r); 308 309 /* 310 * [2] Move ramdisk at BL32 position if need. 311 * 312 * 0x0a200000 and 0x08400000 are rockchip traditional address 313 * of BL32 and ramdisk: 314 * 315 * |------------|------------| 316 * | BL32 | ramdisk | 317 * |------------|------------| 318 * 319 * Move ramdisk to BL32 address to fix sysmem alloc failed 320 * issue on the board with critical memory(ie. 256MB). 321 */ 322 if (gd->ram_size > SZ_128M && gd->ram_size <= SZ_256M) { 323 u_addr_r = env_get_ulong("ramdisk_addr_r", 16, 0); 324 if (u_addr_r == 0x0a200000) 325 env_set("ramdisk_addr_r", "0x08400000"); 326 } 327 } else { 328 mem = param_parse_optee_mem(); 329 330 /* 331 * [1] Move kernel forward if possible. 332 */ 333 if (mem.base > SZ_128M) { 334 addr_r = env_get("kernel_addr_no_low_bl32_r"); 335 if (addr_r) 336 env_set("kernel_addr_r", addr_r); 337 } 338 339 /* 340 * [2] Move ramdisk backward if optee enlarge. 341 */ 342 end = mem.base + mem.size; 343 u_addr_r = env_get_ulong("ramdisk_addr_r", 16, 0); 344 if (u_addr_r >= mem.base && u_addr_r < end) 345 env_set_hex("ramdisk_addr_r", end); 346 } 347 } 348 349 static void cmdline_handle(void) 350 { 351 struct blk_desc *dev_desc; 352 353 param_parse_pubkey_fuse_programmed(); 354 355 dev_desc = rockchip_get_bootdev(); 356 if (!dev_desc) 357 return; 358 359 /* 360 * 1. From rk356x, the sd/udisk recovery update flag was moved from 361 * IDB to Android BCB. 362 * 363 * 2. Udisk is init at the late boot_from_udisk(), but 364 * rockchip_get_boot_mode() actually only read once, 365 * we need to update boot mode according to udisk BCB. 366 */ 367 if ((dev_desc->if_type == IF_TYPE_MMC && dev_desc->devnum == 1) || 368 (dev_desc->if_type == IF_TYPE_USB && dev_desc->devnum == 0)) { 369 if (get_bcb_recovery_msg() == BCB_MSG_RECOVERY_RK_FWUPDATE) { 370 if (dev_desc->if_type == IF_TYPE_MMC && dev_desc->devnum == 1) { 371 env_update("bootargs", "sdfwupdate"); 372 } else if (dev_desc->if_type == IF_TYPE_USB && dev_desc->devnum == 0) { 373 env_update("bootargs", "usbfwupdate"); 374 env_set("reboot_mode", "recovery-usb"); 375 } 376 } else { 377 if (dev_desc->if_type == IF_TYPE_USB && dev_desc->devnum == 0) 378 env_set("reboot_mode", "normal"); 379 } 380 } 381 } 382 383 int board_late_init(void) 384 { 385 #ifdef CONFIG_ROCKCHIP_SET_ETHADDR 386 rockchip_set_ethaddr(); 387 #endif 388 #ifdef CONFIG_ROCKCHIP_SET_SN 389 rockchip_set_serialno(); 390 #endif 391 setup_download_mode(); 392 393 #ifdef CONFIG_ROCKCHIP_USB_BOOT 394 boot_from_udisk(); 395 #endif 396 #ifdef CONFIG_DM_CHARGE_DISPLAY 397 charge_display(); 398 #endif 399 #ifdef CONFIG_DRM_ROCKCHIP 400 rockchip_show_logo(); 401 #endif 402 #ifdef CONFIG_ROCKCHIP_EINK_DISPLAY 403 rockchip_eink_show_uboot_logo(); 404 #endif 405 #if (CONFIG_ROCKCHIP_BOOT_MODE_REG > 0) 406 setup_boot_mode(); 407 #endif 408 env_fixup(); 409 soc_clk_dump(); 410 cmdline_handle(); 411 #ifdef CONFIG_AMP 412 amp_cpus_on(); 413 #endif 414 return rk_board_late_init(); 415 } 416 417 static void early_download(void) 418 { 419 #if defined(CONFIG_PWRKEY_DNL_TRIGGER_NUM) && \ 420 (CONFIG_PWRKEY_DNL_TRIGGER_NUM > 0) 421 if (pwrkey_download_init()) 422 printf("Pwrkey download init failed\n"); 423 #endif 424 425 #if (CONFIG_ROCKCHIP_BOOT_MODE_REG > 0) 426 if (is_hotkey(HK_BROM_DNL)) { 427 printf("Enter bootrom download..."); 428 flushc(); 429 writel(BOOT_BROM_DOWNLOAD, CONFIG_ROCKCHIP_BOOT_MODE_REG); 430 do_reset(NULL, 0, 0, NULL); 431 printf("failed!\n"); 432 } 433 #endif 434 } 435 436 static void board_debug_init(void) 437 { 438 if (!gd->serial.using_pre_serial && 439 !(gd->flags & GD_FLG_DISABLE_CONSOLE)) 440 debug_uart_init(); 441 442 if (tstc()) { 443 gd->console_evt = getc(); 444 if (gd->console_evt <= 0x1a) /* 'z' */ 445 printf("Hotkey: ctrl+%c\n", gd->console_evt + 'a' - 1); 446 } 447 448 if (IS_ENABLED(CONFIG_CONSOLE_DISABLE_CLI)) 449 printf("Cmd interface: disabled\n"); 450 } 451 452 #if defined(CONFIG_MTD_BLK) && defined(CONFIG_USING_KERNEL_DTB) 453 static void board_mtd_blk_map_partitions(void) 454 { 455 struct blk_desc *dev_desc; 456 457 dev_desc = rockchip_get_bootdev(); 458 if (dev_desc) 459 mtd_blk_map_partitions(dev_desc); 460 } 461 #endif 462 463 int board_init(void) 464 { 465 board_debug_init(); 466 /* optee select security level */ 467 #ifdef CONFIG_OPTEE_CLIENT 468 trusty_select_security_level(); 469 #endif 470 471 #ifdef DEBUG 472 soc_clk_dump(); 473 #endif 474 475 #ifdef CONFIG_USING_KERNEL_DTB 476 #ifdef CONFIG_MTD_BLK 477 board_mtd_blk_map_partitions(); 478 #endif 479 init_kernel_dtb(); 480 #endif 481 early_download(); 482 483 /* 484 * pmucru isn't referenced on some platforms, so pmucru driver can't 485 * probe that the "assigned-clocks" is unused. 486 */ 487 clks_probe(); 488 #ifdef CONFIG_DM_REGULATOR 489 if (regulators_enable_boot_on(is_hotkey(HK_REGULATOR))) 490 debug("%s: Can't enable boot on regulator\n", __func__); 491 #endif 492 493 #ifdef CONFIG_ROCKCHIP_IO_DOMAIN 494 io_domain_init(); 495 #endif 496 497 set_armclk_rate(); 498 499 #ifdef CONFIG_DM_DVFS 500 dvfs_init(true); 501 #endif 502 503 #ifdef CONFIG_ANDROID_AB 504 if (ab_decrease_tries()) 505 printf("Decrease ab tries count fail!\n"); 506 #endif 507 508 return rk_board_init(); 509 } 510 511 int interrupt_debugger_init(void) 512 { 513 #ifdef CONFIG_ROCKCHIP_DEBUGGER 514 return rockchip_debugger_init(); 515 #else 516 return 0; 517 #endif 518 } 519 520 int board_fdt_fixup(void *blob) 521 { 522 /* Common fixup for DRM */ 523 #ifdef CONFIG_DRM_ROCKCHIP 524 rockchip_display_fixup(blob); 525 #endif 526 527 return rk_board_fdt_fixup(blob); 528 } 529 530 #if defined(CONFIG_ARM64_BOOT_AARCH32) || !defined(CONFIG_ARM64) 531 /* 532 * Common for OP-TEE: 533 * 64-bit & 32-bit mode: share memory dcache is always enabled; 534 * 535 * Common for U-Boot: 536 * 64-bit mode: MMU table is static defined in rkxxx.c file, all memory 537 * regions are mapped. That's good to match OP-TEE MMU policy. 538 * 539 * 32-bit mode: MMU table is setup according to gd->bd->bi_dram[..] where 540 * the OP-TEE region has been reserved, so it can not be 541 * mapped(i.e. dcache is disabled). That's *NOT* good to match 542 * OP-TEE MMU policy. 543 * 544 * For the data coherence when communication between U-Boot and OP-TEE, U-Boot 545 * should follow OP-TEE MMU policy. 546 * 547 * So 32-bit mode U-Boot should map OP-TEE share memory as dcache enabled. 548 */ 549 int board_initr_caches_fixup(void) 550 { 551 #ifdef CONFIG_OPTEE_CLIENT 552 struct memblock mem; 553 554 mem.base = 0; 555 mem.size = 0; 556 557 optee_get_shm_config(&mem.base, &mem.size); 558 if (mem.size) 559 mmu_set_region_dcache_behaviour(mem.base, mem.size, 560 DCACHE_WRITEBACK); 561 #endif 562 return 0; 563 } 564 #endif 565 566 void arch_preboot_os(uint32_t bootm_state, bootm_headers_t *images) 567 { 568 if (!(bootm_state & BOOTM_STATE_OS_PREP)) 569 return; 570 571 #ifdef CONFIG_ARM64 572 u8 *data = (void *)images->ep; 573 574 /* 575 * Fix kernel 5.10 arm64 boot warning: 576 * "[Firmware Bug]: Kernel image misaligned at boot, please fix your bootloader!" 577 * 578 * kernel: 5.10 commit 120dc60d0bdb ("arm64: get rid of TEXT_OFFSET") 579 * arm64 kernel version: 580 * data[10] == 0x00 if kernel version >= 5.10: N*2MB align 581 * data[10] == 0x08 if kernel version < 5.10: N*2MB + 0x80000(TEXT_OFFSET) 582 * 583 * Why fix here? 584 * 1. this is the common and final path for any boot command. 585 * 2. don't influence original boot flow, just fix it exactly before 586 * jumping kernel. 587 * 588 * But relocation is in board_quiesce_devices() until all decompress 589 * done, mainly for saving boot time. 590 */ 591 if (data[10] == 0x00) { 592 if (round_down(images->ep, SZ_2M) != images->ep) 593 images->ep = round_down(images->ep, SZ_2M); 594 } else { 595 if (IS_ALIGNED(images->ep, SZ_2M)) 596 images->ep += 0x80000; 597 } 598 #endif 599 hotkey_run(HK_CLI_OS_PRE); 600 } 601 602 void enable_caches(void) 603 { 604 icache_enable(); 605 dcache_enable(); 606 } 607 608 #ifdef CONFIG_LMB 609 /* 610 * Using last bi_dram[...] to initialize "bootm_low" and "bootm_mapsize". 611 * This makes lmb_alloc_base() always alloc from tail of sdram. 612 * If we don't assign it, bi_dram[0] is used by default and it may cause 613 * lmb_alloc_base() fail when bi_dram[0] range is small. 614 */ 615 void board_lmb_reserve(struct lmb *lmb) 616 { 617 char bootm_mapsize[32]; 618 char bootm_low[32]; 619 u64 start, size; 620 int i; 621 622 for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) { 623 if (!gd->bd->bi_dram[i].size) 624 break; 625 } 626 627 start = gd->bd->bi_dram[i - 1].start; 628 size = gd->bd->bi_dram[i - 1].size; 629 630 /* 631 * 32-bit kernel: ramdisk/fdt shouldn't be loaded to highmem area(768MB+), 632 * otherwise "Unable to handle kernel paging request at virtual address ...". 633 * 634 * So that we hope limit highest address at 768M, but there comes the the 635 * problem: ramdisk is a compressed image and it expands after descompress, 636 * so it accesses 768MB+ and brings the above "Unable to handle kernel ...". 637 * 638 * We make a appointment that the highest memory address is 512MB, it 639 * makes lmb alloc safer. 640 */ 641 #ifndef CONFIG_ARM64 642 if (start >= ((u64)CONFIG_SYS_SDRAM_BASE + SZ_512M)) { 643 start = gd->bd->bi_dram[i - 2].start; 644 size = gd->bd->bi_dram[i - 2].size; 645 } 646 647 if ((start + size) > ((u64)CONFIG_SYS_SDRAM_BASE + SZ_512M)) 648 size = (u64)CONFIG_SYS_SDRAM_BASE + SZ_512M - start; 649 #endif 650 sprintf(bootm_low, "0x%llx", start); 651 sprintf(bootm_mapsize, "0x%llx", size); 652 env_set("bootm_low", bootm_low); 653 env_set("bootm_mapsize", bootm_mapsize); 654 } 655 #endif 656 657 #ifdef CONFIG_BIDRAM 658 int board_bidram_reserve(struct bidram *bidram) 659 { 660 struct memblock mem; 661 int ret; 662 663 /* ATF */ 664 mem = param_parse_atf_mem(); 665 ret = bidram_reserve(MEM_ATF, mem.base, mem.size); 666 if (ret) 667 return ret; 668 669 /* PSTORE/ATAGS/SHM */ 670 mem = param_parse_common_resv_mem(); 671 ret = bidram_reserve(MEM_SHM, mem.base, mem.size); 672 if (ret) 673 return ret; 674 675 /* OP-TEE */ 676 mem = param_parse_optee_mem(); 677 ret = bidram_reserve(MEM_OPTEE, mem.base, mem.size); 678 if (ret) 679 return ret; 680 681 return 0; 682 } 683 684 #ifdef CONFIG_SYSMEM 685 int board_sysmem_reserve(struct sysmem *sysmem) 686 { 687 #ifdef CONFIG_SKIP_RELOCATE_UBOOT 688 if (!sysmem_alloc_base_by_name("NO-RELOC-CODE", 689 CONFIG_SYS_TEXT_BASE, SZ_2M)) { 690 printf("Failed to reserve sysmem for U-Boot code\n"); 691 return -ENOMEM; 692 } 693 #endif 694 return 0; 695 } 696 #endif 697 698 parse_fn_t board_bidram_parse_fn(void) 699 { 700 return param_parse_ddr_mem; 701 } 702 #endif 703 704 int board_init_f_boot_flags(void) 705 { 706 int boot_flags = 0; 707 708 arch_fpga_init(); 709 710 param_parse_pre_serial(&boot_flags); 711 712 /* The highest priority to turn off (override) console */ 713 #if defined(CONFIG_DISABLE_CONSOLE) 714 boot_flags |= GD_FLG_DISABLE_CONSOLE; 715 #endif 716 717 return boot_flags; 718 } 719 720 #if defined(CONFIG_USB_GADGET) && defined(CONFIG_USB_GADGET_DWC2_OTG) 721 #include <fdt_support.h> 722 #include <usb.h> 723 #include <usb/dwc2_udc.h> 724 725 static struct dwc2_plat_otg_data otg_data = { 726 .rx_fifo_sz = 512, 727 .np_tx_fifo_sz = 16, 728 .tx_fifo_sz = 128, 729 }; 730 731 int board_usb_init(int index, enum usb_init_type init) 732 { 733 const void *blob = gd->fdt_blob; 734 const fdt32_t *reg; 735 fdt_addr_t addr; 736 int node; 737 738 /* find the usb_otg node */ 739 node = fdt_node_offset_by_compatible(blob, -1, "snps,dwc2"); 740 741 retry: 742 if (node > 0) { 743 reg = fdt_getprop(blob, node, "reg", NULL); 744 if (!reg) 745 return -EINVAL; 746 747 addr = fdt_translate_address(blob, node, reg); 748 if (addr == OF_BAD_ADDR) { 749 pr_err("Not found usb_otg address\n"); 750 return -EINVAL; 751 } 752 753 #if defined(CONFIG_ROCKCHIP_RK3288) 754 if (addr != 0xff580000) { 755 node = fdt_node_offset_by_compatible(blob, node, 756 "snps,dwc2"); 757 goto retry; 758 } 759 #endif 760 } else { 761 /* 762 * With kernel dtb support, rk3288 dwc2 otg node 763 * use the rockchip legacy dwc2 driver "dwc_otg_310" 764 * with the compatible "rockchip,rk3288_usb20_otg", 765 * and rk3368 also use the "dwc_otg_310" driver with 766 * the compatible "rockchip,rk3368-usb". 767 */ 768 #if defined(CONFIG_ROCKCHIP_RK3288) 769 node = fdt_node_offset_by_compatible(blob, -1, 770 "rockchip,rk3288_usb20_otg"); 771 #elif defined(CONFIG_ROCKCHIP_RK3368) 772 node = fdt_node_offset_by_compatible(blob, -1, 773 "rockchip,rk3368-usb"); 774 #endif 775 if (node > 0) { 776 goto retry; 777 } else { 778 pr_err("Not found usb_otg device\n"); 779 return -ENODEV; 780 } 781 } 782 783 otg_data.regs_otg = (uintptr_t)addr; 784 785 return dwc2_udc_probe(&otg_data); 786 } 787 788 int board_usb_cleanup(int index, enum usb_init_type init) 789 { 790 return 0; 791 } 792 #endif 793 794 static void bootm_no_reloc(void) 795 { 796 char *ramdisk_high; 797 char *fdt_high; 798 799 if (!env_get_yesno("bootm-no-reloc")) 800 return; 801 802 ramdisk_high = env_get("initrd_high"); 803 fdt_high = env_get("fdt_high"); 804 805 if (!fdt_high) { 806 env_set_hex("fdt_high", -1UL); 807 printf("Fdt "); 808 } 809 810 if (!ramdisk_high) { 811 env_set_hex("initrd_high", -1UL); 812 printf("Ramdisk "); 813 } 814 815 if (!fdt_high || !ramdisk_high) 816 printf("skip relocation\n"); 817 } 818 819 int bootm_board_start(void) 820 { 821 /* 822 * print console record data 823 * 824 * On some rockchip platforms, uart debug and sdmmc pin are multiplex. 825 * If boot from sdmmc mode, the console data would be record in buffer, 826 * we switch to uart debug function in order to print it after loading 827 * images. 828 */ 829 #if defined(CONFIG_CONSOLE_RECORD) 830 if (!strcmp("mmc", env_get("devtype")) && 831 !strcmp("1", env_get("devnum"))) { 832 printf("IOMUX: sdmmc => uart debug"); 833 pinctrl_select_state(gd->cur_serial_dev, "default"); 834 console_record_print_purge(); 835 } 836 #endif 837 /* disable bootm relcation to save boot time */ 838 bootm_no_reloc(); 839 840 /* PCBA test needs more permission */ 841 if (get_bcb_recovery_msg() == BCB_MSG_RECOVERY_PCBA) 842 env_update("bootargs", "androidboot.selinux=permissive"); 843 844 /* sysmem */ 845 hotkey_run(HK_SYSMEM); 846 sysmem_overflow_check(); 847 848 return 0; 849 } 850 851 int bootm_image_populate_dtb(void *img) 852 { 853 if ((gd->flags & GD_FLG_KDTB_READY) && !gd->fdt_blob_kern) 854 sysmem_free((phys_addr_t)gd->fdt_blob); 855 else 856 gd->fdt_blob = (void *)env_get_ulong("fdt_addr_r", 16, 0); 857 858 return rockchip_ram_read_dtb_file(img, (void *)gd->fdt_blob); 859 } 860 861 /* 862 * Implement it to support CLI command: 863 * - Android: bootm [aosp addr] 864 * - FIT: bootm [fit addr] 865 * - uImage: bootm [uimage addr] 866 * 867 * Purpose: 868 * - The original bootm command args require fdt addr on AOSP, 869 * which is not flexible on rockchip boot/recovery.img. 870 * - Take Android/FIT/uImage image into sysmem management to avoid image 871 * memory overlap. 872 */ 873 #if defined(CONFIG_ANDROID_BOOTLOADER) || \ 874 defined(CONFIG_ROCKCHIP_FIT_IMAGE) || \ 875 defined(CONFIG_ROCKCHIP_UIMAGE) 876 int board_do_bootm(int argc, char * const argv[]) 877 { 878 int format; 879 void *img; 880 881 /* only 'bootm' full image goes further */ 882 if (argc != 2) 883 return 0; 884 885 img = (void *)simple_strtoul(argv[1], NULL, 16); 886 format = (genimg_get_format(img)); 887 888 /* Android */ 889 #ifdef CONFIG_ANDROID_BOOT_IMAGE 890 if (format == IMAGE_FORMAT_ANDROID) { 891 struct andr_img_hdr *hdr; 892 ulong load_addr; 893 ulong size; 894 int ret; 895 896 hdr = (struct andr_img_hdr *)img; 897 printf("BOOTM: transferring to board Android\n"); 898 899 load_addr = env_get_ulong("kernel_addr_r", 16, 0); 900 load_addr -= hdr->page_size; 901 size = android_image_get_end(hdr) - (ulong)hdr; 902 903 if (!sysmem_alloc_base(MEM_ANDROID, (ulong)hdr, size)) 904 return -ENOMEM; 905 906 ret = bootm_image_populate_dtb(img); 907 if (ret) { 908 printf("bootm can't read dtb, ret=%d\n", ret); 909 return ret; 910 } 911 912 ret = android_image_memcpy_separate(hdr, &load_addr); 913 if (ret) { 914 printf("board do bootm failed, ret=%d\n", ret); 915 return ret; 916 } 917 918 return android_bootloader_boot_kernel(load_addr); 919 } 920 #endif 921 922 /* FIT */ 923 #if IMAGE_ENABLE_FIT 924 if (format == IMAGE_FORMAT_FIT) { 925 char boot_cmd[64]; 926 int ret; 927 928 printf("BOOTM: transferring to board FIT\n"); 929 930 ret = bootm_image_populate_dtb(img); 931 if (ret) { 932 printf("bootm can't read dtb, ret=%d\n", ret); 933 return ret; 934 } 935 snprintf(boot_cmd, sizeof(boot_cmd), "boot_fit %s", argv[1]); 936 return run_command(boot_cmd, 0); 937 } 938 #endif 939 940 /* uImage */ 941 #if 0 942 #if defined(CONFIG_IMAGE_FORMAT_LEGACY) 943 if (format == IMAGE_FORMAT_LEGACY && 944 image_get_type(img) == IH_TYPE_MULTI) { 945 char boot_cmd[64]; 946 947 printf("BOOTM: transferring to board uImage\n"); 948 snprintf(boot_cmd, sizeof(boot_cmd), "boot_uimage %s", argv[1]); 949 return run_command(boot_cmd, 0); 950 } 951 #endif 952 #endif 953 return 0; 954 } 955 #endif 956 957 void autoboot_command_fail_handle(void) 958 { 959 #ifdef CONFIG_ANDROID_AB 960 if (rk_avb_ab_have_bootable_slot() == true) 961 run_command("reset;", 0); 962 else 963 run_command("fastboot usb 0;", 0); 964 #endif 965 966 #ifdef CONFIG_AVB_VBMETA_PUBLIC_KEY_VALIDATE 967 run_command("rockusb 0 ${devtype} ${devnum}", 0); 968 run_command("fastboot usb 0;", 0); 969 #endif 970 971 } 972 973 #ifdef CONFIG_FIT_ROLLBACK_PROTECT 974 975 #define FIT_ROLLBACK_INDEX_LOCATION 0x66697472 /* "fitr" */ 976 977 int fit_read_otp_rollback_index(uint32_t fit_index, uint32_t *otp_index) 978 { 979 #ifdef CONFIG_OPTEE_CLIENT 980 u64 index; 981 int ret; 982 983 ret = trusty_read_rollback_index(FIT_ROLLBACK_INDEX_LOCATION, &index); 984 if (ret) { 985 if (ret != TEE_ERROR_ITEM_NOT_FOUND) 986 return ret; 987 988 index = 0; 989 printf("Initial otp index as %d\n", fit_index); 990 } 991 992 *otp_index = (uint32_t)index; 993 #else 994 *otp_index = 0; 995 #endif 996 997 return 0; 998 } 999 1000 int fit_write_trusty_rollback_index(u32 trusty_index) 1001 { 1002 if (!trusty_index) 1003 return 0; 1004 #ifdef CONFIG_OPTEE_CLIENT 1005 return trusty_write_rollback_index(FIT_ROLLBACK_INDEX_LOCATION, 1006 (u64)trusty_index); 1007 #else 1008 return 0; 1009 #endif 1010 } 1011 #endif 1012 1013 void board_quiesce_devices(void *images) 1014 { 1015 #ifdef CONFIG_ROCKCHIP_PRELOADER_ATAGS 1016 /* Destroy atags makes next warm boot safer */ 1017 atags_destroy(); 1018 #endif 1019 #ifdef CONFIG_FIT_ROLLBACK_PROTECT 1020 int ret; 1021 1022 ret = fit_write_trusty_rollback_index(gd->rollback_index); 1023 if (ret) { 1024 panic("Failed to write fit rollback index %d, ret=%d", 1025 gd->rollback_index, ret); 1026 } 1027 #endif 1028 #ifdef CONFIG_ROCKCHIP_HW_DECOMPRESS 1029 misc_decompress_cleanup(); 1030 #endif 1031 #ifdef CONFIG_ARM64 1032 bootm_headers_t *bootm_images = (bootm_headers_t *)images; 1033 ulong kernel_addr; 1034 1035 /* relocate kernel after decompress cleanup */ 1036 kernel_addr = env_get_ulong("kernel_addr_r", 16, 0); 1037 if (kernel_addr != bootm_images->ep) { 1038 memmove((char *)bootm_images->ep, (const char *)kernel_addr, 1039 bootm_images->os.image_len); 1040 printf("== DO RELOCATE == Kernel from 0x%08lx to 0x%08lx\n", 1041 kernel_addr, bootm_images->ep); 1042 } 1043 #endif 1044 1045 hotkey_run(HK_CMDLINE); 1046 hotkey_run(HK_CLI_OS_GO); 1047 #ifdef CONFIG_ROCKCHIP_REBOOT_TEST 1048 do_reset(NULL, 0, 0, NULL); 1049 #endif 1050 } 1051 1052 char *board_fdt_chosen_bootargs(void *fdt) 1053 { 1054 /* bootargs_ext is used when dtbo is applied. */ 1055 const char *arr_bootargs[] = { "bootargs", "bootargs_ext" }; 1056 const char *bootargs; 1057 int nodeoffset; 1058 int i, dump; 1059 char *msg = "kernel"; 1060 1061 /* debug */ 1062 hotkey_run(HK_INITCALL); 1063 dump = is_hotkey(HK_CMDLINE); 1064 if (dump) 1065 printf("## bootargs(u-boot): %s\n\n", env_get("bootargs")); 1066 1067 /* find or create "/chosen" node. */ 1068 nodeoffset = fdt_find_or_add_subnode(fdt, 0, "chosen"); 1069 if (nodeoffset < 0) 1070 return NULL; 1071 1072 for (i = 0; i < ARRAY_SIZE(arr_bootargs); i++) { 1073 bootargs = fdt_getprop(fdt, nodeoffset, arr_bootargs[i], NULL); 1074 if (!bootargs) 1075 continue; 1076 if (dump) 1077 printf("## bootargs(%s-%s): %s\n\n", 1078 msg, arr_bootargs[i], bootargs); 1079 /* 1080 * Append kernel bootargs 1081 * If use AB system, delete default "root=" which route 1082 * to rootfs. Then the ab bootctl will choose the 1083 * high priority system to boot and add its UUID 1084 * to cmdline. The format is "roo=PARTUUID=xxxx...". 1085 */ 1086 #ifdef CONFIG_ANDROID_AB 1087 env_update_filter("bootargs", bootargs, "root="); 1088 #else 1089 env_update("bootargs", bootargs); 1090 #endif 1091 } 1092 1093 #ifdef CONFIG_ENVF 1094 char * sys_bootargs; 1095 1096 sys_bootargs = env_get("sys_bootargs"); 1097 if (sys_bootargs) { 1098 env_update("bootargs", sys_bootargs); 1099 if (dump) 1100 printf("## sys_bootargs: %s\n\n", sys_bootargs); 1101 } 1102 #endif 1103 #ifdef CONFIG_MTD_BLK 1104 if (!env_get("mtdparts")) { 1105 char *mtd_par_info = mtd_part_parse(NULL); 1106 1107 if (mtd_par_info) { 1108 if (memcmp(env_get("devtype"), "mtd", 3) == 0) 1109 env_update("bootargs", mtd_par_info); 1110 } 1111 } 1112 #endif 1113 /* 1114 * Initrd fixup: remove unused "initrd=0x...,0x...", 1115 * this for compatible with legacy parameter.txt 1116 */ 1117 env_delete("bootargs", "initrd=", 0); 1118 1119 /* 1120 * If uart is required to be disabled during 1121 * power on, it would be not initialized by 1122 * any pre-loader and U-Boot. 1123 * 1124 * If we don't remove earlycon from commandline, 1125 * kernel hangs while using earlycon to putc/getc 1126 * which may dead loop for waiting uart status. 1127 * (It seems the root cause is baundrate is not 1128 * initilalized) 1129 * 1130 * So let's remove earlycon from commandline. 1131 */ 1132 if (gd->flags & GD_FLG_DISABLE_CONSOLE) 1133 env_delete("bootargs", "earlycon=", 0); 1134 1135 /* Android header v4+ need this handle */ 1136 #ifdef CONFIG_ANDROID_BOOT_IMAGE 1137 struct andr_img_hdr *hdr; 1138 1139 hdr = (void *)env_get_ulong("android_addr_r", 16, 0); 1140 if (hdr && !android_image_check_header(hdr) && hdr->header_version >= 4) { 1141 if (env_update_extract_subset("bootargs", "andr_bootargs", "androidboot.")) 1142 printf("extract androidboot.xxx error\n"); 1143 if (dump) 1144 printf("## bootargs(android): %s\n\n", env_get("andr_bootargs")); 1145 } 1146 #endif 1147 bootargs = env_get("bootargs"); 1148 if (dump) 1149 printf("## bootargs(merged): %s\n\n", bootargs); 1150 1151 return (char *)bootargs; 1152 } 1153 1154 int ft_verify_fdt(void *fdt) 1155 { 1156 /* for android header v4+, we load bootparams and fixup initrd */ 1157 #if defined(CONFIG_ANDROID_BOOT_IMAGE) && defined(CONFIG_XBC) 1158 struct andr_img_hdr *hdr; 1159 uint64_t initrd_start, initrd_end; 1160 char *bootargs, *p; 1161 int nodeoffset; 1162 int is_u64, err; 1163 u32 len; 1164 1165 hdr = (void *)env_get_ulong("android_addr_r", 16, 0); 1166 if (!hdr || android_image_check_header(hdr) || 1167 hdr->header_version < 4) 1168 return 1; 1169 1170 bootargs = env_get("andr_bootargs"); 1171 if (!bootargs) 1172 return 1; 1173 1174 /* trans character: space to new line */ 1175 p = bootargs; 1176 while (*p++) { 1177 if (*p == ' ') 1178 *p = '\n'; 1179 } 1180 1181 debug("## andr_bootargs: %s\n", bootargs); 1182 1183 /* 1184 * add boot params right after bootconfig 1185 * 1186 * because we can get final full bootargs in board_fdt_chosen_bootargs(), 1187 * android_image_get_ramdisk() is early than that. 1188 * 1189 * we have to add boot params by now. 1190 */ 1191 len = addBootConfigParameters((char *)bootargs, strlen(bootargs), 1192 (u64)hdr->ramdisk_addr + hdr->ramdisk_size + 1193 hdr->vendor_ramdisk_size, hdr->vendor_bootconfig_size); 1194 if (len < 0) { 1195 printf("error: addBootConfigParameters\n"); 1196 return 0; 1197 } 1198 1199 nodeoffset = fdt_subnode_offset(fdt, 0, "chosen"); 1200 if (nodeoffset < 0) { 1201 printf("error: No /chosen node\n"); 1202 return 0; 1203 } 1204 1205 /* fixup initrd with real value */ 1206 fdt_delprop(fdt, nodeoffset, "linux,initrd-start"); 1207 fdt_delprop(fdt, nodeoffset, "linux,initrd-end"); 1208 1209 is_u64 = (fdt_address_cells(fdt, 0) == 2); 1210 initrd_start = hdr->ramdisk_addr; 1211 initrd_end = initrd_start + hdr->ramdisk_size + 1212 hdr->vendor_ramdisk_size + 1213 hdr->vendor_bootconfig_size + len; 1214 err = fdt_setprop_uxx(fdt, nodeoffset, "linux,initrd-start", 1215 initrd_start, is_u64); 1216 if (err < 0) { 1217 printf("WARNING: could not set linux,initrd-start %s.\n", 1218 fdt_strerror(err)); 1219 return 0; 1220 } 1221 err = fdt_setprop_uxx(fdt, nodeoffset, "linux,initrd-end", 1222 initrd_end, is_u64); 1223 if (err < 0) { 1224 printf("WARNING: could not set linux,initrd-end %s.\n", 1225 fdt_strerror(err)); 1226 return 0; 1227 } 1228 #endif 1229 return 1; 1230 } 1231 1232