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