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