xref: /rk3399_rockchip-uboot/cmd/boot_android.c (revision 008aee876ae5041eb6e2889c9becb47351d0ee47)
106f4a874SAlex Deymo /*
206f4a874SAlex Deymo  * Copyright (C) 2016 The Android Open Source Project
306f4a874SAlex Deymo  *
406f4a874SAlex Deymo  * SPDX-License-Identifier: BSD-2-Clause
506f4a874SAlex Deymo  */
606f4a874SAlex Deymo 
706f4a874SAlex Deymo #include <android_bootloader.h>
8e8e29e8dSJason Zhu #include <android_avb/avb_version.h>
9e8e29e8dSJason Zhu #include <android_avb/avb_ab_flow.h>
10e8e29e8dSJason Zhu #include <android_avb/avb_ops_user.h>
11180cc7c6SAlex Deymo #include <android_cmds.h>
12e8e29e8dSJason Zhu #include <malloc.h>
1306f4a874SAlex Deymo #include <common.h>
14e8e29e8dSJason Zhu #include <bootm.h>
1506f4a874SAlex Deymo #include <command.h>
1682ee22d4SJason Zhu #include <android_bootloader_message.h>
1737a7bc39SJason Zhu #include <android_avb/rk_avb_ops_user.h>
18d9d5eb74SJason Zhu #include <android_avb/avb_atx_ops.h>
1906f4a874SAlex Deymo 
2006f4a874SAlex Deymo static int do_boot_android(cmd_tbl_t *cmdtp, int flag, int argc,
2106f4a874SAlex Deymo 			   char * const argv[])
2206f4a874SAlex Deymo {
2306f4a874SAlex Deymo 	unsigned long load_address;
2406f4a874SAlex Deymo 	int ret = CMD_RET_SUCCESS;
2506f4a874SAlex Deymo 	char *addr_arg_endp, *addr_str;
2606f4a874SAlex Deymo 	struct blk_desc *dev_desc;
2706f4a874SAlex Deymo 
28891380b5SKever Yang 	if (argc < 3)
2906f4a874SAlex Deymo 		return CMD_RET_USAGE;
3080622240SAlex Deymo 	if (argc > 5)
3106f4a874SAlex Deymo 		return CMD_RET_USAGE;
3206f4a874SAlex Deymo 
3380622240SAlex Deymo 	if (argc >= 5) {
3480622240SAlex Deymo 		load_address = simple_strtoul(argv[4], &addr_arg_endp, 16);
3580622240SAlex Deymo 		if (addr_arg_endp == argv[4] || *addr_arg_endp != '\0')
3606f4a874SAlex Deymo 			return CMD_RET_USAGE;
3706f4a874SAlex Deymo 	} else {
38891380b5SKever Yang 		addr_str = env_get("kernel_addr_r");
3906f4a874SAlex Deymo 		if (addr_str)
4006f4a874SAlex Deymo 			load_address = simple_strtoul(addr_str, NULL, 16);
4106f4a874SAlex Deymo 		else
4206f4a874SAlex Deymo 			load_address = CONFIG_SYS_LOAD_ADDR;
4306f4a874SAlex Deymo 	}
4406f4a874SAlex Deymo 
45*008aee87SAndy Yan #if defined(CONFIG_ARM64)
463f251879SKever Yang 	/* ARM64 kernel load addr need to align to 0x80000, and android boot.img
473f251879SKever Yang 	 * have a 2KB header, need to reserve space for it.
483f251879SKever Yang 	 */
493f251879SKever Yang 	load_address &= ~0x7ffff;
50*008aee87SAndy Yan #endif
513f251879SKever Yang 	load_address -= 0x800; /* default page size for boot header */
52891380b5SKever Yang 	dev_desc = blk_get_dev(argv[1], simple_strtoul(argv[2], NULL, 16));
53891380b5SKever Yang 	if (!dev_desc) {
54891380b5SKever Yang 		printf("Could not get %s %s\n", argv[1], argv[2]);
5506f4a874SAlex Deymo 		return CMD_RET_FAILURE;
5606f4a874SAlex Deymo 	}
5706f4a874SAlex Deymo 
58891380b5SKever Yang 	ret = android_bootloader_boot_flow(dev_desc, load_address);
5906f4a874SAlex Deymo 	if (ret < 0) {
6006f4a874SAlex Deymo 		printf("Android boot failed, error %d.\n", ret);
6106f4a874SAlex Deymo 		return CMD_RET_FAILURE;
6206f4a874SAlex Deymo 	}
6306f4a874SAlex Deymo 	return CMD_RET_SUCCESS;
6406f4a874SAlex Deymo }
6506f4a874SAlex Deymo 
6606f4a874SAlex Deymo U_BOOT_CMD(
6780622240SAlex Deymo 	boot_android, 5, 0, do_boot_android,
6806f4a874SAlex Deymo 	"Execute the Android Bootloader flow.",
69df7cce43SAlex Deymo 	"<interface> <dev[:part|;part_name]> <slot> [<kernel_addr>]\n"
7006f4a874SAlex Deymo 	"    - Load the Boot Control Block (BCB) from the partition 'part' on\n"
7106f4a874SAlex Deymo 	"      device type 'interface' instance 'dev' to determine the boot\n"
7206f4a874SAlex Deymo 	"      mode, and load and execute the appropriate kernel.\n"
7306f4a874SAlex Deymo 	"      In normal and recovery mode, the kernel will be loaded from\n"
7406f4a874SAlex Deymo 	"      the corresponding \"boot\" partition. In bootloader mode, the\n"
7506f4a874SAlex Deymo 	"      command defined in the \"fastbootcmd\" variable will be\n"
7606f4a874SAlex Deymo 	"      executed.\n"
7780622240SAlex Deymo 	"      On Android devices with multiple slots, the pass 'slot' is\n"
7880622240SAlex Deymo 	"      used to load the appropriate kernel. The standard slot names\n"
7980622240SAlex Deymo 	"      are 'a' and 'b'.\n"
8006f4a874SAlex Deymo 	"    - If 'part_name' is passed, preceded with a ; instead of :, the\n"
8106f4a874SAlex Deymo 	"      partition name whose label is 'part_name' will be looked up in\n"
8206f4a874SAlex Deymo 	"      the partition table. This is commonly the \"misc\" partition.\n"
8306f4a874SAlex Deymo );
84e8e29e8dSJason Zhu 
8537a7bc39SJason Zhu #ifdef CONFIG_RK_AVB_LIBAVB_USER
8682ee22d4SJason Zhu static int bootloader_message_read(struct android_bootloader_message *data)
8782ee22d4SJason Zhu {
8882ee22d4SJason Zhu 	AvbOps *ops;
8982ee22d4SJason Zhu 	char requested_partitions[] = "misc";
9082ee22d4SJason Zhu 	size_t out_num_read;
9182ee22d4SJason Zhu 	char *buffer;
9282ee22d4SJason Zhu 
9382ee22d4SJason Zhu 	ops = avb_ops_user_new();
9482ee22d4SJason Zhu 	buffer = (char *)data;
9582ee22d4SJason Zhu 
9682ee22d4SJason Zhu 	if (ops == NULL) {
9782ee22d4SJason Zhu 		printf("avb_ops_user_new() failed!\n");
9882ee22d4SJason Zhu 		return CMD_RET_FAILURE;
9982ee22d4SJason Zhu 	}
10082ee22d4SJason Zhu 
10182ee22d4SJason Zhu 	if (ops->read_from_partition(ops, requested_partitions,
10282ee22d4SJason Zhu 				     0, 2048, buffer,
10382ee22d4SJason Zhu 				     &out_num_read) != 0) {
10482ee22d4SJason Zhu 		printf("do avb read error!\n");
10582ee22d4SJason Zhu 		avb_ops_user_free(ops);
10682ee22d4SJason Zhu 		return CMD_RET_FAILURE;
10782ee22d4SJason Zhu 	}
10882ee22d4SJason Zhu 
10982ee22d4SJason Zhu 	avb_ops_user_free(ops);
11082ee22d4SJason Zhu 
11182ee22d4SJason Zhu 	return CMD_RET_SUCCESS;
11282ee22d4SJason Zhu }
11382ee22d4SJason Zhu 
11482ee22d4SJason Zhu static int bootloader_message_write(struct android_bootloader_message *data)
11582ee22d4SJason Zhu {
11682ee22d4SJason Zhu 	AvbOps *ops;
11782ee22d4SJason Zhu 	char requested_partitions[] = "misc";
11882ee22d4SJason Zhu 	char *buffer;
11982ee22d4SJason Zhu 
12082ee22d4SJason Zhu 	ops = avb_ops_user_new();
12182ee22d4SJason Zhu 	buffer = (char *)data;
12282ee22d4SJason Zhu 
12382ee22d4SJason Zhu 	if (ops == NULL) {
12482ee22d4SJason Zhu 		printf("avb_ops_user_new() failed!\n");
12582ee22d4SJason Zhu 		return CMD_RET_FAILURE;
12682ee22d4SJason Zhu 	}
12782ee22d4SJason Zhu 
12882ee22d4SJason Zhu 	if (ops->write_to_partition(ops, requested_partitions,
12982ee22d4SJason Zhu 				     0, 2048, buffer) != 0) {
13082ee22d4SJason Zhu 		printf("do avb write error!\n");
13182ee22d4SJason Zhu 		avb_ops_user_free(ops);
13282ee22d4SJason Zhu 		return CMD_RET_FAILURE;
13382ee22d4SJason Zhu 	}
13482ee22d4SJason Zhu 
13582ee22d4SJason Zhu 	avb_ops_user_free(ops);
13682ee22d4SJason Zhu 
13782ee22d4SJason Zhu 	return CMD_RET_SUCCESS;
13882ee22d4SJason Zhu }
13982ee22d4SJason Zhu 
140e8e29e8dSJason Zhu int do_avb_init_ab_metadata(cmd_tbl_t *cmdtp, int flag,
141e8e29e8dSJason Zhu 			    int argc, char * const argv[])
142e8e29e8dSJason Zhu {
143e8e29e8dSJason Zhu 	AvbOps *ops;
144e8e29e8dSJason Zhu 	AvbABData ab_data;
145e8e29e8dSJason Zhu 
146e8e29e8dSJason Zhu 	memset(&ab_data, 0, sizeof(AvbABData));
147326572eaSJason Zhu 	debug("sizeof(AvbABData) = %d\n", (int)(size_t)sizeof(AvbABData));
148e8e29e8dSJason Zhu 	if (argc != 1)
149e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
150e8e29e8dSJason Zhu 
151e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
152e8e29e8dSJason Zhu 	if (ops == NULL) {
153e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
154e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
155e8e29e8dSJason Zhu 	}
156e8e29e8dSJason Zhu 
15737a7bc39SJason Zhu 	avb_ab_data_init(&ab_data);
158e8e29e8dSJason Zhu 	if (ops->ab_ops->write_ab_metadata(ops->ab_ops, &ab_data) != 0) {
159e8e29e8dSJason Zhu 		printf("do_avb_init_ab_metadata error!\n");
160e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
161e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
162e8e29e8dSJason Zhu 	}
163e8e29e8dSJason Zhu 
164e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
165e8e29e8dSJason Zhu 
166e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
167e8e29e8dSJason Zhu }
168e8e29e8dSJason Zhu 
169e8e29e8dSJason Zhu int do_avb_version(cmd_tbl_t *cmdtp, int flag, int argc,
170e8e29e8dSJason Zhu 		   char * const argv[])
171e8e29e8dSJason Zhu {
172e8e29e8dSJason Zhu 	const char *avb_version;
173e8e29e8dSJason Zhu 
174e8e29e8dSJason Zhu 	if (argc != 1)
175e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
176e8e29e8dSJason Zhu 
177e8e29e8dSJason Zhu 	avb_version = avb_version_string();
178e8e29e8dSJason Zhu 	printf("Android avb version is %s.\n", avb_version);
179e8e29e8dSJason Zhu 
180e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
181e8e29e8dSJason Zhu }
182e8e29e8dSJason Zhu 
183e8e29e8dSJason Zhu int do_avb_ab_mark_slot_active(cmd_tbl_t *cmdtp, int flag,
184e8e29e8dSJason Zhu 			       int argc, char * const argv[])
185e8e29e8dSJason Zhu {
186e8e29e8dSJason Zhu 	AvbOps *ops;
187e8e29e8dSJason Zhu 	unsigned int slot_number;
188e8e29e8dSJason Zhu 
189e8e29e8dSJason Zhu 	if (argc != 2)
190e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
191e8e29e8dSJason Zhu 
192e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
193e8e29e8dSJason Zhu 	if (ops == NULL) {
194e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
195e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
196e8e29e8dSJason Zhu 	}
197e8e29e8dSJason Zhu 
198e8e29e8dSJason Zhu 	slot_number = simple_strtoul(argv[1], NULL, 16);
199e8e29e8dSJason Zhu 	if (avb_ab_mark_slot_active(ops->ab_ops, slot_number) != 0) {
200e8e29e8dSJason Zhu 		printf("avb_ab_mark_slot_active error!\n");
201e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
202e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
203e8e29e8dSJason Zhu 	}
204e8e29e8dSJason Zhu 
205e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
206e8e29e8dSJason Zhu 
207e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
208e8e29e8dSJason Zhu }
209e8e29e8dSJason Zhu 
210e8e29e8dSJason Zhu int do_avb_ab_mark_slot_unbootable(cmd_tbl_t *cmdtp, int flag,
211e8e29e8dSJason Zhu 				   int argc, char * const argv[])
212e8e29e8dSJason Zhu {
213e8e29e8dSJason Zhu 	AvbOps *ops;
214e8e29e8dSJason Zhu 	unsigned int slot_number;
215e8e29e8dSJason Zhu 
216e8e29e8dSJason Zhu 	if (argc != 2)
217e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
218e8e29e8dSJason Zhu 
219e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
220e8e29e8dSJason Zhu 	if (ops == NULL) {
221e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
222e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
223e8e29e8dSJason Zhu 	}
224e8e29e8dSJason Zhu 
225e8e29e8dSJason Zhu 	slot_number = simple_strtoul(argv[1], NULL, 16);
226e8e29e8dSJason Zhu 	if (avb_ab_mark_slot_unbootable(ops->ab_ops, slot_number) != 0) {
227e8e29e8dSJason Zhu 		printf("do_avb_ab_mark_slot_unbootable error!\n");
228e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
229e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
230e8e29e8dSJason Zhu 	}
231e8e29e8dSJason Zhu 
232e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
233e8e29e8dSJason Zhu 
234e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
235e8e29e8dSJason Zhu }
236e8e29e8dSJason Zhu 
237e8e29e8dSJason Zhu int do_avb_ab_mark_slot_successful(cmd_tbl_t *cmdtp, int flag,
238e8e29e8dSJason Zhu 				   int argc, char * const argv[])
239e8e29e8dSJason Zhu {
240e8e29e8dSJason Zhu 	AvbOps *ops;
241e8e29e8dSJason Zhu 	unsigned int slot_number;
242e8e29e8dSJason Zhu 
243e8e29e8dSJason Zhu 	if (argc != 2)
244e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
245e8e29e8dSJason Zhu 
246e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
247e8e29e8dSJason Zhu 	if (ops == NULL) {
248e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
249e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
250e8e29e8dSJason Zhu 	}
251e8e29e8dSJason Zhu 
252e8e29e8dSJason Zhu 	slot_number = simple_strtoul(argv[1], NULL, 16);
253e8e29e8dSJason Zhu 	if (avb_ab_mark_slot_successful(ops->ab_ops, slot_number) != 0) {
254e8e29e8dSJason Zhu 		printf("do_avb_ab_mark_slot_successful error!\n");
255e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
256e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
257e8e29e8dSJason Zhu 	}
258e8e29e8dSJason Zhu 
259e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
260e8e29e8dSJason Zhu 
261e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
262e8e29e8dSJason Zhu }
263e8e29e8dSJason Zhu 
264e8e29e8dSJason Zhu int do_avb_read_rollback_index(cmd_tbl_t *cmdtp, int flag,
265e8e29e8dSJason Zhu 			       int argc, char * const argv[])
266e8e29e8dSJason Zhu {
267e8e29e8dSJason Zhu 	AvbOps *ops;
268e8e29e8dSJason Zhu 	uint64_t out_rollback_index;
269e8e29e8dSJason Zhu 	size_t rollback_index_location;
270e8e29e8dSJason Zhu 
271e8e29e8dSJason Zhu 	if (argc != 2)
272e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
273e8e29e8dSJason Zhu 
274e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
275e8e29e8dSJason Zhu 	if (ops == NULL) {
276e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
277e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
278e8e29e8dSJason Zhu 	}
279e8e29e8dSJason Zhu 
280e8e29e8dSJason Zhu 	rollback_index_location = simple_strtoul(argv[1], NULL, 16);
281e8e29e8dSJason Zhu 	if (ops->read_rollback_index(ops, rollback_index_location,
282e8e29e8dSJason Zhu 				     &out_rollback_index) != 0) {
283e8e29e8dSJason Zhu 		printf("do_avb_read_rollback_index error!\n");
284e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
285e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
286e8e29e8dSJason Zhu 	}
287e8e29e8dSJason Zhu 
288e8e29e8dSJason Zhu 	printf("out_rollback_index = %llx\n", out_rollback_index);
289e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
290e8e29e8dSJason Zhu 
291e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
292e8e29e8dSJason Zhu }
293e8e29e8dSJason Zhu 
294e8e29e8dSJason Zhu int do_avb_write_rollback_index(cmd_tbl_t *cmdtp, int flag,
295e8e29e8dSJason Zhu 				int argc, char * const argv[])
296e8e29e8dSJason Zhu {
297e8e29e8dSJason Zhu 	AvbOps *ops;
298e8e29e8dSJason Zhu 	uint64_t out_rollback_index;
299e8e29e8dSJason Zhu 	size_t rollback_index_location;
300e8e29e8dSJason Zhu 
301e8e29e8dSJason Zhu 	if (argc != 3)
302e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
303e8e29e8dSJason Zhu 
304e8e29e8dSJason Zhu 	rollback_index_location = simple_strtoul(argv[1], NULL, 16);
305e8e29e8dSJason Zhu 	out_rollback_index = simple_strtoull(argv[2], NULL, 16);
306e8e29e8dSJason Zhu 	debug("out_rollback_index = %llx\n", out_rollback_index);
307e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
308e8e29e8dSJason Zhu 	if (ops == NULL) {
309e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
310e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
311e8e29e8dSJason Zhu 	}
312e8e29e8dSJason Zhu 
313e8e29e8dSJason Zhu 	if (ops->write_rollback_index(ops, rollback_index_location,
314e8e29e8dSJason Zhu 				      out_rollback_index) != 0) {
315e8e29e8dSJason Zhu 		printf("do_avb_write_rollback_index error!\n");
316e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
317e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
318e8e29e8dSJason Zhu 	}
319e8e29e8dSJason Zhu 
320e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
321e8e29e8dSJason Zhu 
322e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
323e8e29e8dSJason Zhu }
324e8e29e8dSJason Zhu 
325e8e29e8dSJason Zhu int do_avb_read_is_device_unlocked(cmd_tbl_t *cmdtp, int flag,
326e8e29e8dSJason Zhu 				   int argc, char * const argv[])
327e8e29e8dSJason Zhu {
328e8e29e8dSJason Zhu 	AvbOps *ops;
329e8e29e8dSJason Zhu 	bool out_is_unlocked;
330e8e29e8dSJason Zhu 
331e8e29e8dSJason Zhu 	if (argc != 1)
332e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
333e8e29e8dSJason Zhu 
334e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
335e8e29e8dSJason Zhu 	if (ops == NULL) {
336e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
337e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
338e8e29e8dSJason Zhu 	}
339e8e29e8dSJason Zhu 
340e8e29e8dSJason Zhu 	if (ops->read_is_device_unlocked(ops, &out_is_unlocked) != 0) {
341e8e29e8dSJason Zhu 		printf("do_avb_read_is_device_unlocked error!\n");
342e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
343e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
344e8e29e8dSJason Zhu 	}
345e8e29e8dSJason Zhu 
346d9d5eb74SJason Zhu 	printf("out_is_unlocked = %d\n", out_is_unlocked);
347e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
348e8e29e8dSJason Zhu 
349e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
350e8e29e8dSJason Zhu }
351e8e29e8dSJason Zhu int do_avb_write_is_device_unlocked(cmd_tbl_t *cmdtp, int flag,
352e8e29e8dSJason Zhu 				    int argc, char * const argv[])
353e8e29e8dSJason Zhu {
354e8e29e8dSJason Zhu 	AvbOps *ops;
355e8e29e8dSJason Zhu 	bool out_is_unlocked;
356e8e29e8dSJason Zhu 
357e8e29e8dSJason Zhu 	if (argc != 2)
358e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
359e8e29e8dSJason Zhu 
360e8e29e8dSJason Zhu 	out_is_unlocked = simple_strtoul(argv[1], NULL, 16);
361e8e29e8dSJason Zhu 	if ((out_is_unlocked != 0) || (out_is_unlocked != 1))
362e8e29e8dSJason Zhu 		printf("enter out_is_unlocked value must is '0' or '1'\n");
363e8e29e8dSJason Zhu 
364e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
365e8e29e8dSJason Zhu 	if (ops == NULL) {
366e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
367e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
368e8e29e8dSJason Zhu 	}
369e8e29e8dSJason Zhu 
370e8e29e8dSJason Zhu 	if (ops->write_is_device_unlocked(ops, &out_is_unlocked) != 0) {
371e8e29e8dSJason Zhu 		printf("do_avb_write_is_device_unlocked error!\n");
372e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
373e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
374e8e29e8dSJason Zhu 	}
375e8e29e8dSJason Zhu 
376e8e29e8dSJason Zhu 	debug("out_is_unlocked = %d\n", out_is_unlocked);
377e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
378e8e29e8dSJason Zhu 
379e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
380e8e29e8dSJason Zhu }
381e8e29e8dSJason Zhu 
382e8e29e8dSJason Zhu int do_avb_get_size_of_partition(cmd_tbl_t *cmdtp, int flag,
383e8e29e8dSJason Zhu 				 int argc, char * const argv[])
384e8e29e8dSJason Zhu {
385e8e29e8dSJason Zhu 	AvbOps *ops;
386e8e29e8dSJason Zhu 	char *requested_partitions;
387e8e29e8dSJason Zhu 	uint64_t out_size_in_bytes;
388e8e29e8dSJason Zhu 
389e8e29e8dSJason Zhu 	if (argc != 2)
390e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
391e8e29e8dSJason Zhu 
392e8e29e8dSJason Zhu 	requested_partitions = argv[1];
393e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
394e8e29e8dSJason Zhu 	if (ops == NULL) {
395e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
396e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
397e8e29e8dSJason Zhu 	}
398e8e29e8dSJason Zhu 
399e8e29e8dSJason Zhu 	if (ops->get_size_of_partition(ops, requested_partitions,
400e8e29e8dSJason Zhu 				       &out_size_in_bytes) != 0) {
401e8e29e8dSJason Zhu 		printf("do_avb_get_size_of_partition error!\n");
402e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
403e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
404e8e29e8dSJason Zhu 	}
405e8e29e8dSJason Zhu 
406e8e29e8dSJason Zhu 	printf("partition size = %lld\n", out_size_in_bytes);
407e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
408e8e29e8dSJason Zhu 
409e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
410e8e29e8dSJason Zhu }
411e8e29e8dSJason Zhu 
412e8e29e8dSJason Zhu int do_avb_get_get_unique_guid_for_partition(cmd_tbl_t *cmdtp, int flag,
413e8e29e8dSJason Zhu 					     int argc, char * const argv[])
414e8e29e8dSJason Zhu {
415e8e29e8dSJason Zhu 	AvbOps *ops;
416e8e29e8dSJason Zhu 	char *requested_partitions;
417e8e29e8dSJason Zhu 	size_t guid_buf_size = 37;
418e8e29e8dSJason Zhu 	char guid_buf[37];
419e8e29e8dSJason Zhu 
420e8e29e8dSJason Zhu 	if (argc != 2)
421e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
422e8e29e8dSJason Zhu 
423e8e29e8dSJason Zhu 	requested_partitions = argv[1];
424e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
425e8e29e8dSJason Zhu 	if (ops == NULL) {
426e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
427e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
428e8e29e8dSJason Zhu 	}
429e8e29e8dSJason Zhu 
430e8e29e8dSJason Zhu 	if (ops->get_unique_guid_for_partition(ops, requested_partitions,
431e8e29e8dSJason Zhu 					       guid_buf, guid_buf_size) != 0) {
432e8e29e8dSJason Zhu 		printf("do_avb_get_get_unique_guid_for_partition error!\n");
433e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
434e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
435e8e29e8dSJason Zhu 	}
436e8e29e8dSJason Zhu 
437e8e29e8dSJason Zhu 	printf("guid = %s\n", guid_buf);
438e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
439e8e29e8dSJason Zhu 
440e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
441e8e29e8dSJason Zhu }
442e8e29e8dSJason Zhu 
443e8e29e8dSJason Zhu int do_avb_read(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
444e8e29e8dSJason Zhu {
445e8e29e8dSJason Zhu 	AvbOps *ops;
446e8e29e8dSJason Zhu 	char *requested_partitions;
447e8e29e8dSJason Zhu 	int64_t offset_blk;
448e8e29e8dSJason Zhu 	size_t blkcnt;
449e8e29e8dSJason Zhu 	size_t out_num_read;
450e8e29e8dSJason Zhu 	int i;
451e8e29e8dSJason Zhu 	char *buffer;
452e8e29e8dSJason Zhu 
453e8e29e8dSJason Zhu 	if (argc != 4)
454e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
455e8e29e8dSJason Zhu 
456e8e29e8dSJason Zhu 	requested_partitions = argv[1];
457e8e29e8dSJason Zhu 	offset_blk = simple_strtoul(argv[2], NULL, 16);
458e8e29e8dSJason Zhu 	blkcnt = simple_strtoul(argv[3], NULL, 16);
459e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
460e8e29e8dSJason Zhu 	buffer = (char *)malloc(blkcnt * 512);
461e8e29e8dSJason Zhu 	if (buffer == NULL)
462e8e29e8dSJason Zhu 		printf("malloc buffer failed!\n");
463e8e29e8dSJason Zhu 
464e8e29e8dSJason Zhu 	if (ops == NULL) {
465e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
466e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
467e8e29e8dSJason Zhu 	}
468e8e29e8dSJason Zhu 
469e8e29e8dSJason Zhu 	if (ops->read_from_partition(ops, requested_partitions,
470e8e29e8dSJason Zhu 				     offset_blk, blkcnt, buffer,
471e8e29e8dSJason Zhu 				     &out_num_read) != 0) {
472e8e29e8dSJason Zhu 		printf("do avb read error!\n");
473e8e29e8dSJason Zhu 		free(buffer);
474e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
475e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
476e8e29e8dSJason Zhu 	}
477e8e29e8dSJason Zhu 
478e8e29e8dSJason Zhu 	for (i = 0; i < 512 * blkcnt; i++)
479e8e29e8dSJason Zhu 		printf("buffer %d = %d\n", i, buffer[i]);
480e8e29e8dSJason Zhu 
481e8e29e8dSJason Zhu 	free(buffer);
482e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
483e8e29e8dSJason Zhu 
484e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
485e8e29e8dSJason Zhu }
486e8e29e8dSJason Zhu 
487e8e29e8dSJason Zhu int do_avb_write(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
488e8e29e8dSJason Zhu {
489e8e29e8dSJason Zhu 	AvbOps *ops;
490e8e29e8dSJason Zhu 	char *requested_partitions;
491e8e29e8dSJason Zhu 	int64_t offset_blk;
492e8e29e8dSJason Zhu 	size_t blkcnt;
493e8e29e8dSJason Zhu 	size_t out_num_read;
494e8e29e8dSJason Zhu 	char *buffer;
495e8e29e8dSJason Zhu 
496e8e29e8dSJason Zhu 	if (argc != 4)
497e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
498e8e29e8dSJason Zhu 
499e8e29e8dSJason Zhu 	requested_partitions = argv[1];
500e8e29e8dSJason Zhu 	offset_blk = simple_strtoul(argv[2], NULL, 16);
501e8e29e8dSJason Zhu 	blkcnt = simple_strtoul(argv[3], NULL, 16);
502e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
503e8e29e8dSJason Zhu 	buffer = (char *)malloc(blkcnt * 512);
504e8e29e8dSJason Zhu 	if (buffer == NULL) {
505e8e29e8dSJason Zhu 		printf("malloc buffer failed!\n");
506e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
507e8e29e8dSJason Zhu 	}
508e8e29e8dSJason Zhu 
509e8e29e8dSJason Zhu 	if (ops == NULL) {
510e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
511e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
512e8e29e8dSJason Zhu 	}
513e8e29e8dSJason Zhu 	if (ops->read_from_partition(ops, requested_partitions, offset_blk,
514e8e29e8dSJason Zhu 				     blkcnt, buffer, &out_num_read) != 0) {
515e8e29e8dSJason Zhu 		printf("do_avb_write error!\n");
516e8e29e8dSJason Zhu 		free(buffer);
517e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
518e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
519e8e29e8dSJason Zhu 	}
520e8e29e8dSJason Zhu 
521e8e29e8dSJason Zhu 	free(buffer);
522e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
523e8e29e8dSJason Zhu 
524e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
525e8e29e8dSJason Zhu }
526e8e29e8dSJason Zhu 
527e8e29e8dSJason Zhu int do_avb_read_ab_metadata(cmd_tbl_t *cmdtp, int flag,
528e8e29e8dSJason Zhu 			    int argc, char * const argv[])
529e8e29e8dSJason Zhu {
530e8e29e8dSJason Zhu 	AvbOps *ops;
531e8e29e8dSJason Zhu 	AvbABData ab_data;
532e8e29e8dSJason Zhu 
533e8e29e8dSJason Zhu 	if (argc != 1)
534e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
535e8e29e8dSJason Zhu 
536e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
537e8e29e8dSJason Zhu 	if (ops == NULL) {
538e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
539e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
540e8e29e8dSJason Zhu 	}
541e8e29e8dSJason Zhu 
542e8e29e8dSJason Zhu 	if (ops->ab_ops->read_ab_metadata(ops->ab_ops, &ab_data) != 0) {
543e8e29e8dSJason Zhu 		printf("do_avb_write_ab_metadata error!\n");
544e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
545e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
546e8e29e8dSJason Zhu 	}
547e8e29e8dSJason Zhu 
548e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
549e8e29e8dSJason Zhu 
550e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
551e8e29e8dSJason Zhu }
552e8e29e8dSJason Zhu 
553e8e29e8dSJason Zhu int do_avb_write_ab_metadata(cmd_tbl_t *cmdtp, int flag,
554e8e29e8dSJason Zhu 			     int argc, char * const argv[])
555e8e29e8dSJason Zhu {
556e8e29e8dSJason Zhu 	AvbOps *ops;
557e8e29e8dSJason Zhu 	AvbABData ab_data;
558e8e29e8dSJason Zhu 
559e8e29e8dSJason Zhu 	if (argc != 1)
560e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
561e8e29e8dSJason Zhu 
562e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
563e8e29e8dSJason Zhu 	if (ops == NULL) {
564e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
565e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
566e8e29e8dSJason Zhu 	}
567e8e29e8dSJason Zhu 
568e8e29e8dSJason Zhu 	if (ops->ab_ops->write_ab_metadata(ops->ab_ops, &ab_data) != 0) {
569e8e29e8dSJason Zhu 		printf("do_avb_write_ab_metadata error!\n");
570e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
571e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
572e8e29e8dSJason Zhu 	}
573e8e29e8dSJason Zhu 
574e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
575e8e29e8dSJason Zhu 
576e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
577e8e29e8dSJason Zhu }
578e8e29e8dSJason Zhu 
579d9d5eb74SJason Zhu int do_perm_attr_test(cmd_tbl_t *cmdtp, int flag,
580d9d5eb74SJason Zhu 		      int argc, char * const argv[])
581d9d5eb74SJason Zhu {
582d9d5eb74SJason Zhu 	AvbOps *ops;
583d9d5eb74SJason Zhu 	int i;
584d9d5eb74SJason Zhu 	uint8_t hash[AVB_SHA256_DIGEST_SIZE];
585d9d5eb74SJason Zhu 
586d9d5eb74SJason Zhu 	if (argc != 1)
587d9d5eb74SJason Zhu 		return CMD_RET_USAGE;
588d9d5eb74SJason Zhu 
589d9d5eb74SJason Zhu 	ops = avb_ops_user_new();
590d9d5eb74SJason Zhu 	if (ops == NULL) {
591d9d5eb74SJason Zhu 		printf("avb_ops_user_new() failed!\n");
592d9d5eb74SJason Zhu 		return CMD_RET_FAILURE;
593d9d5eb74SJason Zhu 	}
594d9d5eb74SJason Zhu 
595d9d5eb74SJason Zhu 	if (ops->atx_ops->read_permanent_attributes_hash(ops->atx_ops, hash) != 0) {
596d9d5eb74SJason Zhu 		printf("read_permanent_attributes_hash error!\n");
597d9d5eb74SJason Zhu 		avb_ops_user_free(ops);
598d9d5eb74SJason Zhu 		return CMD_RET_FAILURE;
599d9d5eb74SJason Zhu 	}
600d9d5eb74SJason Zhu 
601d9d5eb74SJason Zhu 	for (i = 0; i < AVB_SHA256_DIGEST_SIZE; i++) {
602d9d5eb74SJason Zhu 		if (i % 4 == 0)
603d9d5eb74SJason Zhu 			printf("\n");
604d9d5eb74SJason Zhu 		printf("0x%x  ", hash[i]);
605d9d5eb74SJason Zhu 	}
606d9d5eb74SJason Zhu 
607d9d5eb74SJason Zhu 	avb_ops_user_free(ops);
608d9d5eb74SJason Zhu 
609d9d5eb74SJason Zhu 	return CMD_RET_SUCCESS;
610d9d5eb74SJason Zhu }
611d9d5eb74SJason Zhu 
612e8e29e8dSJason Zhu int do_avb_verify_partition(cmd_tbl_t *cmdtp, int flag,
613e8e29e8dSJason Zhu 			    int argc, char * const argv[])
614e8e29e8dSJason Zhu {
615e8e29e8dSJason Zhu 	AvbOps *ops;
616e8e29e8dSJason Zhu 	const char *requested_partitions[1];
617e8e29e8dSJason Zhu 	const char * slot_suffixes[2] = {"_a", "_b"};
618e8e29e8dSJason Zhu 	AvbSlotVerifyFlags flags;
619e8e29e8dSJason Zhu 	AvbSlotVerifyData *slot_data[2] = {NULL, NULL};
620e8e29e8dSJason Zhu 	AvbSlotVerifyResult verify_result;
621e8e29e8dSJason Zhu 	size_t n;
622e8e29e8dSJason Zhu 
623e8e29e8dSJason Zhu 	if (argc != 3)
624e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
625e8e29e8dSJason Zhu 
626e8e29e8dSJason Zhu 	requested_partitions[0] = argv[1];
627e8e29e8dSJason Zhu 	n = simple_strtoul(argv[2], NULL, 16);
628e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
629e8e29e8dSJason Zhu 	flags = AVB_SLOT_VERIFY_FLAGS_NONE;
630e8e29e8dSJason Zhu 	verify_result =
631e8e29e8dSJason Zhu 		avb_slot_verify(ops,
632e8e29e8dSJason Zhu 				requested_partitions,
633e8e29e8dSJason Zhu 				slot_suffixes[n],
634e8e29e8dSJason Zhu 				flags,
635e8e29e8dSJason Zhu 				AVB_HASHTREE_ERROR_MODE_RESTART_AND_INVALIDATE,
636e8e29e8dSJason Zhu 				&slot_data[n]);
637e8e29e8dSJason Zhu 	if (verify_result != 0)
638e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
639e8e29e8dSJason Zhu 
640e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
641e8e29e8dSJason Zhu 
642e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
643e8e29e8dSJason Zhu }
644e8e29e8dSJason Zhu 
645e8e29e8dSJason Zhu int do_avb_flow(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
646e8e29e8dSJason Zhu {
647f0864c7fSJason Zhu 	char slot_partition[2][20] = {{0}, {0}};
648e8e29e8dSJason Zhu 	unsigned long load_address;
649e8e29e8dSJason Zhu 	AvbOps *ops;
650e8e29e8dSJason Zhu 	const char *avb_version;
651e8e29e8dSJason Zhu 	AvbSlotVerifyData *slot_data;
652e8e29e8dSJason Zhu 	AvbSlotVerifyFlags flags;
653e8e29e8dSJason Zhu 	const char *requested_partitions[] = {"boot", "system", NULL};
654e8e29e8dSJason Zhu 	char *command_line;
65537a7bc39SJason Zhu 	bool unlocked;
656e8e29e8dSJason Zhu 	const char *mode_cmdline = NULL;
657e8e29e8dSJason Zhu 	char root_data[70] = "root=PARTUUID=";
65837a7bc39SJason Zhu 	char *vboot_state = "androidboot.verifiedbootstate=";
6599aed1a13SJason Zhu 	char avb_root_data[2000] = {0};
660e8e29e8dSJason Zhu 	size_t guid_buf_size = 37;
661e8e29e8dSJason Zhu 	char guid_buf[37];
662e8e29e8dSJason Zhu 	char verify_flag;
663e8e29e8dSJason Zhu 	char boot_slot_select[5];
66482ee22d4SJason Zhu 	struct android_bootloader_message data;
66582ee22d4SJason Zhu 	const char *fastboot_cmd = env_get("fastbootcmd");
66637a7bc39SJason Zhu 	AvbABFlowResult ab_result;
667e8e29e8dSJason Zhu 
668e8e29e8dSJason Zhu 	if (argc != 2)
669e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
67082ee22d4SJason Zhu 
67182ee22d4SJason Zhu 	bootloader_message_read(&data);
67282ee22d4SJason Zhu 	if (!strcmp("bootonce-bootloader", data.command)) {
67382ee22d4SJason Zhu 		memset(data.command, 0, sizeof(data.command));
67482ee22d4SJason Zhu 		bootloader_message_write(&data);
67582ee22d4SJason Zhu 		if (fastboot_cmd) {
67682ee22d4SJason Zhu 			printf("bootonce-bootloader!\n");
67782ee22d4SJason Zhu 			return run_command(fastboot_cmd, CMD_FLAG_ENV);
67882ee22d4SJason Zhu 		} else {
67982ee22d4SJason Zhu 			printf("The fastbootcmd is NULL!\n");
68037a7bc39SJason Zhu 			goto fail;
68182ee22d4SJason Zhu 		}
68282ee22d4SJason Zhu 	} else if (!strcmp("boot-recovery", data.command)) {
68382ee22d4SJason Zhu 		printf("Enter boot-recovery!\n");
68482ee22d4SJason Zhu 	} else if(!strcmp("boot-normal", data.command)) {
68582ee22d4SJason Zhu 		printf("Enter boot-normal!\n");
68682ee22d4SJason Zhu 		mode_cmdline = "skip_initramfs";
68782ee22d4SJason Zhu 	} else {
6889f7ea89dSWenping Zhang 		/*
6899f7ea89dSWenping Zhang 		 * Firstly, confirm if there is a command in misc partition in
6909f7ea89dSWenping Zhang 		 * previous cases, and then we need to confirm whether user has
6919f7ea89dSWenping Zhang 		 * requested to enter recovery mode by entering "reboot recovery"
6929f7ea89dSWenping Zhang 		 * command through adb or serial console.
6939f7ea89dSWenping Zhang 		 */
6949f7ea89dSWenping Zhang 		char *env_rebootmode = env_get("reboot_mode");
6959f7ea89dSWenping Zhang 
6969f7ea89dSWenping Zhang 		if (env_rebootmode && !strcmp("recovery", env_rebootmode))
6979f7ea89dSWenping Zhang 			printf("Enter recovery mode by command 'reboot recovery'!\n");
6989f7ea89dSWenping Zhang 		else
69982ee22d4SJason Zhu 			mode_cmdline = "skip_initramfs";
70082ee22d4SJason Zhu 	}
70182ee22d4SJason Zhu 
702e8e29e8dSJason Zhu 	avb_version = avb_version_string();
703e8e29e8dSJason Zhu 	printf("Android avb version is %s.\n", avb_version);
704e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
70537a7bc39SJason Zhu 	if (ops == NULL) {
706e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
70737a7bc39SJason Zhu 		goto fail;
70837a7bc39SJason Zhu 	}
709e8e29e8dSJason Zhu 
71037a7bc39SJason Zhu 	if (ops->read_is_device_unlocked(ops, &unlocked) != 0) {
711e8e29e8dSJason Zhu 		printf("Error determining whether device is unlocked.\n");
71237a7bc39SJason Zhu 		unlocked = ANDROID_VBOOT_UNLOCK;
71337a7bc39SJason Zhu 		if (ops->write_is_device_unlocked(ops, &unlocked) != 0) {
71437a7bc39SJason Zhu 			printf("Can not write lock state!\n");
71537a7bc39SJason Zhu 			unlocked = ANDROID_VBOOT_LOCK;
71637a7bc39SJason Zhu 		}
71737a7bc39SJason Zhu 		if (ops->read_is_device_unlocked(ops, &unlocked) != 0) {
71837a7bc39SJason Zhu 			printf("Can not read lock state!\n");
71937a7bc39SJason Zhu 			unlocked = ANDROID_VBOOT_LOCK;
72037a7bc39SJason Zhu 		}
72137a7bc39SJason Zhu 	}
722e8e29e8dSJason Zhu 
723e8e29e8dSJason Zhu 	printf("read_is_device_unlocked() ops returned that device is %s\n",
724e8e29e8dSJason Zhu 	       unlocked ? "UNLOCKED" : "LOCKED");
725e8e29e8dSJason Zhu 
726e8e29e8dSJason Zhu 	flags = AVB_SLOT_VERIFY_FLAGS_NONE;
727e8e29e8dSJason Zhu 	if (unlocked)
728e8e29e8dSJason Zhu 		flags |= AVB_SLOT_VERIFY_FLAGS_ALLOW_VERIFICATION_ERROR;
729e8e29e8dSJason Zhu 
730e8e29e8dSJason Zhu 	verify_flag = argv[1][0];
731e8e29e8dSJason Zhu 	if (verify_flag == 'v') {
732e8e29e8dSJason Zhu 		debug("start with verify!\n");
73337a7bc39SJason Zhu 		ab_result =
73437a7bc39SJason Zhu 		    avb_ab_flow(ops->ab_ops,
735e8e29e8dSJason Zhu 				requested_partitions,
736e8e29e8dSJason Zhu 				flags,
737e8e29e8dSJason Zhu 				AVB_HASHTREE_ERROR_MODE_RESTART_AND_INVALIDATE,
73837a7bc39SJason Zhu 				&slot_data);
73937a7bc39SJason Zhu 		if ((ab_result != AVB_AB_FLOW_RESULT_OK) &&
74037a7bc39SJason Zhu 		    (ab_result !=
74137a7bc39SJason Zhu 		    AVB_AB_FLOW_RESULT_OK_WITH_VERIFICATION_ERROR)) {
7424397fdfdSJason Zhu 			printf("avb_ab_flow() error!\n");
74337a7bc39SJason Zhu 			avb_ops_user_free(ops);
74437a7bc39SJason Zhu 			goto fail;
74537a7bc39SJason Zhu 		}
74637a7bc39SJason Zhu 
74737a7bc39SJason Zhu 		if (ab_result ==\
74837a7bc39SJason Zhu 		    AVB_AB_FLOW_RESULT_OK_WITH_VERIFICATION_ERROR) {
74937a7bc39SJason Zhu 			strcat(avb_root_data, vboot_state);
75037a7bc39SJason Zhu 			strcat(avb_root_data, "orange");
75137a7bc39SJason Zhu 		} else if (ab_result == AVB_AB_FLOW_RESULT_OK) {
75237a7bc39SJason Zhu 			strcat(avb_root_data, vboot_state);
75337a7bc39SJason Zhu 			strcat(avb_root_data, "green");
7544397fdfdSJason Zhu 		}
7554397fdfdSJason Zhu 
756e8e29e8dSJason Zhu 		command_line = android_assemble_cmdline(slot_data->ab_suffix,
757e8e29e8dSJason Zhu 							mode_cmdline);
7589aed1a13SJason Zhu 		strcat(avb_root_data, " ");
7599aed1a13SJason Zhu 		strcat(avb_root_data, command_line);
7609aed1a13SJason Zhu 		strcat(avb_root_data, " ");
7619aed1a13SJason Zhu 		strcat(avb_root_data, slot_data->cmdline);
7629aed1a13SJason Zhu 		env_set("bootargs", avb_root_data);
763e8e29e8dSJason Zhu 		load_address = CONFIG_SYS_LOAD_ADDR;
76437a7bc39SJason Zhu 		if (rk_avb_close_optee_client())
765708de143SJason Zhu 			printf("Can not close optee client!\n");
766708de143SJason Zhu 
767e8e29e8dSJason Zhu 		memcpy((uint8_t*)load_address,
768e8e29e8dSJason Zhu 		       slot_data->loaded_partitions->data,
769e8e29e8dSJason Zhu 		       slot_data->loaded_partitions->data_size);
770e8e29e8dSJason Zhu 		android_bootloader_boot_kernel(load_address);
77137a7bc39SJason Zhu 		avb_ops_user_free(ops);
772e8e29e8dSJason Zhu 	} else if (verify_flag == 'n') {
773e8e29e8dSJason Zhu 		load_address = CONFIG_SYS_LOAD_ADDR;
77437a7bc39SJason Zhu 		rk_avb_ab_slot_select(ops->ab_ops, boot_slot_select);
775e8e29e8dSJason Zhu 		strcat(slot_partition[1], requested_partitions[1]);
776e8e29e8dSJason Zhu 		strcat(slot_partition[1], boot_slot_select);
777e8e29e8dSJason Zhu 		printf("%s\n", slot_partition[1]);
778e8e29e8dSJason Zhu 		ops->get_unique_guid_for_partition(ops,
779e8e29e8dSJason Zhu 						   slot_partition[1],
780e8e29e8dSJason Zhu 						   guid_buf,
781e8e29e8dSJason Zhu 						   guid_buf_size);
782e8e29e8dSJason Zhu 		strcat(root_data, guid_buf);
783e8e29e8dSJason Zhu 		command_line = android_assemble_cmdline(boot_slot_select,
784e8e29e8dSJason Zhu 							mode_cmdline);
785e8e29e8dSJason Zhu 		strcat(root_data, " ");
786e8e29e8dSJason Zhu 		strcat(root_data, command_line);
787e8e29e8dSJason Zhu 		env_set("bootargs", root_data);
78837a7bc39SJason Zhu 		if (android_avb_boot_flow(boot_slot_select, load_address)) {
78937a7bc39SJason Zhu 			printf("Cannot boot the system, goto the fastboot!\n");
79037a7bc39SJason Zhu 			avb_ops_user_free(ops);
79137a7bc39SJason Zhu 			goto fail;
79237a7bc39SJason Zhu 		}
79337a7bc39SJason Zhu 		avb_ops_user_free(ops);
794bf17c627SJason Zhu 	} else if (verify_flag == 'o') {
795bf17c627SJason Zhu 		load_address = CONFIG_SYS_LOAD_ADDR;
796bf17c627SJason Zhu 		strcat(slot_partition[1], requested_partitions[1]);
797bf17c627SJason Zhu 		ops->get_unique_guid_for_partition(ops,
798bf17c627SJason Zhu 						   slot_partition[1],
799bf17c627SJason Zhu 						   guid_buf,
800bf17c627SJason Zhu 						   guid_buf_size);
801bf17c627SJason Zhu 		strcat(root_data, guid_buf);
802bf17c627SJason Zhu 		command_line = android_assemble_cmdline(boot_slot_select,
803bf17c627SJason Zhu 							mode_cmdline);
804bf17c627SJason Zhu 		strcat(root_data, " ");
805bf17c627SJason Zhu 		strcat(root_data, command_line);
806bf17c627SJason Zhu 		env_set("bootargs", root_data);
80737a7bc39SJason Zhu 		if (android_boot_flow(load_address)) {
80837a7bc39SJason Zhu 			printf("Cannot boot the system, goto the fastboot!\n");
80937a7bc39SJason Zhu 			avb_ops_user_free(ops);
81037a7bc39SJason Zhu 			goto fail;
81137a7bc39SJason Zhu 		}
81237a7bc39SJason Zhu 		avb_ops_user_free(ops);
813e8e29e8dSJason Zhu 	} else {
814e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
815e8e29e8dSJason Zhu 	}
816e8e29e8dSJason Zhu 
817e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
81837a7bc39SJason Zhu fail:
81937a7bc39SJason Zhu 	if (fastboot_cmd == NULL) {
82037a7bc39SJason Zhu 		printf("fastboot_cmd is null, run default fastboot_cmd!\n");
82137a7bc39SJason Zhu 		fastboot_cmd = "fastboot usb 0";
82237a7bc39SJason Zhu 	}
82337a7bc39SJason Zhu 
82437a7bc39SJason Zhu 	return run_command(fastboot_cmd, CMD_FLAG_ENV);
825e8e29e8dSJason Zhu }
826e8e29e8dSJason Zhu 
827e8e29e8dSJason Zhu static cmd_tbl_t cmd_avb[] = {
828e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(init, 1, 1, do_avb_init_ab_metadata, "", ""),
829e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(version, 1, 1, do_avb_version, "", ""),
830e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(slot_active, 2, 1,
831e8e29e8dSJason Zhu 			 do_avb_ab_mark_slot_active, "", ""),
832e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(slot_unbootable, 2, 1,
833e8e29e8dSJason Zhu 			 do_avb_ab_mark_slot_unbootable, "", ""),
834e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(slot_successful, 2, 1,
835e8e29e8dSJason Zhu 			 do_avb_ab_mark_slot_successful, "", ""),
836e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(read_rollback, 2, 1,
837e8e29e8dSJason Zhu 			 do_avb_read_rollback_index, "", ""),
838e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(write_rollback, 3, 1,
839e8e29e8dSJason Zhu 			 do_avb_write_rollback_index, "", ""),
840e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(read_lock_status, 1, 1,
841e8e29e8dSJason Zhu 			 do_avb_read_is_device_unlocked, "", ""),
842e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(write_lock_status, 2, 1,
843e8e29e8dSJason Zhu 			 do_avb_write_is_device_unlocked, "", ""),
844e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(part_size, 2, 1,
845e8e29e8dSJason Zhu 			 do_avb_get_size_of_partition, "", ""),
846e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(part_guid, 2, 1,
847e8e29e8dSJason Zhu 			 do_avb_get_get_unique_guid_for_partition, "", ""),
848e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(read, 4, 1, do_avb_read, "", ""),
849e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(write, 4, 1, do_avb_write, "", ""),
850e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(readabmisc, 1, 1, do_avb_read_ab_metadata, "", ""),
851e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(writeabmisc, 1, 1, do_avb_write_ab_metadata, "", ""),
852d9d5eb74SJason Zhu 	U_BOOT_CMD_MKENT(perm_attr_test, 1, 1, do_perm_attr_test, "", ""),
853e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(verify, 3, 1, do_avb_verify_partition, "", ""),
854e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(flow, 2, 1, do_avb_flow, "", "")
855e8e29e8dSJason Zhu };
856e8e29e8dSJason Zhu 
857e8e29e8dSJason Zhu static int do_boot_avb(cmd_tbl_t *cmdtp,
858e8e29e8dSJason Zhu 		       int flag,
859e8e29e8dSJason Zhu 		       int argc,
860e8e29e8dSJason Zhu 		       char * const argv[])
861e8e29e8dSJason Zhu {
862e8e29e8dSJason Zhu 	cmd_tbl_t *cp;
863e8e29e8dSJason Zhu 
864e8e29e8dSJason Zhu 	cp = find_cmd_tbl(argv[1], cmd_avb, ARRAY_SIZE(cmd_avb));
865e8e29e8dSJason Zhu 
866e8e29e8dSJason Zhu 	argc--;
867e8e29e8dSJason Zhu 	argv++;
868e8e29e8dSJason Zhu 
869e8e29e8dSJason Zhu 	if (cp == NULL || argc > cp->maxargs)
870e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
871e8e29e8dSJason Zhu 	if (flag == CMD_FLAG_REPEAT && !cp->repeatable)
872e8e29e8dSJason Zhu 		return CMD_RET_SUCCESS;
873e8e29e8dSJason Zhu 
874e8e29e8dSJason Zhu 	return cp->cmd(cmdtp, flag, argc, argv);
875e8e29e8dSJason Zhu }
876e8e29e8dSJason Zhu 
877e8e29e8dSJason Zhu U_BOOT_CMD(
878e8e29e8dSJason Zhu 	bootavb, 29, 1, do_boot_avb,
879e8e29e8dSJason Zhu 	"Execute the Android avb a/b boot flow.",
880e8e29e8dSJason Zhu 	"init - initialize the avbabmeta\n"
881e8e29e8dSJason Zhu 	"bootavb version - display info of bootavb version\n"
882e8e29e8dSJason Zhu 	"bootavb slot_active cnt\n"
883e8e29e8dSJason Zhu 	"bootavb slot_unbootable cnt\n"
884e8e29e8dSJason Zhu 	"bootavb slot_successful cnt\n"
885e8e29e8dSJason Zhu 	"bootavb read_rollback rollback_index_location\n"
886e8e29e8dSJason Zhu 	"bootavb write_rollback rollback_index_location out_rollback_index\n"
887e8e29e8dSJason Zhu 	"bootavb read_lock_status\n"
888e8e29e8dSJason Zhu 	"bootavb write_lock_status 0 or 1\n"
889e8e29e8dSJason Zhu 	"bootavb part_size partitions_name\n"
890e8e29e8dSJason Zhu 	"bootavb part_guid partitions_name\n"
891e8e29e8dSJason Zhu 	"bootavb read partition offset_blk cnt\n"
892e8e29e8dSJason Zhu 	"bootavb write partition offset_blk cnt\n"
893e8e29e8dSJason Zhu 	"bootavb readabmisc\n"
894e8e29e8dSJason Zhu 	"bootavb writeabmisc\n"
895d9d5eb74SJason Zhu 	"bootavb perm_attr_test\n"
896e8e29e8dSJason Zhu 	"bootavb verify partition slot_cnt;partion name without '_a' or '_b'\n"
897e8e29e8dSJason Zhu 	"bootavb flow v/n\n"
898e8e29e8dSJason Zhu );
899e8e29e8dSJason Zhu #endif
900