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