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