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 <version.h> 9 #include <abuf.h> 10 #include <amp.h> 11 #include <android_ab.h> 12 #include <android_bootloader.h> 13 #include <android_image.h> 14 #include <bidram.h> 15 #include <boot_rkimg.h> 16 #include <cli.h> 17 #include <clk.h> 18 #include <console.h> 19 #include <debug_uart.h> 20 #include <dm.h> 21 #include <dvfs.h> 22 #include <fdt_support.h> 23 #include <io-domain.h> 24 #include <image.h> 25 #include <key.h> 26 #include <memblk.h> 27 #include <misc.h> 28 #include <of_live.h> 29 #include <mtd_blk.h> 30 #include <ram.h> 31 #include <rng.h> 32 #include <rockchip_debugger.h> 33 #include <syscon.h> 34 #include <sysmem.h> 35 #include <video_rockchip.h> 36 #include <xbc.h> 37 #include <asm/io.h> 38 #include <asm/gpio.h> 39 #include <android_avb/rk_avb_ops_user.h> 40 #include <dm/uclass-internal.h> 41 #include <dm/root.h> 42 #include <power/charge_display.h> 43 #include <power/regulator.h> 44 #include <optee_include/OpteeClientInterface.h> 45 #include <optee_include/OpteeClientApiLib.h> 46 #include <optee_include/tee_api_defines.h> 47 #include <asm/arch/boot_mode.h> 48 #include <asm/arch/clock.h> 49 #include <asm/arch/cpu.h> 50 #include <asm/arch/hotkey.h> 51 #include <asm/arch/param.h> 52 #include <asm/arch/periph.h> 53 #include <asm/arch/resource_img.h> 54 #include <asm/arch/rk_atags.h> 55 #include <asm/arch/vendor.h> 56 #ifdef CONFIG_ROCKCHIP_EINK_DISPLAY 57 #include <rk_eink.h> 58 #endif 59 #ifdef CONFIG_ROCKCHIP_MINIDUMP 60 #include <rk_mini_dump.h> 61 #endif 62 63 #ifdef CONFIG_ARM64 64 static ulong orig_images_ep; 65 #endif 66 67 __weak int rk_board_late_init(void) 68 { 69 return 0; 70 } 71 72 __weak int rk_board_fdt_fixup(void *blob) 73 { 74 return 0; 75 } 76 77 __weak int rk_board_dm_fdt_fixup(void *blob) 78 { 79 return 0; 80 } 81 82 __weak int soc_id_init(void) 83 { 84 return 0; 85 } 86 87 __weak int soc_clk_dump(void) 88 { 89 return 0; 90 } 91 92 __weak int set_armclk_rate(void) 93 { 94 return 0; 95 } 96 97 __weak int rk_board_init(void) 98 { 99 return 0; 100 } 101 102 #ifdef CONFIG_ROCKCHIP_SET_ETHADDR 103 /* 104 * define serialno max length, the max length is 512 Bytes 105 * The remaining bytes are used to ensure that the first 512 bytes 106 * are valid when executing 'env_set("serial#", value)'. 107 */ 108 #define VENDOR_SN_MAX 513 109 #define CPUID_LEN 0x10 110 111 #define MAX_ETHERNET 0x2 112 113 static int rockchip_set_ethaddr(void) 114 { 115 __maybe_unused bool need_write = false; 116 bool randomed = false; 117 char buf[ARP_HLEN_ASCII + 1], mac[16]; 118 u8 ethaddr[ARP_HLEN * MAX_ETHERNET] = {0}; 119 int i, ret = -EINVAL; 120 121 #ifdef CONFIG_ROCKCHIP_VENDOR_PARTITION 122 ret = vendor_storage_read(LAN_MAC_ID, ethaddr, sizeof(ethaddr)); 123 #endif 124 for (i = 0; i < MAX_ETHERNET; i++) { 125 if (ret <= 0 || !is_valid_ethaddr(ðaddr[i * ARP_HLEN])) { 126 if (!randomed) { 127 net_random_ethaddr(ðaddr[i * ARP_HLEN]); 128 randomed = true; 129 } else { 130 if (i > 0) { 131 memcpy(ðaddr[i * ARP_HLEN], 132 ðaddr[(i - 1) * ARP_HLEN], 133 ARP_HLEN); 134 ethaddr[i * ARP_HLEN] |= 0x02; 135 ethaddr[i * ARP_HLEN] += (i << 2); 136 } 137 } 138 139 need_write = true; 140 } 141 142 if (is_valid_ethaddr(ðaddr[i * ARP_HLEN])) { 143 snprintf(buf, ARP_HLEN_ASCII + 1, "%pM", ðaddr[i * ARP_HLEN]); 144 if (i == 0) 145 memcpy(mac, "ethaddr", sizeof("ethaddr")); 146 else 147 sprintf(mac, "eth%daddr", i); 148 env_set(mac, buf); 149 } 150 } 151 152 #ifdef CONFIG_ROCKCHIP_VENDOR_PARTITION 153 if (need_write) { 154 ret = vendor_storage_write(LAN_MAC_ID, 155 ethaddr, sizeof(ethaddr)); 156 if (ret < 0) 157 printf("%s: vendor_storage_write failed %d\n", 158 __func__, ret); 159 } 160 #endif 161 return 0; 162 } 163 #endif 164 165 #ifdef CONFIG_ROCKCHIP_SET_SN 166 static int rockchip_set_serialno(void) 167 { 168 u8 low[CPUID_LEN / 2], high[CPUID_LEN / 2]; 169 u8 cpuid[CPUID_LEN] = {0}; 170 char serialno_str[VENDOR_SN_MAX]; 171 int ret = 0, i; 172 u64 serialno; 173 174 /* Read serial number from vendor storage part */ 175 memset(serialno_str, 0, VENDOR_SN_MAX); 176 177 #ifdef CONFIG_ROCKCHIP_VENDOR_PARTITION 178 int j; 179 180 ret = vendor_storage_read(SN_ID, serialno_str, (VENDOR_SN_MAX-1)); 181 if (ret > 0) { 182 j = strlen(serialno_str); 183 for (i = 0; i < j; i++) { 184 if ((serialno_str[i] >= 'a' && serialno_str[i] <= 'z') || 185 (serialno_str[i] >= 'A' && serialno_str[i] <= 'Z') || 186 (serialno_str[i] >= '0' && serialno_str[i] <= '9')) { 187 continue; 188 } else { 189 if (i > 0) 190 serialno_str[i] = 0x0; 191 break; 192 } 193 } 194 195 /* valid character count > 0 */ 196 if (i > 0) { 197 serialno_str[i + 1] = 0x0; 198 env_set("serial#", serialno_str); 199 } 200 } 201 #endif 202 if (!env_get("serial#")) { 203 #if defined(CONFIG_ROCKCHIP_EFUSE) || defined(CONFIG_ROCKCHIP_OTP) 204 struct udevice *dev; 205 206 /* retrieve the device */ 207 if (IS_ENABLED(CONFIG_ROCKCHIP_EFUSE)) 208 ret = uclass_get_device_by_driver(UCLASS_MISC, 209 DM_GET_DRIVER(rockchip_efuse), 210 &dev); 211 else 212 ret = uclass_get_device_by_driver(UCLASS_MISC, 213 DM_GET_DRIVER(rockchip_otp), 214 &dev); 215 216 if (ret) { 217 printf("%s: could not find efuse/otp device\n", __func__); 218 return ret; 219 } 220 221 /* read the cpu_id range from the efuses */ 222 ret = misc_read(dev, CFG_CPUID_OFFSET, &cpuid, sizeof(cpuid)); 223 if (ret) { 224 printf("%s: read cpuid from efuse/otp failed, ret=%d\n", 225 __func__, ret); 226 return ret; 227 } 228 #else 229 /* generate random cpuid */ 230 for (i = 0; i < CPUID_LEN; i++) 231 cpuid[i] = (u8)(rand()); 232 #endif 233 /* Generate the serial number based on CPU ID */ 234 for (i = 0; i < 8; i++) { 235 low[i] = cpuid[1 + (i << 1)]; 236 high[i] = cpuid[i << 1]; 237 } 238 239 serialno = crc32_no_comp(0, low, 8); 240 serialno |= (u64)crc32_no_comp(serialno, high, 8) << 32; 241 snprintf(serialno_str, sizeof(serialno_str), "%llx", serialno); 242 243 env_set("serial#", serialno_str); 244 } 245 246 return ret; 247 } 248 #endif 249 250 #if defined(CONFIG_USB_FUNCTION_FASTBOOT) 251 int fb_set_reboot_flag(void) 252 { 253 printf("Setting reboot to fastboot flag ...\n"); 254 writel(BOOT_FASTBOOT, CONFIG_ROCKCHIP_BOOT_MODE_REG); 255 256 return 0; 257 } 258 #endif 259 260 #ifdef CONFIG_ROCKCHIP_USB_BOOT 261 static int boot_from_udisk(void) 262 { 263 struct blk_desc *desc; 264 struct udevice *dev; 265 void *fdt_addr; 266 u32 fdt_size; 267 int devnum = -1; 268 char buf[32]; 269 270 /* Booting priority: mmc1 > udisk */ 271 if (!strcmp(env_get("devtype"), "mmc") && !strcmp(env_get("devnum"), "1")) 272 return 0; 273 274 if (!run_command("usb start", -1)) { 275 for (blk_first_device(IF_TYPE_USB, &dev); 276 dev; 277 blk_next_device(&dev)) { 278 desc = dev_get_uclass_platdata(dev); 279 printf("Scanning usb %d ...\n", desc->devnum); 280 if (desc->type == DEV_TYPE_UNKNOWN) 281 continue; 282 283 if (desc->lba > 0L && desc->blksz > 0L) { 284 devnum = desc->devnum; 285 break; 286 } 287 } 288 if (devnum < 0) { 289 printf("No usb mass storage found\n"); 290 return -ENODEV; 291 } 292 293 desc = blk_get_devnum_by_type(IF_TYPE_USB, devnum); 294 if (!desc) { 295 printf("No usb %d found\n", devnum); 296 return -ENODEV; 297 } 298 299 snprintf(buf, 32, "rkimgtest usb %d", devnum); 300 if (!run_command(buf, -1)) { 301 snprintf(buf, 32, "%d", devnum); 302 rockchip_set_bootdev(desc); 303 env_set("devtype", "usb"); 304 env_set("devnum", buf); 305 printf("=== Booting from usb %d ===\n", devnum); 306 307 /* 308 * If current kernel dtb is not from embedded dtb: 309 * 310 * Use 'gd->fdt_blob_kern' to reload the kernel dtb 311 * from current bootdev(udisk) in the late bootflow. 312 */ 313 if (!gd->fdt_blob_kern) { 314 fdt_size = fdt_totalsize(gd->fdt_blob); 315 fdt_addr = memalign(ARCH_DMA_MINALIGN, fdt_size); 316 if (!fdt_addr) 317 return -ENOMEM; 318 319 /* destroy kernel dtb and resource list */ 320 memcpy(fdt_addr, gd->fdt_blob, fdt_size); 321 fdt_set_magic((void *)gd->fdt_blob, ~0); 322 sysmem_free((phys_addr_t)gd->fdt_blob); 323 resource_destroy(); 324 325 gd->fdt_blob_kern = fdt_addr; 326 gd->fdt_blob = fdt_addr; 327 } 328 } else { 329 printf("No available udisk image on usb %d\n", devnum); 330 return -ENODEV; 331 } 332 } 333 334 return 0; 335 } 336 #endif 337 338 static void env_fixup(void) 339 { 340 struct memblock mem; 341 ulong u_addr_r; 342 phys_size_t end; 343 char *addr_r; 344 345 #ifdef ENV_MEM_LAYOUT_SETTINGS1 346 const char *env_addr0[] = { 347 "scriptaddr", "pxefile_addr_r", 348 "fdt_addr_r", "kernel_addr_r", "kernel_addr_c", "ramdisk_addr_r", 349 }; 350 const char *env_addr1[] = { 351 "scriptaddr1", "pxefile_addr1_r", 352 "fdt_addr1_r", "kernel_addr1_r", "kernel_addr1_c", "ramdisk_addr1_r", 353 }; 354 int i; 355 356 /* 128M is a typical ram size for most platform, so as default here */ 357 if (gd->ram_size <= SZ_128M) { 358 /* Replace orignal xxx_addr_r */ 359 for (i = 0; i < ARRAY_SIZE(env_addr1); i++) { 360 addr_r = env_get(env_addr1[i]); 361 if (addr_r) 362 env_set(env_addr0[i], addr_r); 363 } 364 } 365 #endif 366 /* No BL32 ? */ 367 if (!(gd->flags & GD_FLG_BL32_ENABLED)) { 368 /* 369 * [1] Move kernel to lower address if possible. 370 */ 371 addr_r = env_get("kernel_addr_no_low_bl32_r"); 372 if (addr_r) 373 env_set("kernel_addr_r", addr_r); 374 375 /* 376 * [2] Move ramdisk at BL32 position if need. 377 * 378 * 0x0a200000 and 0x08400000 are rockchip traditional address 379 * of BL32 and ramdisk: 380 * 381 * |------------|------------| 382 * | BL32 | ramdisk | 383 * |------------|------------| 384 * 385 * Move ramdisk to BL32 address to fix sysmem alloc failed 386 * issue on the board with critical memory(ie. 256MB). 387 */ 388 if (gd->ram_size > SZ_128M && gd->ram_size <= SZ_256M) { 389 u_addr_r = env_get_ulong("ramdisk_addr_r", 16, 0); 390 if (u_addr_r == 0x0a200000) 391 env_set("ramdisk_addr_r", "0x08400000"); 392 } 393 } else { 394 mem = param_parse_optee_mem(); 395 396 /* 397 * [1] Move kernel forward if possible. 398 */ 399 if (mem.base > SZ_128M) { 400 addr_r = env_get("kernel_addr_no_low_bl32_r"); 401 if (addr_r) 402 env_set("kernel_addr_r", addr_r); 403 } 404 405 /* 406 * [2] Move ramdisk backward if optee enlarge. 407 */ 408 end = mem.base + mem.size; 409 u_addr_r = env_get_ulong("ramdisk_addr_r", 16, 0); 410 if (u_addr_r >= mem.base && u_addr_r < end) 411 env_set_hex("ramdisk_addr_r", end); 412 } 413 } 414 415 static void cmdline_handle(void) 416 { 417 struct blk_desc *dev_desc; 418 int if_type; 419 int devnum; 420 421 param_parse_pubkey_fuse_programmed(); 422 423 dev_desc = rockchip_get_bootdev(); 424 if (!dev_desc) 425 return; 426 427 /* 428 * 1. From rk356x, the sd/udisk recovery update flag was moved from 429 * IDB to Android BCB. 430 * 431 * 2. Udisk is init at the late boot_from_udisk(), but 432 * rockchip_get_boot_mode() actually only read once, 433 * we need to update boot mode according to udisk BCB. 434 */ 435 if_type = dev_desc->if_type; 436 devnum = dev_desc->devnum; 437 if ((if_type == IF_TYPE_MMC && devnum == 1) || (if_type == IF_TYPE_USB)) { 438 if (get_bcb_recovery_msg() == BCB_MSG_RECOVERY_RK_FWUPDATE) { 439 if (if_type == IF_TYPE_MMC && devnum == 1) { 440 env_update("bootargs", "sdfwupdate"); 441 } else if (if_type == IF_TYPE_USB) { 442 env_update("bootargs", "usbfwupdate"); 443 env_set("reboot_mode", "recovery-usb"); 444 } 445 } else { 446 if (if_type == IF_TYPE_USB) 447 env_set("reboot_mode", "normal"); 448 } 449 } 450 451 if (rockchip_get_boot_mode() == BOOT_MODE_QUIESCENT) 452 env_update("bootargs", "androidboot.quiescent=1 pwm_bl.quiescent=1"); 453 } 454 455 static void scan_run_cmd(void) 456 { 457 char *config = CONFIG_ROCKCHIP_CMD; 458 char *cmd, *key; 459 460 key = strchr(config, ' '); 461 if (!key) 462 return; 463 464 cmd = strdup(config); 465 cmd[key - config] = 0; 466 key++; 467 468 if (!strcmp(key, "-")) { 469 run_command(cmd, 0); 470 } else { 471 #ifdef CONFIG_DM_KEY 472 ulong map; 473 474 map = simple_strtoul(key, NULL, 10); 475 if (key_is_pressed(key_read(map))) { 476 printf("## Key<%ld> pressed... run cmd '%s'\n", map, cmd); 477 run_command(cmd, 0); 478 } 479 #endif 480 } 481 } 482 483 int board_late_init(void) 484 { 485 #ifdef CONFIG_ROCKCHIP_SET_ETHADDR 486 rockchip_set_ethaddr(); 487 #endif 488 #ifdef CONFIG_ROCKCHIP_SET_SN 489 rockchip_set_serialno(); 490 #endif 491 setup_download_mode(); 492 scan_run_cmd(); 493 #ifdef CONFIG_ROCKCHIP_USB_BOOT 494 boot_from_udisk(); 495 #endif 496 #ifdef CONFIG_DM_CHARGE_DISPLAY 497 charge_display(); 498 #endif 499 500 #ifdef CONFIG_ROCKCHIP_MINIDUMP 501 rk_minidump_init(); 502 #endif 503 504 #ifdef CONFIG_DRM_ROCKCHIP 505 if ((rockchip_get_boot_mode() != BOOT_MODE_QUIESCENT) && 506 !smp_event1(SEVT_3, STID_16)) 507 rockchip_show_logo(); 508 #endif 509 510 #ifdef CONFIG_ROCKCHIP_EINK_DISPLAY 511 rockchip_eink_show_uboot_logo(); 512 #endif 513 #if (CONFIG_ROCKCHIP_BOOT_MODE_REG > 0) 514 setup_boot_mode(); 515 #endif 516 env_fixup(); 517 soc_clk_dump(); 518 cmdline_handle(); 519 #ifdef CONFIG_AMP 520 amp_cpus_on(); 521 #endif 522 return rk_board_late_init(); 523 } 524 525 static void early_download(void) 526 { 527 #if defined(CONFIG_PWRKEY_DNL_TRIGGER_NUM) && \ 528 (CONFIG_PWRKEY_DNL_TRIGGER_NUM > 0) 529 if (pwrkey_download_init()) 530 printf("Pwrkey download init failed\n"); 531 #endif 532 533 #if (CONFIG_ROCKCHIP_BOOT_MODE_REG > 0) 534 if (is_hotkey(HK_BROM_DNL)) { 535 printf("Enter bootrom download..."); 536 flushc(); 537 writel(BOOT_BROM_DOWNLOAD, CONFIG_ROCKCHIP_BOOT_MODE_REG); 538 do_reset(NULL, 0, 0, NULL); 539 printf("failed!\n"); 540 } 541 #endif 542 } 543 544 static void board_debug_init(void) 545 { 546 if (!gd->serial.using_pre_serial && 547 !(gd->flags & GD_FLG_DISABLE_CONSOLE)) 548 debug_uart_init(); 549 550 if (tstc()) { 551 gd->console_evt = getc(); 552 if (gd->console_evt <= 0x1a) /* 'z' */ 553 printf("Hotkey: ctrl+%c\n", gd->console_evt + 'a' - 1); 554 } 555 556 if (IS_ENABLED(CONFIG_CONSOLE_DISABLE_CLI)) 557 printf("Cmd interface: disabled\n"); 558 } 559 560 int board_init(void) 561 { 562 smp_event1(SEVT_0, 0); 563 564 board_debug_init(); 565 #ifdef DEBUG 566 soc_clk_dump(); 567 #endif 568 #ifdef CONFIG_OPTEE_CLIENT 569 optee_client_init(); 570 #endif 571 #ifdef CONFIG_USING_KERNEL_DTB 572 init_kernel_dtb(); 573 #endif 574 early_download(); 575 576 clks_probe(); 577 578 #ifdef CONFIG_DM_REGULATOR 579 if (smp_event1(SEVT_3, STID_18)) 580 smp_event1(SEVT_1, STID_18); 581 else 582 regulators_enable_boot_on(is_hotkey(HK_REGULATOR)); 583 #endif 584 #ifdef CONFIG_ROCKCHIP_IO_DOMAIN 585 io_domain_init(); 586 #endif 587 set_armclk_rate(); 588 #ifdef CONFIG_DM_DVFS 589 dvfs_init(true); 590 #endif 591 #ifdef CONFIG_ANDROID_AB 592 if (ab_decrease_tries()) 593 printf("Decrease ab tries count fail!\n"); 594 #endif 595 soc_id_init(); 596 597 return rk_board_init(); 598 } 599 600 int interrupt_debugger_init(void) 601 { 602 #ifdef CONFIG_ROCKCHIP_DEBUGGER 603 return rockchip_debugger_init(); 604 #else 605 return 0; 606 #endif 607 } 608 609 #ifdef CONFIG_SANITY_CPU_SWAP 610 static void sanity_cpu_swap(void *blob) 611 { 612 int cpus_offset; 613 int noffset; 614 ulong mpidr; 615 ulong reg; 616 617 cpus_offset = fdt_path_offset(blob, "/cpus"); 618 if (cpus_offset < 0) 619 return; 620 621 for (noffset = fdt_first_subnode(blob, cpus_offset); 622 noffset >= 0; 623 noffset = fdt_next_subnode(blob, noffset)) { 624 const struct fdt_property *prop; 625 int len; 626 627 prop = fdt_get_property(blob, noffset, "device_type", &len); 628 if (!prop) 629 continue; 630 if (len < 4) 631 continue; 632 if (strcmp(prop->data, "cpu")) 633 continue; 634 635 /* only sanity first cpu */ 636 reg = (ulong)fdtdec_get_addr_size_auto_parent(blob, cpus_offset, noffset, 637 "reg", 0, NULL, false); 638 mpidr = read_mpidr() & 0xfff; 639 if ((mpidr & reg) != reg) { 640 printf("CPU swap error: Loader and Kernel firmware mismatch! " 641 "Current cpu0 \"reg\" is 0x%lx but kernel dtb requires 0x%lx\n", 642 mpidr, reg); 643 run_command("download", 0); 644 } 645 return; 646 } 647 } 648 #endif 649 650 static int rockchip_dm_late_init(void *blob) 651 { 652 struct udevice *dev; 653 654 /* Prepare for board_rng_seed(), dryrun and ignore result */ 655 if (IS_ENABLED(CONFIG_BOARD_RNG_SEED) && IS_ENABLED(CONFIG_DM_RNG)) 656 uclass_get_device(UCLASS_RNG, 0, &dev); 657 658 return 0; 659 } 660 661 int board_fdt_fixup(void *blob) 662 { 663 #ifdef CONFIG_SANITY_CPU_SWAP 664 sanity_cpu_swap(blob); 665 #endif 666 /* 667 * Device's platdata points to orignal fdt blob property, 668 * access DM device before any fdt fixup. 669 * 670 * Do board specific init and common init. 671 */ 672 rk_board_dm_fdt_fixup(blob); 673 rockchip_dm_late_init(blob); 674 675 smp_event1(SEVT_2, STID_16); 676 677 /* Common fixup for DRM */ 678 #ifdef CONFIG_DRM_ROCKCHIP 679 rockchip_display_fixup(blob); 680 #endif 681 682 #ifdef CONFIG_ROCKCHIP_VENDOR_PARTITION 683 vendor_storage_fixup(blob); 684 #endif 685 686 return rk_board_fdt_fixup(blob); 687 } 688 689 #if defined(CONFIG_ARM64_BOOT_AARCH32) || !defined(CONFIG_ARM64) 690 /* 691 * Common for OP-TEE: 692 * 64-bit & 32-bit mode: share memory dcache is always enabled; 693 * 694 * Common for U-Boot: 695 * 64-bit mode: MMU table is static defined in rkxxx.c file, all memory 696 * regions are mapped. That's good to match OP-TEE MMU policy. 697 * 698 * 32-bit mode: MMU table is setup according to gd->bd->bi_dram[..] where 699 * the OP-TEE region has been reserved, so it can not be 700 * mapped(i.e. dcache is disabled). That's *NOT* good to match 701 * OP-TEE MMU policy. 702 * 703 * For the data coherence when communication between U-Boot and OP-TEE, U-Boot 704 * should follow OP-TEE MMU policy. 705 * 706 * So 32-bit mode U-Boot should map OP-TEE share memory as dcache enabled. 707 */ 708 int board_initr_caches_fixup(void) 709 { 710 #ifdef CONFIG_OPTEE_CLIENT 711 struct memblock mem; 712 713 mem.base = 0; 714 mem.size = 0; 715 716 optee_get_shm_config(&mem.base, &mem.size); 717 if (mem.size) 718 mmu_set_region_dcache_behaviour(mem.base, mem.size, 719 DCACHE_WRITEBACK); 720 #endif 721 return 0; 722 } 723 #endif 724 725 void arch_preboot_os(uint32_t bootm_state, bootm_headers_t *images) 726 { 727 if (!(bootm_state & BOOTM_STATE_OS_PREP)) 728 return; 729 730 #ifdef CONFIG_ARM64 731 u8 *data = (void *)images->ep; 732 733 /* 734 * Fix kernel 5.10 arm64 boot warning: 735 * "[Firmware Bug]: Kernel image misaligned at boot, please fix your bootloader!" 736 * 737 * kernel: 5.10 commit 120dc60d0bdb ("arm64: get rid of TEXT_OFFSET") 738 * arm64 kernel version: 739 * data[10] == 0x00 if kernel version >= 5.10: N*2MB align 740 * data[10] == 0x08 if kernel version < 5.10: N*2MB + 0x80000(TEXT_OFFSET) 741 * 742 * Why fix here? 743 * 1. this is the common and final path for any boot command. 744 * 2. don't influence original boot flow, just fix it exactly before 745 * jumping kernel. 746 * 747 * But relocation is in board_quiesce_devices() until all decompress 748 * done, mainly for saving boot time. 749 */ 750 751 orig_images_ep = images->ep; 752 753 if (data[10] == 0x00) { 754 if (round_down(images->ep, SZ_2M) != images->ep) 755 images->ep = round_down(images->ep, SZ_2M); 756 } else { 757 if (IS_ALIGNED(images->ep, SZ_2M)) 758 images->ep += 0x80000; 759 } 760 #endif 761 hotkey_run(HK_CLI_OS_PRE); 762 } 763 764 void enable_caches(void) 765 { 766 icache_enable(); 767 dcache_enable(); 768 } 769 770 #ifdef CONFIG_LMB 771 /* 772 * Using last bi_dram[...] to initialize "bootm_low" and "bootm_mapsize". 773 * This makes lmb_alloc_base() always alloc from tail of sdram. 774 * If we don't assign it, bi_dram[0] is used by default and it may cause 775 * lmb_alloc_base() fail when bi_dram[0] range is small. 776 */ 777 void board_lmb_reserve(struct lmb *lmb) 778 { 779 char bootm_mapsize[32]; 780 char bootm_low[32]; 781 u64 start, size; 782 int i; 783 784 for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) { 785 if (!gd->bd->bi_dram[i].size) 786 break; 787 } 788 789 start = gd->bd->bi_dram[i - 1].start; 790 size = gd->bd->bi_dram[i - 1].size; 791 792 /* 793 * 32-bit kernel: ramdisk/fdt shouldn't be loaded to highmem area(768MB+), 794 * otherwise "Unable to handle kernel paging request at virtual address ...". 795 * 796 * So that we hope limit highest address at 768M, but there comes the the 797 * problem: ramdisk is a compressed image and it expands after descompress, 798 * so it accesses 768MB+ and brings the above "Unable to handle kernel ...". 799 * 800 * We make a appointment that the highest memory address is 512MB, it 801 * makes lmb alloc safer. 802 */ 803 #ifndef CONFIG_ARM64 804 if (start >= ((u64)CONFIG_SYS_SDRAM_BASE + SZ_512M)) { 805 start = gd->bd->bi_dram[i - 2].start; 806 size = gd->bd->bi_dram[i - 2].size; 807 } 808 809 if ((start + size) > ((u64)CONFIG_SYS_SDRAM_BASE + SZ_512M)) 810 size = (u64)CONFIG_SYS_SDRAM_BASE + SZ_512M - start; 811 #endif 812 sprintf(bootm_low, "0x%llx", start); 813 sprintf(bootm_mapsize, "0x%llx", size); 814 env_set("bootm_low", bootm_low); 815 env_set("bootm_mapsize", bootm_mapsize); 816 } 817 #endif 818 819 #ifdef CONFIG_BIDRAM 820 int board_bidram_reserve(struct bidram *bidram) 821 { 822 struct memblock mem; 823 int ret; 824 825 /* ATF */ 826 mem = param_parse_atf_mem(); 827 ret = bidram_reserve(MEM_ATF, mem.base, mem.size); 828 if (ret) 829 return ret; 830 831 /* PSTORE/ATAGS/SHM */ 832 mem = param_parse_common_resv_mem(); 833 ret = bidram_reserve(MEM_SHM, mem.base, mem.size); 834 if (ret) 835 return ret; 836 837 /* OP-TEE */ 838 mem = param_parse_optee_mem(); 839 ret = bidram_reserve(MEM_OPTEE, mem.base, mem.size); 840 if (ret) 841 return ret; 842 843 return 0; 844 } 845 846 #ifdef CONFIG_SYSMEM 847 int board_sysmem_reserve(struct sysmem *sysmem) 848 { 849 #ifdef CONFIG_SKIP_RELOCATE_UBOOT 850 if (!sysmem_alloc_base_by_name("NO-RELOC-CODE", 851 CONFIG_SYS_TEXT_BASE, SZ_2M)) { 852 printf("Failed to reserve sysmem for U-Boot code\n"); 853 return -ENOMEM; 854 } 855 #endif 856 return 0; 857 } 858 #endif 859 860 parse_fn_t board_bidram_parse_fn(void) 861 { 862 return param_parse_ddr_mem; 863 } 864 #endif 865 866 int board_init_f_boot_flags(void) 867 { 868 int boot_flags = 0; 869 870 #ifdef CONFIG_ARM64 871 asm volatile("mrs %0, cntfrq_el0" : "=r" (gd->arch.timer_rate_hz)); 872 #else 873 asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (gd->arch.timer_rate_hz)); 874 #endif 875 876 #if CONFIG_IS_ENABLED(FPGA_ROCKCHIP) 877 arch_fpga_init(); 878 #endif 879 #ifdef CONFIG_PSTORE 880 param_parse_pstore(); 881 #endif 882 param_parse_pre_serial(&boot_flags); 883 884 /* The highest priority to turn off (override) console */ 885 #if defined(CONFIG_DISABLE_CONSOLE) 886 boot_flags |= GD_FLG_DISABLE_CONSOLE; 887 #endif 888 889 return boot_flags; 890 } 891 892 #if defined(CONFIG_USB_GADGET) 893 #include <usb.h> 894 #if defined(CONFIG_USB_GADGET_DWC2_OTG) 895 #include <fdt_support.h> 896 #include <usb/dwc2_udc.h> 897 898 static struct dwc2_plat_otg_data otg_data = { 899 .rx_fifo_sz = 512, 900 .np_tx_fifo_sz = 16, 901 .tx_fifo_sz = 128, 902 }; 903 904 int board_usb_init(int index, enum usb_init_type init) 905 { 906 const void *blob = gd->fdt_blob; 907 const fdt32_t *reg; 908 fdt_addr_t addr; 909 int node; 910 911 /* find the usb_otg node */ 912 node = fdt_node_offset_by_compatible(blob, -1, "snps,dwc2"); 913 914 retry: 915 if (node > 0) { 916 reg = fdt_getprop(blob, node, "reg", NULL); 917 if (!reg) 918 return -EINVAL; 919 920 addr = fdt_translate_address(blob, node, reg); 921 if (addr == OF_BAD_ADDR) { 922 pr_err("Not found usb_otg address\n"); 923 return -EINVAL; 924 } 925 926 #if defined(CONFIG_ROCKCHIP_RK3288) 927 if (addr != 0xff580000) { 928 node = fdt_node_offset_by_compatible(blob, node, 929 "snps,dwc2"); 930 goto retry; 931 } 932 #endif 933 } else { 934 /* 935 * With kernel dtb support, rk3288 dwc2 otg node 936 * use the rockchip legacy dwc2 driver "dwc_otg_310" 937 * with the compatible "rockchip,rk3288_usb20_otg", 938 * and rk3368 also use the "dwc_otg_310" driver with 939 * the compatible "rockchip,rk3368-usb". 940 */ 941 #if defined(CONFIG_ROCKCHIP_RK3288) 942 node = fdt_node_offset_by_compatible(blob, -1, 943 "rockchip,rk3288_usb20_otg"); 944 #elif defined(CONFIG_ROCKCHIP_RK3368) 945 node = fdt_node_offset_by_compatible(blob, -1, 946 "rockchip,rk3368-usb"); 947 #endif 948 if (node > 0) { 949 goto retry; 950 } else { 951 pr_err("Not found usb_otg device\n"); 952 return -ENODEV; 953 } 954 } 955 956 otg_data.regs_otg = (uintptr_t)addr; 957 958 return dwc2_udc_probe(&otg_data); 959 } 960 961 int board_usb_cleanup(int index, enum usb_init_type init) 962 { 963 return 0; 964 } 965 #elif defined(CONFIG_USB_DWC3_GADGET) /* CONFIG_USB_GADGET_DWC2_OTG */ 966 #include <dwc3-uboot.h> 967 968 int board_usb_cleanup(int index, enum usb_init_type init) 969 { 970 dwc3_uboot_exit(index); 971 return 0; 972 } 973 974 #endif /* CONFIG_USB_DWC3_GADGET */ 975 #endif /* CONFIG_USB_GADGET */ 976 977 static void bootm_no_reloc(void) 978 { 979 char *ramdisk_high; 980 char *fdt_high; 981 982 if (!env_get_yesno("bootm-no-reloc")) 983 return; 984 985 ramdisk_high = env_get("initrd_high"); 986 fdt_high = env_get("fdt_high"); 987 988 if (!fdt_high) { 989 env_set_hex("fdt_high", -1UL); 990 printf("Fdt "); 991 } 992 993 if (!ramdisk_high) { 994 env_set_hex("initrd_high", -1UL); 995 printf("Ramdisk "); 996 } 997 998 if (!fdt_high || !ramdisk_high) 999 printf("skip relocation\n"); 1000 } 1001 1002 int bootm_board_start(void) 1003 { 1004 /* 1005 * print console record data 1006 * 1007 * On some rockchip platforms, uart debug and sdmmc pin are multiplex. 1008 * If boot from sdmmc mode, the console data would be record in buffer, 1009 * we switch to uart debug function in order to print it after loading 1010 * images. 1011 */ 1012 #if 0 1013 if (!strcmp("mmc", env_get("devtype")) && 1014 !strcmp("1", env_get("devnum"))) { 1015 printf("IOMUX: sdmmc => uart debug"); 1016 pinctrl_select_state(gd->cur_serial_dev, "default"); 1017 console_record_print_purge(); 1018 } 1019 #endif 1020 /* disable bootm relcation to save boot time */ 1021 bootm_no_reloc(); 1022 1023 /* PCBA test needs more permission */ 1024 if (get_bcb_recovery_msg() == BCB_MSG_RECOVERY_PCBA) 1025 env_update("bootargs", "androidboot.selinux=permissive"); 1026 1027 /* sysmem */ 1028 hotkey_run(HK_SYSMEM); 1029 sysmem_overflow_check(); 1030 1031 return 0; 1032 } 1033 1034 int bootm_image_populate_dtb(void *img) 1035 { 1036 if ((gd->flags & GD_FLG_KDTB_READY) && !gd->fdt_blob_kern) 1037 sysmem_free((phys_addr_t)gd->fdt_blob); 1038 else 1039 gd->fdt_blob = (void *)env_get_ulong("fdt_addr_r", 16, 0); 1040 1041 return rockchip_ram_read_dtb_file(img, (void *)gd->fdt_blob); 1042 } 1043 1044 /* 1045 * Implement it to support CLI command: 1046 * - Android: bootm [aosp addr] 1047 * - FIT: bootm [fit addr] 1048 * - uImage: bootm [uimage addr] 1049 * 1050 * Purpose: 1051 * - The original bootm command args require fdt addr on AOSP, 1052 * which is not flexible on rockchip boot/recovery.img. 1053 * - Take Android/FIT/uImage image into sysmem management to avoid image 1054 * memory overlap. 1055 */ 1056 #if defined(CONFIG_ANDROID_BOOTLOADER) || \ 1057 defined(CONFIG_ROCKCHIP_FIT_IMAGE) || \ 1058 defined(CONFIG_ROCKCHIP_UIMAGE) 1059 int board_do_bootm(int argc, char * const argv[]) 1060 { 1061 int format; 1062 void *img; 1063 1064 /* only 'bootm' full image goes further */ 1065 if (argc != 2) 1066 return 0; 1067 1068 img = (void *)simple_strtoul(argv[1], NULL, 16); 1069 format = (genimg_get_format(img)); 1070 1071 /* Android */ 1072 #ifdef CONFIG_ANDROID_BOOT_IMAGE 1073 if (format == IMAGE_FORMAT_ANDROID) { 1074 struct andr_img_hdr *hdr; 1075 ulong load_addr; 1076 ulong size; 1077 int ret; 1078 1079 hdr = (struct andr_img_hdr *)img; 1080 printf("BOOTM: transferring to board Android\n"); 1081 1082 load_addr = env_get_ulong("kernel_addr_r", 16, 0); 1083 load_addr -= hdr->page_size; 1084 size = android_image_get_end(hdr) - (ulong)hdr; 1085 1086 if (!sysmem_alloc_base(MEM_ANDROID, (ulong)hdr, size)) 1087 return -ENOMEM; 1088 1089 ret = bootm_image_populate_dtb(img); 1090 if (ret) { 1091 printf("bootm can't read dtb, ret=%d\n", ret); 1092 return ret; 1093 } 1094 1095 ret = android_image_memcpy_separate(hdr, &load_addr); 1096 if (ret) { 1097 printf("board do bootm failed, ret=%d\n", ret); 1098 return ret; 1099 } 1100 1101 return android_bootloader_boot_kernel(load_addr); 1102 } 1103 #endif 1104 1105 /* FIT */ 1106 #if IMAGE_ENABLE_FIT 1107 if (format == IMAGE_FORMAT_FIT) { 1108 char boot_cmd[64]; 1109 int ret; 1110 1111 printf("BOOTM: transferring to board FIT\n"); 1112 1113 ret = bootm_image_populate_dtb(img); 1114 if (ret) { 1115 printf("bootm can't read dtb, ret=%d\n", ret); 1116 return ret; 1117 } 1118 snprintf(boot_cmd, sizeof(boot_cmd), "boot_fit %s", argv[1]); 1119 return run_command(boot_cmd, 0); 1120 } 1121 #endif 1122 1123 /* uImage */ 1124 #if 0 1125 #if defined(CONFIG_IMAGE_FORMAT_LEGACY) 1126 if (format == IMAGE_FORMAT_LEGACY && 1127 image_get_type(img) == IH_TYPE_MULTI) { 1128 char boot_cmd[64]; 1129 1130 printf("BOOTM: transferring to board uImage\n"); 1131 snprintf(boot_cmd, sizeof(boot_cmd), "boot_uimage %s", argv[1]); 1132 return run_command(boot_cmd, 0); 1133 } 1134 #endif 1135 #endif 1136 return 0; 1137 } 1138 #endif 1139 1140 void autoboot_command_fail_handle(void) 1141 { 1142 #ifdef CONFIG_ANDROID_AB 1143 if (rk_avb_ab_have_bootable_slot() == true) 1144 run_command("reset;", 0); 1145 else 1146 run_command("fastboot usb 0;", 0); 1147 #endif 1148 1149 #ifdef CONFIG_AVB_VBMETA_PUBLIC_KEY_VALIDATE 1150 run_command("download", 0); 1151 run_command("fastboot usb 0;", 0); 1152 #endif 1153 1154 } 1155 1156 #ifdef CONFIG_FIT_ROLLBACK_PROTECT 1157 1158 #define FIT_ROLLBACK_INDEX_LOCATION 0x66697472 /* "fitr" */ 1159 1160 int fit_read_otp_rollback_index(uint32_t fit_index, uint32_t *otp_index) 1161 { 1162 #ifdef CONFIG_OPTEE_CLIENT 1163 u64 index; 1164 int ret; 1165 1166 ret = trusty_read_rollback_index(FIT_ROLLBACK_INDEX_LOCATION, &index); 1167 if (ret) { 1168 if (ret != TEE_ERROR_ITEM_NOT_FOUND) 1169 return ret; 1170 1171 index = 0; 1172 printf("Initial otp index as %d\n", fit_index); 1173 } 1174 1175 *otp_index = (uint32_t)index; 1176 #else 1177 *otp_index = 0; 1178 #endif 1179 1180 return 0; 1181 } 1182 1183 int fit_write_trusty_rollback_index(u32 trusty_index) 1184 { 1185 if (!trusty_index) 1186 return 0; 1187 #ifdef CONFIG_OPTEE_CLIENT 1188 return trusty_write_rollback_index(FIT_ROLLBACK_INDEX_LOCATION, 1189 (u64)trusty_index); 1190 #else 1191 return 0; 1192 #endif 1193 } 1194 #endif 1195 1196 void board_quiesce_devices(void *images) 1197 { 1198 #ifdef CONFIG_ROCKCHIP_PRELOADER_ATAGS 1199 /* Destroy atags makes next warm boot safer */ 1200 atags_destroy(); 1201 #endif 1202 #ifdef CONFIG_FIT_ROLLBACK_PROTECT 1203 int ret; 1204 1205 ret = fit_write_trusty_rollback_index(gd->rollback_index); 1206 if (ret) { 1207 panic("Failed to write fit rollback index %d, ret=%d", 1208 gd->rollback_index, ret); 1209 } 1210 #endif 1211 #ifdef CONFIG_ROCKCHIP_HW_DECOMPRESS 1212 misc_decompress_cleanup(); 1213 #endif 1214 #ifdef CONFIG_ARM64 1215 bootm_headers_t *bootm_images = (bootm_headers_t *)images; 1216 1217 /* relocate kernel after decompress cleanup */ 1218 if (orig_images_ep && orig_images_ep != bootm_images->ep) { 1219 memmove((char *)bootm_images->ep, (const char *)orig_images_ep, 1220 bootm_images->os.image_len); 1221 printf("== DO RELOCATE == Kernel from 0x%08lx to 0x%08lx\n", 1222 orig_images_ep, bootm_images->ep); 1223 } 1224 #endif 1225 smp_event1(SEVT_0, -1); 1226 1227 hotkey_run(HK_CMDLINE); 1228 hotkey_run(HK_CLI_OS_GO); 1229 #ifdef CONFIG_ROCKCHIP_REBOOT_TEST 1230 do_reset(NULL, 0, 0, NULL); 1231 #endif 1232 } 1233 1234 /* 1235 * Use hardware rng to seed Linux random 1236 * 1237 * 'Android_14 + GKI' requires this information. 1238 */ 1239 int board_rng_seed(struct abuf *buf) 1240 { 1241 #ifdef CONFIG_DM_RNG 1242 struct udevice *dev; 1243 #endif 1244 size_t len = 32; 1245 u8 *data; 1246 int i; 1247 1248 data = malloc(len); 1249 if (!data) { 1250 printf("Out of memory\n"); 1251 return -ENOMEM; 1252 } 1253 1254 #ifdef CONFIG_DM_RNG 1255 if (uclass_get_device(UCLASS_RNG, 0, &dev) || dm_rng_read(dev, data, len)) 1256 #endif 1257 { 1258 printf("board seed: Pseudo\n"); 1259 for (i = 0; i < len; i++) 1260 data[i] = (u8)rand(); 1261 } 1262 1263 abuf_init_set(buf, data, len); 1264 1265 return 0; 1266 } 1267 1268 /* 1269 * Pass fwver when any available. 1270 */ 1271 static void bootargs_add_fwver(bool verbose) 1272 { 1273 #ifdef CONFIG_ROCKCHIP_PRELOADER_ATAGS 1274 struct tag *t; 1275 char *list1 = NULL; 1276 char *list2 = NULL; 1277 char *fwver = NULL; 1278 char *p = PLAIN_VERSION; 1279 int i, end; 1280 1281 t = atags_get_tag(ATAG_FWVER); 1282 if (t) { 1283 list1 = calloc(1, sizeof(struct tag_fwver)); 1284 if (!list1) 1285 return; 1286 for (i = 0; i < FW_MAX; i++) { 1287 if (t->u.fwver.ver[i][0] != '\0') { 1288 strcat(list1, t->u.fwver.ver[i]); 1289 strcat(list1, ","); 1290 } 1291 } 1292 } 1293 1294 list2 = calloc(1, FWVER_LEN); 1295 if (!list2) 1296 goto out; 1297 strcat(list2, "uboot-"); 1298 /* optional */ 1299 #ifdef BUILD_TAG 1300 strcat(list2, BUILD_TAG); 1301 strcat(list2, "-"); 1302 #endif 1303 /* optional */ 1304 if (strcmp(PLAIN_VERSION, "2017.09")) { 1305 strncat(list2, p + strlen("2017.09-g"), 10); 1306 strcat(list2, "-"); 1307 } 1308 strcat(list2, U_BOOT_DMI_DATE); 1309 1310 /* merge ! */ 1311 if (list1 || list2) { 1312 fwver = calloc(1, sizeof(struct tag_fwver)); 1313 if (!fwver) 1314 goto out; 1315 1316 strcat(fwver, "androidboot.fwver="); 1317 if (list1) 1318 strcat(fwver, list1); 1319 if (list2) { 1320 strcat(fwver, list2); 1321 } else { 1322 end = strlen(fwver) - 1; 1323 fwver[end] = '\0'; /* omit last ',' */ 1324 } 1325 if (verbose) 1326 printf("## fwver: %s\n\n", fwver); 1327 env_update("bootargs", fwver); 1328 env_set("fwver", fwver + strlen("androidboot.")); 1329 } 1330 out: 1331 if (list1) 1332 free(list1); 1333 if (list2) 1334 free(list2); 1335 if (fwver) 1336 free(fwver); 1337 #endif 1338 } 1339 1340 static void bootargs_add_android(bool verbose) 1341 { 1342 #ifdef CONFIG_ANDROID_AB 1343 ab_update_root_partition(); 1344 #endif 1345 1346 /* Android header v4+ need this handle */ 1347 #ifdef CONFIG_ANDROID_BOOT_IMAGE 1348 struct andr_img_hdr *hdr; 1349 char *fwver; 1350 1351 hdr = (void *)env_get_ulong("android_addr_r", 16, 0); 1352 if (hdr && !android_image_check_header(hdr) && hdr->header_version >= 4) { 1353 if (env_update_extract_subset("bootargs", "andr_bootargs", "androidboot.")) 1354 printf("extract androidboot.xxx error\n"); 1355 if (verbose) 1356 printf("## bootargs(android): %s\n\n", env_get("andr_bootargs")); 1357 1358 /* for kernel cmdline can be read */ 1359 fwver = env_get("fwver"); 1360 if (fwver) { 1361 env_update("bootargs", fwver); 1362 env_set("fwver", NULL); 1363 } 1364 } 1365 #endif 1366 } 1367 1368 static void bootargs_add_partition(bool verbose) 1369 { 1370 #if defined(CONFIG_ENVF) || defined(CONFIG_ENV_PARTITION) 1371 char *part_type[] = { "mtdparts", "blkdevparts" }; 1372 char *part_list; 1373 char *env; 1374 int id = 0; 1375 1376 env = env_get(part_type[id]); 1377 if (!env) 1378 env = env_get(part_type[++id]); 1379 if (env) { 1380 if (!strstr(env, part_type[id])) { 1381 part_list = calloc(1, strlen(env) + strlen(part_type[id]) + 2); 1382 if (part_list) { 1383 strcat(part_list, part_type[id]); 1384 strcat(part_list, "="); 1385 strcat(part_list, env); 1386 } 1387 } else { 1388 part_list = env; 1389 } 1390 env_update("bootargs", part_list); 1391 if (verbose) 1392 printf("## parts: %s\n\n", part_list); 1393 } 1394 1395 env = env_get("sys_bootargs"); 1396 if (env) { 1397 env_update("bootargs", env); 1398 if (verbose) 1399 printf("## sys_bootargs: %s\n\n", env); 1400 } 1401 #endif 1402 1403 #ifdef CONFIG_MTD_BLK 1404 if (!env_get("mtdparts")) { 1405 char *mtd_par_info = mtd_part_parse(NULL); 1406 1407 if (mtd_par_info) { 1408 if (memcmp(env_get("devtype"), "mtd", 3) == 0) 1409 env_update("bootargs", mtd_par_info); 1410 } 1411 } 1412 #endif 1413 } 1414 1415 static void bootargs_add_dtb_dtbo(void *fdt, bool verbose) 1416 { 1417 /* bootargs_ext is used when dtbo is applied. */ 1418 const char *arr_bootargs[] = { "bootargs", "bootargs_ext" }; 1419 const char *bootargs; 1420 char *msg = "kernel"; 1421 int i, noffset; 1422 1423 /* find or create "/chosen" node. */ 1424 noffset = fdt_find_or_add_subnode(fdt, 0, "chosen"); 1425 if (noffset < 0) 1426 return; 1427 1428 for (i = 0; i < ARRAY_SIZE(arr_bootargs); i++) { 1429 bootargs = fdt_getprop(fdt, noffset, arr_bootargs[i], NULL); 1430 if (!bootargs) 1431 continue; 1432 if (verbose) 1433 printf("## bootargs(%s-%s): %s\n\n", 1434 msg, arr_bootargs[i], bootargs); 1435 /* 1436 * Append kernel bootargs 1437 * If use AB system, delete default "root=" which route 1438 * to rootfs. Then the ab bootctl will choose the 1439 * high priority system to boot and add its UUID 1440 * to cmdline. The format is "roo=PARTUUID=xxxx...". 1441 */ 1442 #ifdef CONFIG_ANDROID_AB 1443 env_update_filter("bootargs", bootargs, "root="); 1444 #else 1445 env_update("bootargs", bootargs); 1446 #endif 1447 } 1448 } 1449 1450 char *board_fdt_chosen_bootargs(void *fdt) 1451 { 1452 int verbose = is_hotkey(HK_CMDLINE); 1453 const char *bootargs; 1454 1455 /* debug */ 1456 hotkey_run(HK_INITCALL); 1457 if (verbose) 1458 printf("## bootargs(u-boot): %s\n\n", env_get("bootargs")); 1459 1460 bootargs_add_dtb_dtbo(fdt, verbose); 1461 bootargs_add_partition(verbose); 1462 bootargs_add_fwver(verbose); 1463 bootargs_add_android(verbose); 1464 1465 /* 1466 * Initrd fixup: remove unused "initrd=0x...,0x...", 1467 * this for compatible with legacy parameter.txt 1468 */ 1469 env_delete("bootargs", "initrd=", 0); 1470 1471 /* 1472 * If uart is required to be disabled during 1473 * power on, it would be not initialized by 1474 * any pre-loader and U-Boot. 1475 * 1476 * If we don't remove earlycon from commandline, 1477 * kernel hangs while using earlycon to putc/getc 1478 * which may dead loop for waiting uart status. 1479 * (It seems the root cause is baundrate is not 1480 * initilalized) 1481 * 1482 * So let's remove earlycon from commandline. 1483 */ 1484 if (gd->flags & GD_FLG_DISABLE_CONSOLE) 1485 env_delete("bootargs", "earlycon=", 0); 1486 1487 bootargs = env_get("bootargs"); 1488 if (verbose) 1489 printf("## bootargs(merged): %s\n\n", bootargs); 1490 1491 return (char *)bootargs; 1492 } 1493 1494 int ft_verify_fdt(void *fdt) 1495 { 1496 /* for android header v4+, we load bootparams and fixup initrd */ 1497 #if defined(CONFIG_ANDROID_BOOT_IMAGE) && defined(CONFIG_XBC) 1498 struct andr_img_hdr *hdr; 1499 uint64_t initrd_start, initrd_end; 1500 char *bootargs, *p; 1501 int nodeoffset; 1502 int is_u64, err; 1503 u32 len; 1504 1505 hdr = (void *)env_get_ulong("android_addr_r", 16, 0); 1506 if (!hdr || android_image_check_header(hdr) || 1507 hdr->header_version < 4) 1508 return 1; 1509 1510 bootargs = env_get("andr_bootargs"); 1511 if (!bootargs) 1512 return 1; 1513 1514 /* trans character: space to new line */ 1515 p = bootargs; 1516 while (*p++) { 1517 if (*p == ' ') 1518 *p = '\n'; 1519 } 1520 1521 debug("## andr_bootargs: %s\n", bootargs); 1522 1523 /* 1524 * add boot params right after bootconfig 1525 * 1526 * because we can get final full bootargs in board_fdt_chosen_bootargs(), 1527 * android_image_get_ramdisk() is early than that. 1528 * 1529 * we have to add boot params by now. 1530 */ 1531 len = addBootConfigParameters((char *)bootargs, strlen(bootargs), 1532 (u64)hdr->ramdisk_addr + hdr->ramdisk_size + 1533 hdr->vendor_ramdisk_size, hdr->vendor_bootconfig_size); 1534 if (len < 0) { 1535 printf("error: addBootConfigParameters\n"); 1536 return 0; 1537 } 1538 1539 nodeoffset = fdt_subnode_offset(fdt, 0, "chosen"); 1540 if (nodeoffset < 0) { 1541 printf("error: No /chosen node\n"); 1542 return 0; 1543 } 1544 1545 /* fixup initrd with real value */ 1546 fdt_delprop(fdt, nodeoffset, "linux,initrd-start"); 1547 fdt_delprop(fdt, nodeoffset, "linux,initrd-end"); 1548 1549 is_u64 = (fdt_address_cells(fdt, 0) == 2); 1550 initrd_start = hdr->ramdisk_addr; 1551 initrd_end = initrd_start + hdr->ramdisk_size + 1552 hdr->vendor_ramdisk_size + 1553 hdr->vendor_bootconfig_size + len; 1554 err = fdt_setprop_uxx(fdt, nodeoffset, "linux,initrd-start", 1555 initrd_start, is_u64); 1556 if (err < 0) { 1557 printf("WARNING: could not set linux,initrd-start %s.\n", 1558 fdt_strerror(err)); 1559 return 0; 1560 } 1561 err = fdt_setprop_uxx(fdt, nodeoffset, "linux,initrd-end", 1562 initrd_end, is_u64); 1563 if (err < 0) { 1564 printf("WARNING: could not set linux,initrd-end %s.\n", 1565 fdt_strerror(err)); 1566 return 0; 1567 } 1568 #endif 1569 return 1; 1570 } 1571 1572