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 <asm/io.h> 33 #include <asm/gpio.h> 34 #include <android_avb/rk_avb_ops_user.h> 35 #include <dm/uclass-internal.h> 36 #include <dm/root.h> 37 #include <power/charge_display.h> 38 #include <power/regulator.h> 39 #include <optee_include/OpteeClientInterface.h> 40 #include <optee_include/OpteeClientApiLib.h> 41 #include <optee_include/tee_api_defines.h> 42 #include <asm/arch/boot_mode.h> 43 #include <asm/arch/clock.h> 44 #include <asm/arch/cpu.h> 45 #include <asm/arch/hotkey.h> 46 #include <asm/arch/param.h> 47 #include <asm/arch/periph.h> 48 #include <asm/arch/resource_img.h> 49 #include <asm/arch/rk_atags.h> 50 #include <asm/arch/vendor.h> 51 #ifdef CONFIG_ROCKCHIP_EINK_DISPLAY 52 #include <rk_eink.h> 53 #endif 54 DECLARE_GLOBAL_DATA_PTR; 55 56 __weak int rk_board_late_init(void) 57 { 58 return 0; 59 } 60 61 __weak int rk_board_fdt_fixup(void *blob) 62 { 63 return 0; 64 } 65 66 __weak int soc_clk_dump(void) 67 { 68 return 0; 69 } 70 71 __weak int set_armclk_rate(void) 72 { 73 return 0; 74 } 75 76 __weak int rk_board_init(void) 77 { 78 return 0; 79 } 80 81 /* 82 * define serialno max length, the max length is 512 Bytes 83 * The remaining bytes are used to ensure that the first 512 bytes 84 * are valid when executing 'env_set("serial#", value)'. 85 */ 86 #define VENDOR_SN_MAX 513 87 #define CPUID_LEN 0x10 88 #define CPUID_OFF 0x07 89 90 #define MAX_ETHERNET 0x2 91 92 static int rockchip_set_ethaddr(void) 93 { 94 #ifdef CONFIG_ROCKCHIP_VENDOR_PARTITION 95 char buf[ARP_HLEN_ASCII + 1], mac[16]; 96 u8 ethaddr[ARP_HLEN * MAX_ETHERNET] = {0}; 97 int ret, i; 98 bool need_write = false, randomed = false; 99 100 ret = vendor_storage_read(LAN_MAC_ID, ethaddr, sizeof(ethaddr)); 101 for (i = 0; i < MAX_ETHERNET; i++) { 102 if (ret <= 0 || !is_valid_ethaddr(ðaddr[i * ARP_HLEN])) { 103 if (!randomed) { 104 net_random_ethaddr(ðaddr[i * ARP_HLEN]); 105 randomed = true; 106 } else { 107 if (i > 0) { 108 memcpy(ðaddr[i * ARP_HLEN], 109 ðaddr[(i - 1) * ARP_HLEN], 110 ARP_HLEN); 111 ethaddr[i * ARP_HLEN] |= 0x02; 112 ethaddr[i * ARP_HLEN] += (i << 2); 113 } 114 } 115 116 need_write = true; 117 } 118 119 if (is_valid_ethaddr(ðaddr[i * ARP_HLEN])) { 120 sprintf(buf, "%pM", ðaddr[i * ARP_HLEN]); 121 if (i == 0) 122 memcpy(mac, "ethaddr", sizeof("ethaddr")); 123 else 124 sprintf(mac, "eth%daddr", i); 125 env_set(mac, buf); 126 } 127 } 128 129 if (need_write) { 130 ret = vendor_storage_write(LAN_MAC_ID, 131 ethaddr, sizeof(ethaddr)); 132 if (ret < 0) 133 printf("%s: vendor_storage_write failed %d\n", 134 __func__, ret); 135 } 136 #endif 137 138 return 0; 139 } 140 141 static int rockchip_set_serialno(void) 142 { 143 u8 low[CPUID_LEN / 2], high[CPUID_LEN / 2]; 144 u8 cpuid[CPUID_LEN] = {0}; 145 char serialno_str[VENDOR_SN_MAX]; 146 int ret = 0, i; 147 u64 serialno; 148 149 /* Read serial number from vendor storage part */ 150 memset(serialno_str, 0, VENDOR_SN_MAX); 151 152 #ifdef CONFIG_ROCKCHIP_VENDOR_PARTITION 153 ret = vendor_storage_read(SN_ID, serialno_str, (VENDOR_SN_MAX-1)); 154 if (ret > 0) { 155 i = strlen(serialno_str); 156 for (; i > 0; i--) { 157 if ((serialno_str[i] >= 'a' && serialno_str[i] <= 'z') || 158 (serialno_str[i] >= 'A' && serialno_str[i] <= 'Z') || 159 (serialno_str[i] >= '0' && serialno_str[i] <= '9')) 160 break; 161 } 162 163 serialno_str[i + 1] = 0x0; 164 env_set("serial#", serialno_str); 165 } else { 166 #endif 167 #if defined(CONFIG_ROCKCHIP_EFUSE) || defined(CONFIG_ROCKCHIP_OTP) 168 struct udevice *dev; 169 170 /* retrieve the device */ 171 if (IS_ENABLED(CONFIG_ROCKCHIP_EFUSE)) 172 ret = uclass_get_device_by_driver(UCLASS_MISC, 173 DM_GET_DRIVER(rockchip_efuse), 174 &dev); 175 else 176 ret = uclass_get_device_by_driver(UCLASS_MISC, 177 DM_GET_DRIVER(rockchip_otp), 178 &dev); 179 180 if (ret) { 181 printf("%s: could not find efuse/otp device\n", __func__); 182 return ret; 183 } 184 185 /* read the cpu_id range from the efuses */ 186 ret = misc_read(dev, CPUID_OFF, &cpuid, sizeof(cpuid)); 187 if (ret) { 188 printf("%s: read cpuid from efuse/otp failed, ret=%d\n", 189 __func__, ret); 190 return ret; 191 } 192 #else 193 /* generate random cpuid */ 194 for (i = 0; i < CPUID_LEN; i++) 195 cpuid[i] = (u8)(rand()); 196 #endif 197 /* Generate the serial number based on CPU ID */ 198 for (i = 0; i < 8; i++) { 199 low[i] = cpuid[1 + (i << 1)]; 200 high[i] = cpuid[i << 1]; 201 } 202 203 serialno = crc32_no_comp(0, low, 8); 204 serialno |= (u64)crc32_no_comp(serialno, high, 8) << 32; 205 snprintf(serialno_str, sizeof(serialno_str), "%llx", serialno); 206 207 env_set("serial#", serialno_str); 208 #ifdef CONFIG_ROCKCHIP_VENDOR_PARTITION 209 } 210 #endif 211 212 return ret; 213 } 214 215 #if defined(CONFIG_USB_FUNCTION_FASTBOOT) 216 int fb_set_reboot_flag(void) 217 { 218 printf("Setting reboot to fastboot flag ...\n"); 219 writel(BOOT_FASTBOOT, CONFIG_ROCKCHIP_BOOT_MODE_REG); 220 221 return 0; 222 } 223 #endif 224 225 #ifdef CONFIG_ROCKCHIP_USB_BOOT 226 static int boot_from_udisk(void) 227 { 228 struct blk_desc *desc; 229 char *devtype; 230 char *devnum; 231 232 devtype = env_get("devtype"); 233 devnum = env_get("devnum"); 234 235 /* Booting priority: mmc1 > udisk */ 236 if (!strcmp(devtype, "mmc") && !strcmp(devnum, "1")) 237 return 0; 238 239 if (!run_command("usb start", -1)) { 240 desc = blk_get_devnum_by_type(IF_TYPE_USB, 0); 241 if (!desc) { 242 printf("No usb device found\n"); 243 return -ENODEV; 244 } 245 246 if (!run_command("rkimgtest usb 0", -1)) { 247 rockchip_set_bootdev(desc); 248 env_set("devtype", "usb"); 249 env_set("devnum", "0"); 250 printf("Boot from usb 0\n"); 251 } else { 252 printf("No usb dev 0 found\n"); 253 return -ENODEV; 254 } 255 } 256 257 return 0; 258 } 259 #endif 260 261 static void env_fixup(void) 262 { 263 struct memblock mem; 264 ulong u_addr_r; 265 phys_size_t end; 266 char *addr_r; 267 268 #ifdef ENV_MEM_LAYOUT_SETTINGS1 269 const char *env_addr0[] = { 270 "scriptaddr", "pxefile_addr_r", 271 "fdt_addr_r", "kernel_addr_r", "ramdisk_addr_r", 272 }; 273 const char *env_addr1[] = { 274 "scriptaddr1", "pxefile_addr1_r", 275 "fdt_addr1_r", "kernel_addr1_r", "ramdisk_addr1_r", 276 }; 277 int i; 278 279 /* 128M is a typical ram size for most platform, so as default here */ 280 if (gd->ram_size <= SZ_128M) { 281 /* Replace orignal xxx_addr_r */ 282 for (i = 0; i < ARRAY_SIZE(env_addr1); i++) { 283 addr_r = env_get(env_addr1[i]); 284 if (addr_r) 285 env_set(env_addr0[i], addr_r); 286 } 287 } 288 #endif 289 /* No BL32 ? */ 290 if (!(gd->flags & GD_FLG_BL32_ENABLED)) { 291 /* 292 * [1] Move kernel to lower address if possible. 293 */ 294 addr_r = env_get("kernel_addr_no_low_bl32_r"); 295 if (addr_r) 296 env_set("kernel_addr_r", addr_r); 297 298 /* 299 * [2] Move ramdisk at BL32 position if need. 300 * 301 * 0x0a200000 and 0x08400000 are rockchip traditional address 302 * of BL32 and ramdisk: 303 * 304 * |------------|------------| 305 * | BL32 | ramdisk | 306 * |------------|------------| 307 * 308 * Move ramdisk to BL32 address to fix sysmem alloc failed 309 * issue on the board with critical memory(ie. 256MB). 310 */ 311 if (gd->ram_size > SZ_128M && gd->ram_size <= SZ_256M) { 312 u_addr_r = env_get_ulong("ramdisk_addr_r", 16, 0); 313 if (u_addr_r == 0x0a200000) 314 env_set("ramdisk_addr_r", "0x08400000"); 315 } 316 } else { 317 mem = param_parse_optee_mem(); 318 319 /* 320 * [1] Move kernel forward if possible. 321 */ 322 if (mem.base > SZ_128M) { 323 addr_r = env_get("kernel_addr_no_low_bl32_r"); 324 if (addr_r) 325 env_set("kernel_addr_r", addr_r); 326 } 327 328 /* 329 * [2] Move ramdisk backward if optee enlarge. 330 */ 331 end = mem.base + mem.size; 332 u_addr_r = env_get_ulong("ramdisk_addr_r", 16, 0); 333 if (u_addr_r >= mem.base && u_addr_r < end) 334 env_set_hex("ramdisk_addr_r", end); 335 } 336 } 337 338 static void cmdline_handle(void) 339 { 340 struct blk_desc *dev_desc; 341 342 #ifdef CONFIG_ROCKCHIP_PRELOADER_ATAGS 343 struct tag *t; 344 345 t = atags_get_tag(ATAG_PUB_KEY); 346 if (t) { 347 /* Pass if efuse/otp programmed */ 348 if (t->u.pub_key.flag == PUBKEY_FUSE_PROGRAMMED) 349 env_update("bootargs", "fuse.programmed=1"); 350 else 351 env_update("bootargs", "fuse.programmed=0"); 352 } 353 #endif 354 dev_desc = rockchip_get_bootdev(); 355 if (!dev_desc) 356 return; 357 358 if (get_bcb_recovery_msg() == BCB_MSG_RECOVERY_RK_FWUPDATE) { 359 if (dev_desc->if_type == IF_TYPE_MMC && dev_desc->devnum == 1) 360 env_update("bootargs", "sdfwupdate"); 361 else if (dev_desc->if_type == IF_TYPE_USB && dev_desc->devnum == 0) 362 env_update("bootargs", "usbfwupdate"); 363 } 364 } 365 366 int board_late_init(void) 367 { 368 rockchip_set_ethaddr(); 369 rockchip_set_serialno(); 370 setup_download_mode(); 371 #if (CONFIG_ROCKCHIP_BOOT_MODE_REG > 0) 372 setup_boot_mode(); 373 #endif 374 #ifdef CONFIG_ROCKCHIP_USB_BOOT 375 boot_from_udisk(); 376 #endif 377 #ifdef CONFIG_DM_CHARGE_DISPLAY 378 charge_display(); 379 #endif 380 #ifdef CONFIG_DRM_ROCKCHIP 381 rockchip_show_logo(); 382 #endif 383 #ifdef CONFIG_ROCKCHIP_EINK_DISPLAY 384 rockchip_eink_show_uboot_logo(); 385 #endif 386 env_fixup(); 387 soc_clk_dump(); 388 cmdline_handle(); 389 #ifdef CONFIG_AMP 390 amp_cpus_on(); 391 #endif 392 return rk_board_late_init(); 393 } 394 395 static void early_download(void) 396 { 397 #if defined(CONFIG_PWRKEY_DNL_TRIGGER_NUM) && \ 398 (CONFIG_PWRKEY_DNL_TRIGGER_NUM > 0) 399 if (pwrkey_download_init()) 400 printf("Pwrkey download init failed\n"); 401 #endif 402 403 #if (CONFIG_ROCKCHIP_BOOT_MODE_REG > 0) 404 if (is_hotkey(HK_BROM_DNL)) { 405 printf("Enter bootrom download..."); 406 flushc(); 407 writel(BOOT_BROM_DOWNLOAD, CONFIG_ROCKCHIP_BOOT_MODE_REG); 408 do_reset(NULL, 0, 0, NULL); 409 printf("failed!\n"); 410 } 411 #endif 412 } 413 414 static void board_debug_init(void) 415 { 416 if (!gd->serial.using_pre_serial && 417 !(gd->flags & GD_FLG_DISABLE_CONSOLE)) 418 debug_uart_init(); 419 420 if (tstc()) { 421 gd->console_evt = getc(); 422 if (gd->console_evt <= 0x1a) /* 'z' */ 423 printf("Hotkey: ctrl+%c\n", gd->console_evt + 'a' - 1); 424 } 425 426 if (IS_ENABLED(CONFIG_CONSOLE_DISABLE_CLI)) 427 printf("Cmd interface: disabled\n"); 428 } 429 430 #ifdef CONFIG_MTD_BLK 431 static void board_mtd_blk_map_partitions(void) 432 { 433 struct blk_desc *dev_desc; 434 435 dev_desc = rockchip_get_bootdev(); 436 if (dev_desc) 437 mtd_blk_map_partitions(dev_desc); 438 } 439 #endif 440 441 int board_init(void) 442 { 443 board_debug_init(); 444 445 #ifdef DEBUG 446 soc_clk_dump(); 447 #endif 448 449 #ifdef CONFIG_USING_KERNEL_DTB 450 #ifdef CONFIG_MTD_BLK 451 board_mtd_blk_map_partitions(); 452 #endif 453 init_kernel_dtb(); 454 #endif 455 early_download(); 456 457 /* 458 * pmucru isn't referenced on some platforms, so pmucru driver can't 459 * probe that the "assigned-clocks" is unused. 460 */ 461 clks_probe(); 462 #ifdef CONFIG_DM_REGULATOR 463 if (regulators_enable_boot_on(is_hotkey(HK_REGULATOR))) 464 debug("%s: Can't enable boot on regulator\n", __func__); 465 #endif 466 467 #ifdef CONFIG_ROCKCHIP_IO_DOMAIN 468 io_domain_init(); 469 #endif 470 471 set_armclk_rate(); 472 473 #ifdef CONFIG_DM_DVFS 474 dvfs_init(true); 475 #endif 476 477 #ifdef CONFIG_ANDROID_AB 478 if (ab_decrease_tries()) 479 printf("Decrease ab tries count fail!\n"); 480 #endif 481 482 return rk_board_init(); 483 } 484 485 int interrupt_debugger_init(void) 486 { 487 #ifdef CONFIG_ROCKCHIP_DEBUGGER 488 return rockchip_debugger_init(); 489 #else 490 return 0; 491 #endif 492 } 493 494 int board_fdt_fixup(void *blob) 495 { 496 /* Common fixup for DRM */ 497 #ifdef CONFIG_DRM_ROCKCHIP 498 rockchip_display_fixup(blob); 499 #endif 500 501 return rk_board_fdt_fixup(blob); 502 } 503 504 #if defined(CONFIG_ARM64_BOOT_AARCH32) || !defined(CONFIG_ARM64) 505 /* 506 * Common for OP-TEE: 507 * 64-bit & 32-bit mode: share memory dcache is always enabled; 508 * 509 * Common for U-Boot: 510 * 64-bit mode: MMU table is static defined in rkxxx.c file, all memory 511 * regions are mapped. That's good to match OP-TEE MMU policy. 512 * 513 * 32-bit mode: MMU table is setup according to gd->bd->bi_dram[..] where 514 * the OP-TEE region has been reserved, so it can not be 515 * mapped(i.e. dcache is disabled). That's *NOT* good to match 516 * OP-TEE MMU policy. 517 * 518 * For the data coherence when communication between U-Boot and OP-TEE, U-Boot 519 * should follow OP-TEE MMU policy. 520 * 521 * So 32-bit mode U-Boot should map OP-TEE share memory as dcache enabled. 522 */ 523 int board_initr_caches_fixup(void) 524 { 525 #ifdef CONFIG_OPTEE_CLIENT 526 struct memblock mem; 527 528 mem.base = 0; 529 mem.size = 0; 530 531 optee_get_shm_config(&mem.base, &mem.size); 532 if (mem.size) 533 mmu_set_region_dcache_behaviour(mem.base, mem.size, 534 DCACHE_WRITEBACK); 535 #endif 536 return 0; 537 } 538 #endif 539 540 void arch_preboot_os(uint32_t bootm_state) 541 { 542 if (bootm_state & BOOTM_STATE_OS_PREP) 543 hotkey_run(HK_CLI_OS_PRE); 544 } 545 546 void enable_caches(void) 547 { 548 icache_enable(); 549 dcache_enable(); 550 } 551 552 #ifdef CONFIG_LMB 553 /* 554 * Using last bi_dram[...] to initialize "bootm_low" and "bootm_mapsize". 555 * This makes lmb_alloc_base() always alloc from tail of sdram. 556 * If we don't assign it, bi_dram[0] is used by default and it may cause 557 * lmb_alloc_base() fail when bi_dram[0] range is small. 558 */ 559 void board_lmb_reserve(struct lmb *lmb) 560 { 561 char bootm_mapsize[32]; 562 char bootm_low[32]; 563 u64 start, size; 564 int i; 565 566 for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) { 567 if (!gd->bd->bi_dram[i].size) 568 break; 569 } 570 571 start = gd->bd->bi_dram[i - 1].start; 572 size = gd->bd->bi_dram[i - 1].size; 573 574 /* 575 * 32-bit kernel: ramdisk/fdt shouldn't be loaded to highmem area(768MB+), 576 * otherwise "Unable to handle kernel paging request at virtual address ...". 577 * 578 * So that we hope limit highest address at 768M, but there comes the the 579 * problem: ramdisk is a compressed image and it expands after descompress, 580 * so it accesses 768MB+ and brings the above "Unable to handle kernel ...". 581 * 582 * We make a appointment that the highest memory address is 512MB, it 583 * makes lmb alloc safer. 584 */ 585 #ifndef CONFIG_ARM64 586 if (start >= ((u64)CONFIG_SYS_SDRAM_BASE + SZ_512M)) { 587 start = gd->bd->bi_dram[i - 2].start; 588 size = gd->bd->bi_dram[i - 2].size; 589 } 590 591 if ((start + size) > ((u64)CONFIG_SYS_SDRAM_BASE + SZ_512M)) 592 size = (u64)CONFIG_SYS_SDRAM_BASE + SZ_512M - start; 593 #endif 594 sprintf(bootm_low, "0x%llx", start); 595 sprintf(bootm_mapsize, "0x%llx", size); 596 env_set("bootm_low", bootm_low); 597 env_set("bootm_mapsize", bootm_mapsize); 598 } 599 #endif 600 601 #ifdef CONFIG_BIDRAM 602 int board_bidram_reserve(struct bidram *bidram) 603 { 604 struct memblock mem; 605 int ret; 606 607 /* ATF */ 608 mem = param_parse_atf_mem(); 609 ret = bidram_reserve(MEM_ATF, mem.base, mem.size); 610 if (ret) 611 return ret; 612 613 /* PSTORE/ATAGS/SHM */ 614 mem = param_parse_common_resv_mem(); 615 ret = bidram_reserve(MEM_SHM, mem.base, mem.size); 616 if (ret) 617 return ret; 618 619 /* OP-TEE */ 620 mem = param_parse_optee_mem(); 621 ret = bidram_reserve(MEM_OPTEE, mem.base, mem.size); 622 if (ret) 623 return ret; 624 625 return 0; 626 } 627 628 int board_sysmem_reserve(struct sysmem *sysmem) 629 { 630 #ifdef CONFIG_SKIP_RELOCATE_UBOOT 631 if (!sysmem_alloc_base_by_name("NO-RELOC-CODE", 632 CONFIG_SYS_TEXT_BASE, SZ_2M)) { 633 printf("Failed to reserve sysmem for U-Boot code\n"); 634 return -ENOMEM; 635 } 636 #endif 637 return 0; 638 } 639 640 parse_fn_t board_bidram_parse_fn(void) 641 { 642 return param_parse_ddr_mem; 643 } 644 #endif 645 646 int board_init_f_boot_flags(void) 647 { 648 int boot_flags = 0; 649 650 /* pre-loader serial */ 651 #if defined(CONFIG_ROCKCHIP_PRELOADER_SERIAL) && \ 652 defined(CONFIG_ROCKCHIP_PRELOADER_ATAGS) 653 struct tag *t; 654 655 t = atags_get_tag(ATAG_SERIAL); 656 if (t) { 657 gd->serial.using_pre_serial = 1; 658 gd->serial.enable = t->u.serial.enable; 659 gd->serial.baudrate = t->u.serial.baudrate; 660 gd->serial.addr = t->u.serial.addr; 661 gd->serial.id = t->u.serial.id; 662 gd->baudrate = CONFIG_BAUDRATE; 663 if (!t->u.serial.enable) 664 boot_flags |= GD_FLG_DISABLE_CONSOLE; 665 debug("preloader: enable=%d, addr=0x%lx, baudrate=%d, id=%d\n", 666 gd->serial.enable, gd->serial.addr, 667 gd->serial.baudrate, gd->serial.id); 668 } else 669 #endif 670 { 671 gd->baudrate = CONFIG_BAUDRATE; 672 gd->serial.baudrate = CONFIG_BAUDRATE; 673 gd->serial.addr = CONFIG_DEBUG_UART_BASE; 674 } 675 676 /* The highest priority to turn off (override) console */ 677 #if defined(CONFIG_DISABLE_CONSOLE) 678 boot_flags |= GD_FLG_DISABLE_CONSOLE; 679 #endif 680 681 return boot_flags; 682 } 683 684 #if defined(CONFIG_USB_GADGET) && defined(CONFIG_USB_GADGET_DWC2_OTG) 685 #include <fdt_support.h> 686 #include <usb.h> 687 #include <usb/dwc2_udc.h> 688 689 static struct dwc2_plat_otg_data otg_data = { 690 .rx_fifo_sz = 512, 691 .np_tx_fifo_sz = 16, 692 .tx_fifo_sz = 128, 693 }; 694 695 int board_usb_init(int index, enum usb_init_type init) 696 { 697 const void *blob = gd->fdt_blob; 698 const fdt32_t *reg; 699 fdt_addr_t addr; 700 int node; 701 702 /* find the usb_otg node */ 703 node = fdt_node_offset_by_compatible(blob, -1, "snps,dwc2"); 704 705 retry: 706 if (node > 0) { 707 reg = fdt_getprop(blob, node, "reg", NULL); 708 if (!reg) 709 return -EINVAL; 710 711 addr = fdt_translate_address(blob, node, reg); 712 if (addr == OF_BAD_ADDR) { 713 pr_err("Not found usb_otg address\n"); 714 return -EINVAL; 715 } 716 717 #if defined(CONFIG_ROCKCHIP_RK3288) 718 if (addr != 0xff580000) { 719 node = fdt_node_offset_by_compatible(blob, node, 720 "snps,dwc2"); 721 goto retry; 722 } 723 #endif 724 } else { 725 /* 726 * With kernel dtb support, rk3288 dwc2 otg node 727 * use the rockchip legacy dwc2 driver "dwc_otg_310" 728 * with the compatible "rockchip,rk3288_usb20_otg", 729 * and rk3368 also use the "dwc_otg_310" driver with 730 * the compatible "rockchip,rk3368-usb". 731 */ 732 #if defined(CONFIG_ROCKCHIP_RK3288) 733 node = fdt_node_offset_by_compatible(blob, -1, 734 "rockchip,rk3288_usb20_otg"); 735 #elif defined(CONFIG_ROCKCHIP_RK3368) 736 node = fdt_node_offset_by_compatible(blob, -1, 737 "rockchip,rk3368-usb"); 738 #endif 739 if (node > 0) { 740 goto retry; 741 } else { 742 pr_err("Not found usb_otg device\n"); 743 return -ENODEV; 744 } 745 } 746 747 otg_data.regs_otg = (uintptr_t)addr; 748 749 return dwc2_udc_probe(&otg_data); 750 } 751 752 int board_usb_cleanup(int index, enum usb_init_type init) 753 { 754 return 0; 755 } 756 #endif 757 758 static void bootm_no_reloc(void) 759 { 760 char *ramdisk_high; 761 char *fdt_high; 762 763 if (!env_get_yesno("bootm-no-reloc")) 764 return; 765 766 ramdisk_high = env_get("initrd_high"); 767 fdt_high = env_get("fdt_high"); 768 769 if (!fdt_high) { 770 env_set_hex("fdt_high", -1UL); 771 printf("Fdt "); 772 } 773 774 if (!ramdisk_high) { 775 env_set_hex("initrd_high", -1UL); 776 printf("Ramdisk "); 777 } 778 779 if (!fdt_high || !ramdisk_high) 780 printf("skip relocation\n"); 781 } 782 783 int bootm_board_start(void) 784 { 785 /* 786 * print console record data 787 * 788 * On some rockchip platforms, uart debug and sdmmc pin are multiplex. 789 * If boot from sdmmc mode, the console data would be record in buffer, 790 * we switch to uart debug function in order to print it after loading 791 * images. 792 */ 793 #if defined(CONFIG_CONSOLE_RECORD) 794 if (!strcmp("mmc", env_get("devtype")) && 795 !strcmp("1", env_get("devnum"))) { 796 printf("IOMUX: sdmmc => uart debug"); 797 pinctrl_select_state(gd->cur_serial_dev, "default"); 798 console_record_print_purge(); 799 } 800 #endif 801 /* disable bootm relcation to save boot time */ 802 bootm_no_reloc(); 803 804 /* PCBA test needs more permission */ 805 if (get_bcb_recovery_msg() == BCB_MSG_RECOVERY_PCBA) 806 env_update("bootargs", "androidboot.selinux=permissive"); 807 808 /* sysmem */ 809 hotkey_run(HK_SYSMEM); 810 sysmem_overflow_check(); 811 812 return 0; 813 } 814 815 int bootm_image_populate_dtb(void *img) 816 { 817 if ((gd->flags & GD_FLG_KDTB_READY) && !gd->fdt_blob_kern) 818 sysmem_free((phys_addr_t)gd->fdt_blob); 819 else 820 gd->fdt_blob = (void *)env_get_ulong("fdt_addr_r", 16, 0); 821 822 return resource_populate_dtb(img, (void *)gd->fdt_blob); 823 } 824 825 /* 826 * Implement it to support CLI command: 827 * - Android: bootm [aosp addr] 828 * - FIT: bootm [fit addr] 829 * - uImage: bootm [uimage addr] 830 * 831 * Purpose: 832 * - The original bootm command args require fdt addr on AOSP, 833 * which is not flexible on rockchip boot/recovery.img. 834 * - Take Android/FIT/uImage image into sysmem management to avoid image 835 * memory overlap. 836 */ 837 #if defined(CONFIG_ANDROID_BOOTLOADER) || \ 838 defined(CONFIG_ROCKCHIP_FIT_IMAGE) || \ 839 defined(CONFIG_ROCKCHIP_UIMAGE) 840 int board_do_bootm(int argc, char * const argv[]) 841 { 842 int format; 843 void *img; 844 845 if (argc != 2) 846 return 0; 847 848 img = (void *)simple_strtoul(argv[1], NULL, 16); 849 format = (genimg_get_format(img)); 850 851 /* Android */ 852 #ifdef CONFIG_ANDROID_BOOT_IMAGE 853 if (format == IMAGE_FORMAT_ANDROID) { 854 struct andr_img_hdr *hdr; 855 ulong load_addr; 856 ulong size; 857 int ret; 858 859 hdr = (struct andr_img_hdr *)img; 860 printf("BOOTM: transferring to board Android\n"); 861 862 load_addr = env_get_ulong("kernel_addr_r", 16, 0); 863 load_addr -= hdr->page_size; 864 size = android_image_get_end(hdr) - (ulong)hdr; 865 866 if (!sysmem_alloc_base(MEM_ANDROID, (ulong)hdr, size)) 867 return -ENOMEM; 868 869 ret = bootm_image_populate_dtb(img); 870 if (ret) { 871 printf("bootm can't read dtb\n"); 872 return ret; 873 } 874 875 ret = android_image_memcpy_separate(hdr, &load_addr); 876 if (ret) { 877 printf("board do bootm failed, ret=%d\n", ret); 878 return ret; 879 } 880 881 return android_bootloader_boot_kernel(load_addr); 882 } 883 #endif 884 885 /* FIT */ 886 #if IMAGE_ENABLE_FIT 887 if (format == IMAGE_FORMAT_FIT) { 888 char boot_cmd[64]; 889 int ret; 890 891 printf("BOOTM: transferring to board FIT\n"); 892 893 ret = bootm_image_populate_dtb(img); 894 if (ret) { 895 printf("bootm can't read dtb\n"); 896 return ret; 897 } 898 snprintf(boot_cmd, sizeof(boot_cmd), "boot_fit %s", argv[1]); 899 return run_command(boot_cmd, 0); 900 } 901 #endif 902 903 /* uImage */ 904 #if 0 905 #if defined(CONFIG_IMAGE_FORMAT_LEGACY) 906 if (format == IMAGE_FORMAT_LEGACY && 907 image_get_type(img) == IH_TYPE_MULTI) { 908 char boot_cmd[64]; 909 910 printf("BOOTM: transferring to board uImage\n"); 911 snprintf(boot_cmd, sizeof(boot_cmd), "boot_uimage %s", argv[1]); 912 return run_command(boot_cmd, 0); 913 } 914 #endif 915 #endif 916 return 0; 917 } 918 #endif 919 920 void autoboot_command_fail_handle(void) 921 { 922 #ifdef CONFIG_ANDROID_AB 923 if (rk_avb_ab_have_bootable_slot() == true) 924 run_command("reset;", 0); 925 else 926 run_command("fastboot usb 0;", 0); 927 #endif 928 929 #ifdef CONFIG_AVB_VBMETA_PUBLIC_KEY_VALIDATE 930 run_command("rockusb 0 ${devtype} ${devnum}", 0); 931 run_command("fastboot usb 0;", 0); 932 #endif 933 934 } 935 936 #ifdef CONFIG_FIT_ROLLBACK_PROTECT 937 938 #define FIT_ROLLBACK_INDEX_LOCATION 0x66697472 /* "fitr" */ 939 940 int fit_read_otp_rollback_index(uint32_t fit_index, uint32_t *otp_index) 941 { 942 #ifdef CONFIG_OPTEE_CLIENT 943 u64 index; 944 int ret; 945 946 ret = trusty_read_rollback_index(FIT_ROLLBACK_INDEX_LOCATION, &index); 947 if (ret) { 948 if (ret != TEE_ERROR_ITEM_NOT_FOUND) 949 return ret; 950 951 index = 0; 952 printf("Initial otp index as %d\n", fit_index); 953 } 954 955 *otp_index = (uint32_t)index; 956 #else 957 *otp_index = 0; 958 #endif 959 960 return 0; 961 } 962 963 static int fit_write_trusty_rollback_index(u32 trusty_index) 964 { 965 if (!trusty_index) 966 return 0; 967 968 return trusty_write_rollback_index(FIT_ROLLBACK_INDEX_LOCATION, 969 (u64)trusty_index); 970 } 971 #endif 972 973 void board_quiesce_devices(void *images) 974 { 975 hotkey_run(HK_CMDLINE); 976 hotkey_run(HK_CLI_OS_GO); 977 978 #ifdef CONFIG_ROCKCHIP_PRELOADER_ATAGS 979 /* Destroy atags makes next warm boot safer */ 980 atags_destroy(); 981 #endif 982 983 #ifdef CONFIG_ROCKCHIP_REBOOT_TEST 984 do_reset(NULL, 0, 0, NULL); 985 #endif 986 987 #ifdef CONFIG_FIT_ROLLBACK_PROTECT 988 int ret; 989 990 ret = fit_write_trusty_rollback_index(gd->rollback_index); 991 if (ret) { 992 panic("Failed to write fit rollback index %d, ret=%d", 993 gd->rollback_index, ret); 994 } 995 #endif 996 997 #ifdef CONFIG_ROCKCHIP_HW_DECOMPRESS 998 misc_decompress_cleanup(); 999 #endif 1000 } 1001