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