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