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