xref: /rk3399_rockchip-uboot/cmd/boot_android.c (revision 3f251879bfd8a56b1ac30c8ef55d3abe5630612d)
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>
1806f4a874SAlex Deymo 
1906f4a874SAlex Deymo static int do_boot_android(cmd_tbl_t *cmdtp, int flag, int argc,
2006f4a874SAlex Deymo 			   char * const argv[])
2106f4a874SAlex Deymo {
2206f4a874SAlex Deymo 	unsigned long load_address;
2306f4a874SAlex Deymo 	int ret = CMD_RET_SUCCESS;
2406f4a874SAlex Deymo 	char *addr_arg_endp, *addr_str;
2506f4a874SAlex Deymo 	struct blk_desc *dev_desc;
2606f4a874SAlex Deymo 
27891380b5SKever Yang 	if (argc < 3)
2806f4a874SAlex Deymo 		return CMD_RET_USAGE;
2980622240SAlex Deymo 	if (argc > 5)
3006f4a874SAlex Deymo 		return CMD_RET_USAGE;
3106f4a874SAlex Deymo 
3280622240SAlex Deymo 	if (argc >= 5) {
3380622240SAlex Deymo 		load_address = simple_strtoul(argv[4], &addr_arg_endp, 16);
3480622240SAlex Deymo 		if (addr_arg_endp == argv[4] || *addr_arg_endp != '\0')
3506f4a874SAlex Deymo 			return CMD_RET_USAGE;
3606f4a874SAlex Deymo 	} else {
37891380b5SKever Yang 		addr_str = env_get("kernel_addr_r");
3806f4a874SAlex Deymo 		if (addr_str)
3906f4a874SAlex Deymo 			load_address = simple_strtoul(addr_str, NULL, 16);
4006f4a874SAlex Deymo 		else
4106f4a874SAlex Deymo 			load_address = CONFIG_SYS_LOAD_ADDR;
4206f4a874SAlex Deymo 	}
4306f4a874SAlex Deymo 
44*3f251879SKever Yang 	/* ARM64 kernel load addr need to align to 0x80000, and android boot.img
45*3f251879SKever Yang 	 * have a 2KB header, need to reserve space for it.
46*3f251879SKever Yang 	 */
47*3f251879SKever Yang 	load_address &= ~0x7ffff;
48*3f251879SKever Yang 	load_address -= 0x800; /* default page size for boot header */
49891380b5SKever Yang 	dev_desc = blk_get_dev(argv[1], simple_strtoul(argv[2], NULL, 16));
50891380b5SKever Yang 	if (!dev_desc) {
51891380b5SKever Yang 		printf("Could not get %s %s\n", argv[1], argv[2]);
5206f4a874SAlex Deymo 		return CMD_RET_FAILURE;
5306f4a874SAlex Deymo 	}
5406f4a874SAlex Deymo 
55891380b5SKever Yang 	ret = android_bootloader_boot_flow(dev_desc, load_address);
5606f4a874SAlex Deymo 	if (ret < 0) {
5706f4a874SAlex Deymo 		printf("Android boot failed, error %d.\n", ret);
5806f4a874SAlex Deymo 		return CMD_RET_FAILURE;
5906f4a874SAlex Deymo 	}
6006f4a874SAlex Deymo 	return CMD_RET_SUCCESS;
6106f4a874SAlex Deymo }
6206f4a874SAlex Deymo 
6306f4a874SAlex Deymo U_BOOT_CMD(
6480622240SAlex Deymo 	boot_android, 5, 0, do_boot_android,
6506f4a874SAlex Deymo 	"Execute the Android Bootloader flow.",
66df7cce43SAlex Deymo 	"<interface> <dev[:part|;part_name]> <slot> [<kernel_addr>]\n"
6706f4a874SAlex Deymo 	"    - Load the Boot Control Block (BCB) from the partition 'part' on\n"
6806f4a874SAlex Deymo 	"      device type 'interface' instance 'dev' to determine the boot\n"
6906f4a874SAlex Deymo 	"      mode, and load and execute the appropriate kernel.\n"
7006f4a874SAlex Deymo 	"      In normal and recovery mode, the kernel will be loaded from\n"
7106f4a874SAlex Deymo 	"      the corresponding \"boot\" partition. In bootloader mode, the\n"
7206f4a874SAlex Deymo 	"      command defined in the \"fastbootcmd\" variable will be\n"
7306f4a874SAlex Deymo 	"      executed.\n"
7480622240SAlex Deymo 	"      On Android devices with multiple slots, the pass 'slot' is\n"
7580622240SAlex Deymo 	"      used to load the appropriate kernel. The standard slot names\n"
7680622240SAlex Deymo 	"      are 'a' and 'b'.\n"
7706f4a874SAlex Deymo 	"    - If 'part_name' is passed, preceded with a ; instead of :, the\n"
7806f4a874SAlex Deymo 	"      partition name whose label is 'part_name' will be looked up in\n"
7906f4a874SAlex Deymo 	"      the partition table. This is commonly the \"misc\" partition.\n"
8006f4a874SAlex Deymo );
81e8e29e8dSJason Zhu 
8237a7bc39SJason Zhu #ifdef CONFIG_RK_AVB_LIBAVB_USER
8382ee22d4SJason Zhu static int bootloader_message_read(struct android_bootloader_message *data)
8482ee22d4SJason Zhu {
8582ee22d4SJason Zhu 	AvbOps *ops;
8682ee22d4SJason Zhu 	char requested_partitions[] = "misc";
8782ee22d4SJason Zhu 	size_t out_num_read;
8882ee22d4SJason Zhu 	char *buffer;
8982ee22d4SJason Zhu 
9082ee22d4SJason Zhu 	ops = avb_ops_user_new();
9182ee22d4SJason Zhu 	buffer = (char *)data;
9282ee22d4SJason Zhu 
9382ee22d4SJason Zhu 	if (ops == NULL) {
9482ee22d4SJason Zhu 		printf("avb_ops_user_new() failed!\n");
9582ee22d4SJason Zhu 		return CMD_RET_FAILURE;
9682ee22d4SJason Zhu 	}
9782ee22d4SJason Zhu 
9882ee22d4SJason Zhu 	if (ops->read_from_partition(ops, requested_partitions,
9982ee22d4SJason Zhu 				     0, 2048, buffer,
10082ee22d4SJason Zhu 				     &out_num_read) != 0) {
10182ee22d4SJason Zhu 		printf("do avb read error!\n");
10282ee22d4SJason Zhu 		avb_ops_user_free(ops);
10382ee22d4SJason Zhu 		return CMD_RET_FAILURE;
10482ee22d4SJason Zhu 	}
10582ee22d4SJason Zhu 
10682ee22d4SJason Zhu 	avb_ops_user_free(ops);
10782ee22d4SJason Zhu 
10882ee22d4SJason Zhu 	return CMD_RET_SUCCESS;
10982ee22d4SJason Zhu }
11082ee22d4SJason Zhu 
11182ee22d4SJason Zhu static int bootloader_message_write(struct android_bootloader_message *data)
11282ee22d4SJason Zhu {
11382ee22d4SJason Zhu 	AvbOps *ops;
11482ee22d4SJason Zhu 	char requested_partitions[] = "misc";
11582ee22d4SJason Zhu 	char *buffer;
11682ee22d4SJason Zhu 
11782ee22d4SJason Zhu 	ops = avb_ops_user_new();
11882ee22d4SJason Zhu 	buffer = (char *)data;
11982ee22d4SJason Zhu 
12082ee22d4SJason Zhu 	if (ops == NULL) {
12182ee22d4SJason Zhu 		printf("avb_ops_user_new() failed!\n");
12282ee22d4SJason Zhu 		return CMD_RET_FAILURE;
12382ee22d4SJason Zhu 	}
12482ee22d4SJason Zhu 
12582ee22d4SJason Zhu 	if (ops->write_to_partition(ops, requested_partitions,
12682ee22d4SJason Zhu 				     0, 2048, buffer) != 0) {
12782ee22d4SJason Zhu 		printf("do avb write error!\n");
12882ee22d4SJason Zhu 		avb_ops_user_free(ops);
12982ee22d4SJason Zhu 		return CMD_RET_FAILURE;
13082ee22d4SJason Zhu 	}
13182ee22d4SJason Zhu 
13282ee22d4SJason Zhu 	avb_ops_user_free(ops);
13382ee22d4SJason Zhu 
13482ee22d4SJason Zhu 	return CMD_RET_SUCCESS;
13582ee22d4SJason Zhu }
13682ee22d4SJason Zhu 
137e8e29e8dSJason Zhu int do_avb_init_ab_metadata(cmd_tbl_t *cmdtp, int flag,
138e8e29e8dSJason Zhu 			    int argc, char * const argv[])
139e8e29e8dSJason Zhu {
140e8e29e8dSJason Zhu 	AvbOps *ops;
141e8e29e8dSJason Zhu 	AvbABData ab_data;
142e8e29e8dSJason Zhu 
143e8e29e8dSJason Zhu 	memset(&ab_data, 0, sizeof(AvbABData));
144e8e29e8dSJason Zhu 	debug("sizeof(AvbABData) = %d\n", sizeof(AvbABData));
145e8e29e8dSJason Zhu 	if (argc != 1)
146e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
147e8e29e8dSJason Zhu 
148e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
149e8e29e8dSJason Zhu 	if (ops == NULL) {
150e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
151e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
152e8e29e8dSJason Zhu 	}
153e8e29e8dSJason Zhu 
15437a7bc39SJason Zhu 	avb_ab_data_init(&ab_data);
155e8e29e8dSJason Zhu 	if (ops->ab_ops->write_ab_metadata(ops->ab_ops, &ab_data) != 0) {
156e8e29e8dSJason Zhu 		printf("do_avb_init_ab_metadata error!\n");
157e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
158e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
159e8e29e8dSJason Zhu 	}
160e8e29e8dSJason Zhu 
161e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
162e8e29e8dSJason Zhu 
163e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
164e8e29e8dSJason Zhu }
165e8e29e8dSJason Zhu 
166e8e29e8dSJason Zhu int do_avb_version(cmd_tbl_t *cmdtp, int flag, int argc,
167e8e29e8dSJason Zhu 		   char * const argv[])
168e8e29e8dSJason Zhu {
169e8e29e8dSJason Zhu 	const char *avb_version;
170e8e29e8dSJason Zhu 
171e8e29e8dSJason Zhu 	if (argc != 1)
172e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
173e8e29e8dSJason Zhu 
174e8e29e8dSJason Zhu 	avb_version = avb_version_string();
175e8e29e8dSJason Zhu 	printf("Android avb version is %s.\n", avb_version);
176e8e29e8dSJason Zhu 
177e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
178e8e29e8dSJason Zhu }
179e8e29e8dSJason Zhu 
180e8e29e8dSJason Zhu int do_avb_ab_mark_slot_active(cmd_tbl_t *cmdtp, int flag,
181e8e29e8dSJason Zhu 			       int argc, char * const argv[])
182e8e29e8dSJason Zhu {
183e8e29e8dSJason Zhu 	AvbOps *ops;
184e8e29e8dSJason Zhu 	unsigned int slot_number;
185e8e29e8dSJason Zhu 
186e8e29e8dSJason Zhu 	if (argc != 2)
187e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
188e8e29e8dSJason Zhu 
189e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
190e8e29e8dSJason Zhu 	if (ops == NULL) {
191e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
192e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
193e8e29e8dSJason Zhu 	}
194e8e29e8dSJason Zhu 
195e8e29e8dSJason Zhu 	slot_number = simple_strtoul(argv[1], NULL, 16);
196e8e29e8dSJason Zhu 	if (avb_ab_mark_slot_active(ops->ab_ops, slot_number) != 0) {
197e8e29e8dSJason Zhu 		printf("avb_ab_mark_slot_active error!\n");
198e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
199e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
200e8e29e8dSJason Zhu 	}
201e8e29e8dSJason Zhu 
202e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
203e8e29e8dSJason Zhu 
204e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
205e8e29e8dSJason Zhu }
206e8e29e8dSJason Zhu 
207e8e29e8dSJason Zhu int do_avb_ab_mark_slot_unbootable(cmd_tbl_t *cmdtp, int flag,
208e8e29e8dSJason Zhu 				   int argc, char * const argv[])
209e8e29e8dSJason Zhu {
210e8e29e8dSJason Zhu 	AvbOps *ops;
211e8e29e8dSJason Zhu 	unsigned int slot_number;
212e8e29e8dSJason Zhu 
213e8e29e8dSJason Zhu 	if (argc != 2)
214e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
215e8e29e8dSJason Zhu 
216e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
217e8e29e8dSJason Zhu 	if (ops == NULL) {
218e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
219e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
220e8e29e8dSJason Zhu 	}
221e8e29e8dSJason Zhu 
222e8e29e8dSJason Zhu 	slot_number = simple_strtoul(argv[1], NULL, 16);
223e8e29e8dSJason Zhu 	if (avb_ab_mark_slot_unbootable(ops->ab_ops, slot_number) != 0) {
224e8e29e8dSJason Zhu 		printf("do_avb_ab_mark_slot_unbootable error!\n");
225e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
226e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
227e8e29e8dSJason Zhu 	}
228e8e29e8dSJason Zhu 
229e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
230e8e29e8dSJason Zhu 
231e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
232e8e29e8dSJason Zhu }
233e8e29e8dSJason Zhu 
234e8e29e8dSJason Zhu int do_avb_ab_mark_slot_successful(cmd_tbl_t *cmdtp, int flag,
235e8e29e8dSJason Zhu 				   int argc, char * const argv[])
236e8e29e8dSJason Zhu {
237e8e29e8dSJason Zhu 	AvbOps *ops;
238e8e29e8dSJason Zhu 	unsigned int slot_number;
239e8e29e8dSJason Zhu 
240e8e29e8dSJason Zhu 	if (argc != 2)
241e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
242e8e29e8dSJason Zhu 
243e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
244e8e29e8dSJason Zhu 	if (ops == NULL) {
245e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
246e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
247e8e29e8dSJason Zhu 	}
248e8e29e8dSJason Zhu 
249e8e29e8dSJason Zhu 	slot_number = simple_strtoul(argv[1], NULL, 16);
250e8e29e8dSJason Zhu 	if (avb_ab_mark_slot_successful(ops->ab_ops, slot_number) != 0) {
251e8e29e8dSJason Zhu 		printf("do_avb_ab_mark_slot_successful error!\n");
252e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
253e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
254e8e29e8dSJason Zhu 	}
255e8e29e8dSJason Zhu 
256e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
257e8e29e8dSJason Zhu 
258e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
259e8e29e8dSJason Zhu }
260e8e29e8dSJason Zhu 
261e8e29e8dSJason Zhu int do_avb_read_rollback_index(cmd_tbl_t *cmdtp, int flag,
262e8e29e8dSJason Zhu 			       int argc, char * const argv[])
263e8e29e8dSJason Zhu {
264e8e29e8dSJason Zhu 	AvbOps *ops;
265e8e29e8dSJason Zhu 	uint64_t out_rollback_index;
266e8e29e8dSJason Zhu 	size_t rollback_index_location;
267e8e29e8dSJason Zhu 
268e8e29e8dSJason Zhu 	if (argc != 2)
269e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
270e8e29e8dSJason Zhu 
271e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
272e8e29e8dSJason Zhu 	if (ops == NULL) {
273e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
274e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
275e8e29e8dSJason Zhu 	}
276e8e29e8dSJason Zhu 
277e8e29e8dSJason Zhu 	rollback_index_location = simple_strtoul(argv[1], NULL, 16);
278e8e29e8dSJason Zhu 	if (ops->read_rollback_index(ops, rollback_index_location,
279e8e29e8dSJason Zhu 				     &out_rollback_index) != 0) {
280e8e29e8dSJason Zhu 		printf("do_avb_read_rollback_index error!\n");
281e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
282e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
283e8e29e8dSJason Zhu 	}
284e8e29e8dSJason Zhu 
285e8e29e8dSJason Zhu 	printf("out_rollback_index = %llx\n", out_rollback_index);
286e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
287e8e29e8dSJason Zhu 
288e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
289e8e29e8dSJason Zhu }
290e8e29e8dSJason Zhu 
291e8e29e8dSJason Zhu int do_avb_write_rollback_index(cmd_tbl_t *cmdtp, int flag,
292e8e29e8dSJason Zhu 				int argc, char * const argv[])
293e8e29e8dSJason Zhu {
294e8e29e8dSJason Zhu 	AvbOps *ops;
295e8e29e8dSJason Zhu 	uint64_t out_rollback_index;
296e8e29e8dSJason Zhu 	size_t rollback_index_location;
297e8e29e8dSJason Zhu 
298e8e29e8dSJason Zhu 	if (argc != 3)
299e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
300e8e29e8dSJason Zhu 
301e8e29e8dSJason Zhu 	rollback_index_location = simple_strtoul(argv[1], NULL, 16);
302e8e29e8dSJason Zhu 	out_rollback_index = simple_strtoull(argv[2], NULL, 16);
303e8e29e8dSJason Zhu 	debug("out_rollback_index = %llx\n", out_rollback_index);
304e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
305e8e29e8dSJason Zhu 	if (ops == NULL) {
306e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
307e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
308e8e29e8dSJason Zhu 	}
309e8e29e8dSJason Zhu 
310e8e29e8dSJason Zhu 	if (ops->write_rollback_index(ops, rollback_index_location,
311e8e29e8dSJason Zhu 				      out_rollback_index) != 0) {
312e8e29e8dSJason Zhu 		printf("do_avb_write_rollback_index error!\n");
313e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
314e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
315e8e29e8dSJason Zhu 	}
316e8e29e8dSJason Zhu 
317e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
318e8e29e8dSJason Zhu 
319e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
320e8e29e8dSJason Zhu }
321e8e29e8dSJason Zhu 
322e8e29e8dSJason Zhu int do_avb_read_is_device_unlocked(cmd_tbl_t *cmdtp, int flag,
323e8e29e8dSJason Zhu 				   int argc, char * const argv[])
324e8e29e8dSJason Zhu {
325e8e29e8dSJason Zhu 	AvbOps *ops;
326e8e29e8dSJason Zhu 	bool out_is_unlocked;
327e8e29e8dSJason Zhu 
328e8e29e8dSJason Zhu 	if (argc != 1)
329e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
330e8e29e8dSJason Zhu 
331e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
332e8e29e8dSJason Zhu 	if (ops == NULL) {
333e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
334e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
335e8e29e8dSJason Zhu 	}
336e8e29e8dSJason Zhu 
337e8e29e8dSJason Zhu 	if (ops->read_is_device_unlocked(ops, &out_is_unlocked) != 0) {
338e8e29e8dSJason Zhu 		printf("do_avb_read_is_device_unlocked error!\n");
339e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
340e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
341e8e29e8dSJason Zhu 	}
342e8e29e8dSJason Zhu 
343e8e29e8dSJason Zhu 	debug("out_is_unlocked = %d\n", out_is_unlocked);
344e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
345e8e29e8dSJason Zhu 
346e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
347e8e29e8dSJason Zhu }
348e8e29e8dSJason Zhu int do_avb_write_is_device_unlocked(cmd_tbl_t *cmdtp, int flag,
349e8e29e8dSJason Zhu 				    int argc, char * const argv[])
350e8e29e8dSJason Zhu {
351e8e29e8dSJason Zhu 	AvbOps *ops;
352e8e29e8dSJason Zhu 	bool out_is_unlocked;
353e8e29e8dSJason Zhu 
354e8e29e8dSJason Zhu 	if (argc != 2)
355e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
356e8e29e8dSJason Zhu 
357e8e29e8dSJason Zhu 	out_is_unlocked = simple_strtoul(argv[1], NULL, 16);
358e8e29e8dSJason Zhu 	if ((out_is_unlocked != 0) || (out_is_unlocked != 1))
359e8e29e8dSJason Zhu 		printf("enter out_is_unlocked value must is '0' or '1'\n");
360e8e29e8dSJason Zhu 
361e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
362e8e29e8dSJason Zhu 	if (ops == NULL) {
363e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
364e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
365e8e29e8dSJason Zhu 	}
366e8e29e8dSJason Zhu 
367e8e29e8dSJason Zhu 	if (ops->write_is_device_unlocked(ops, &out_is_unlocked) != 0) {
368e8e29e8dSJason Zhu 		printf("do_avb_write_is_device_unlocked error!\n");
369e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
370e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
371e8e29e8dSJason Zhu 	}
372e8e29e8dSJason Zhu 
373e8e29e8dSJason Zhu 	debug("out_is_unlocked = %d\n", out_is_unlocked);
374e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
375e8e29e8dSJason Zhu 
376e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
377e8e29e8dSJason Zhu }
378e8e29e8dSJason Zhu 
379e8e29e8dSJason Zhu int do_avb_get_size_of_partition(cmd_tbl_t *cmdtp, int flag,
380e8e29e8dSJason Zhu 				 int argc, char * const argv[])
381e8e29e8dSJason Zhu {
382e8e29e8dSJason Zhu 	AvbOps *ops;
383e8e29e8dSJason Zhu 	char *requested_partitions;
384e8e29e8dSJason Zhu 	uint64_t out_size_in_bytes;
385e8e29e8dSJason Zhu 
386e8e29e8dSJason Zhu 	if (argc != 2)
387e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
388e8e29e8dSJason Zhu 
389e8e29e8dSJason Zhu 	requested_partitions = argv[1];
390e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
391e8e29e8dSJason Zhu 	if (ops == NULL) {
392e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
393e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
394e8e29e8dSJason Zhu 	}
395e8e29e8dSJason Zhu 
396e8e29e8dSJason Zhu 	if (ops->get_size_of_partition(ops, requested_partitions,
397e8e29e8dSJason Zhu 				       &out_size_in_bytes) != 0) {
398e8e29e8dSJason Zhu 		printf("do_avb_get_size_of_partition error!\n");
399e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
400e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
401e8e29e8dSJason Zhu 	}
402e8e29e8dSJason Zhu 
403e8e29e8dSJason Zhu 	printf("partition size = %lld\n", out_size_in_bytes);
404e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
405e8e29e8dSJason Zhu 
406e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
407e8e29e8dSJason Zhu }
408e8e29e8dSJason Zhu 
409e8e29e8dSJason Zhu int do_avb_get_get_unique_guid_for_partition(cmd_tbl_t *cmdtp, int flag,
410e8e29e8dSJason Zhu 					     int argc, char * const argv[])
411e8e29e8dSJason Zhu {
412e8e29e8dSJason Zhu 	AvbOps *ops;
413e8e29e8dSJason Zhu 	char *requested_partitions;
414e8e29e8dSJason Zhu 	size_t guid_buf_size = 37;
415e8e29e8dSJason Zhu 	char guid_buf[37];
416e8e29e8dSJason Zhu 
417e8e29e8dSJason Zhu 	if (argc != 2)
418e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
419e8e29e8dSJason Zhu 
420e8e29e8dSJason Zhu 	requested_partitions = argv[1];
421e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
422e8e29e8dSJason Zhu 	if (ops == NULL) {
423e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
424e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
425e8e29e8dSJason Zhu 	}
426e8e29e8dSJason Zhu 
427e8e29e8dSJason Zhu 	if (ops->get_unique_guid_for_partition(ops, requested_partitions,
428e8e29e8dSJason Zhu 					       guid_buf, guid_buf_size) != 0) {
429e8e29e8dSJason Zhu 		printf("do_avb_get_get_unique_guid_for_partition error!\n");
430e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
431e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
432e8e29e8dSJason Zhu 	}
433e8e29e8dSJason Zhu 
434e8e29e8dSJason Zhu 	printf("guid = %s\n", guid_buf);
435e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
436e8e29e8dSJason Zhu 
437e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
438e8e29e8dSJason Zhu }
439e8e29e8dSJason Zhu 
440e8e29e8dSJason Zhu int do_avb_read(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
441e8e29e8dSJason Zhu {
442e8e29e8dSJason Zhu 	AvbOps *ops;
443e8e29e8dSJason Zhu 	char *requested_partitions;
444e8e29e8dSJason Zhu 	int64_t offset_blk;
445e8e29e8dSJason Zhu 	size_t blkcnt;
446e8e29e8dSJason Zhu 	size_t out_num_read;
447e8e29e8dSJason Zhu 	int i;
448e8e29e8dSJason Zhu 	char *buffer;
449e8e29e8dSJason Zhu 
450e8e29e8dSJason Zhu 	if (argc != 4)
451e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
452e8e29e8dSJason Zhu 
453e8e29e8dSJason Zhu 	requested_partitions = argv[1];
454e8e29e8dSJason Zhu 	offset_blk = simple_strtoul(argv[2], NULL, 16);
455e8e29e8dSJason Zhu 	blkcnt = simple_strtoul(argv[3], NULL, 16);
456e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
457e8e29e8dSJason Zhu 	buffer = (char *)malloc(blkcnt * 512);
458e8e29e8dSJason Zhu 	if (buffer == NULL)
459e8e29e8dSJason Zhu 		printf("malloc buffer failed!\n");
460e8e29e8dSJason Zhu 
461e8e29e8dSJason Zhu 	if (ops == NULL) {
462e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
463e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
464e8e29e8dSJason Zhu 	}
465e8e29e8dSJason Zhu 
466e8e29e8dSJason Zhu 	if (ops->read_from_partition(ops, requested_partitions,
467e8e29e8dSJason Zhu 				     offset_blk, blkcnt, buffer,
468e8e29e8dSJason Zhu 				     &out_num_read) != 0) {
469e8e29e8dSJason Zhu 		printf("do avb read error!\n");
470e8e29e8dSJason Zhu 		free(buffer);
471e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
472e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
473e8e29e8dSJason Zhu 	}
474e8e29e8dSJason Zhu 
475e8e29e8dSJason Zhu 	for (i = 0; i < 512 * blkcnt; i++)
476e8e29e8dSJason Zhu 		printf("buffer %d = %d\n", i, buffer[i]);
477e8e29e8dSJason Zhu 
478e8e29e8dSJason Zhu 	free(buffer);
479e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
480e8e29e8dSJason Zhu 
481e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
482e8e29e8dSJason Zhu }
483e8e29e8dSJason Zhu 
484e8e29e8dSJason Zhu int do_avb_write(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
485e8e29e8dSJason Zhu {
486e8e29e8dSJason Zhu 	AvbOps *ops;
487e8e29e8dSJason Zhu 	char *requested_partitions;
488e8e29e8dSJason Zhu 	int64_t offset_blk;
489e8e29e8dSJason Zhu 	size_t blkcnt;
490e8e29e8dSJason Zhu 	size_t out_num_read;
491e8e29e8dSJason Zhu 	char *buffer;
492e8e29e8dSJason Zhu 
493e8e29e8dSJason Zhu 	if (argc != 4)
494e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
495e8e29e8dSJason Zhu 
496e8e29e8dSJason Zhu 	requested_partitions = argv[1];
497e8e29e8dSJason Zhu 	offset_blk = simple_strtoul(argv[2], NULL, 16);
498e8e29e8dSJason Zhu 	blkcnt = simple_strtoul(argv[3], NULL, 16);
499e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
500e8e29e8dSJason Zhu 	buffer = (char *)malloc(blkcnt * 512);
501e8e29e8dSJason Zhu 	if (buffer == NULL) {
502e8e29e8dSJason Zhu 		printf("malloc buffer failed!\n");
503e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
504e8e29e8dSJason Zhu 	}
505e8e29e8dSJason Zhu 
506e8e29e8dSJason Zhu 	if (ops == NULL) {
507e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
508e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
509e8e29e8dSJason Zhu 	}
510e8e29e8dSJason Zhu 	if (ops->read_from_partition(ops, requested_partitions, offset_blk,
511e8e29e8dSJason Zhu 				     blkcnt, buffer, &out_num_read) != 0) {
512e8e29e8dSJason Zhu 		printf("do_avb_write error!\n");
513e8e29e8dSJason Zhu 		free(buffer);
514e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
515e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
516e8e29e8dSJason Zhu 	}
517e8e29e8dSJason Zhu 
518e8e29e8dSJason Zhu 	free(buffer);
519e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
520e8e29e8dSJason Zhu 
521e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
522e8e29e8dSJason Zhu }
523e8e29e8dSJason Zhu 
524e8e29e8dSJason Zhu int do_avb_read_ab_metadata(cmd_tbl_t *cmdtp, int flag,
525e8e29e8dSJason Zhu 			    int argc, char * const argv[])
526e8e29e8dSJason Zhu {
527e8e29e8dSJason Zhu 	AvbOps *ops;
528e8e29e8dSJason Zhu 	AvbABData ab_data;
529e8e29e8dSJason Zhu 
530e8e29e8dSJason Zhu 	if (argc != 1)
531e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
532e8e29e8dSJason Zhu 
533e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
534e8e29e8dSJason Zhu 	if (ops == NULL) {
535e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
536e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
537e8e29e8dSJason Zhu 	}
538e8e29e8dSJason Zhu 
539e8e29e8dSJason Zhu 	if (ops->ab_ops->read_ab_metadata(ops->ab_ops, &ab_data) != 0) {
540e8e29e8dSJason Zhu 		printf("do_avb_write_ab_metadata error!\n");
541e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
542e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
543e8e29e8dSJason Zhu 	}
544e8e29e8dSJason Zhu 
545e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
546e8e29e8dSJason Zhu 
547e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
548e8e29e8dSJason Zhu }
549e8e29e8dSJason Zhu 
550e8e29e8dSJason Zhu int do_avb_write_ab_metadata(cmd_tbl_t *cmdtp, int flag,
551e8e29e8dSJason Zhu 			     int argc, char * const argv[])
552e8e29e8dSJason Zhu {
553e8e29e8dSJason Zhu 	AvbOps *ops;
554e8e29e8dSJason Zhu 	AvbABData ab_data;
555e8e29e8dSJason Zhu 
556e8e29e8dSJason Zhu 	if (argc != 1)
557e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
558e8e29e8dSJason Zhu 
559e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
560e8e29e8dSJason Zhu 	if (ops == NULL) {
561e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
562e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
563e8e29e8dSJason Zhu 	}
564e8e29e8dSJason Zhu 
565e8e29e8dSJason Zhu 	if (ops->ab_ops->write_ab_metadata(ops->ab_ops, &ab_data) != 0) {
566e8e29e8dSJason Zhu 		printf("do_avb_write_ab_metadata error!\n");
567e8e29e8dSJason Zhu 		avb_ops_user_free(ops);
568e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
569e8e29e8dSJason Zhu 	}
570e8e29e8dSJason Zhu 
571e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
572e8e29e8dSJason Zhu 
573e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
574e8e29e8dSJason Zhu }
575e8e29e8dSJason Zhu 
576e8e29e8dSJason Zhu int do_avb_verify_partition(cmd_tbl_t *cmdtp, int flag,
577e8e29e8dSJason Zhu 			    int argc, char * const argv[])
578e8e29e8dSJason Zhu {
579e8e29e8dSJason Zhu 	AvbOps *ops;
580e8e29e8dSJason Zhu 	const char *requested_partitions[1];
581e8e29e8dSJason Zhu 	const char * slot_suffixes[2] = {"_a", "_b"};
582e8e29e8dSJason Zhu 	AvbSlotVerifyFlags flags;
583e8e29e8dSJason Zhu 	AvbSlotVerifyData *slot_data[2] = {NULL, NULL};
584e8e29e8dSJason Zhu 	AvbSlotVerifyResult verify_result;
585e8e29e8dSJason Zhu 	size_t n;
586e8e29e8dSJason Zhu 
587e8e29e8dSJason Zhu 	if (argc != 3)
588e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
589e8e29e8dSJason Zhu 
590e8e29e8dSJason Zhu 	requested_partitions[0] = argv[1];
591e8e29e8dSJason Zhu 	n = simple_strtoul(argv[2], NULL, 16);
592e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
593e8e29e8dSJason Zhu 	flags = AVB_SLOT_VERIFY_FLAGS_NONE;
594e8e29e8dSJason Zhu 	verify_result =
595e8e29e8dSJason Zhu 		avb_slot_verify(ops,
596e8e29e8dSJason Zhu 				requested_partitions,
597e8e29e8dSJason Zhu 				slot_suffixes[n],
598e8e29e8dSJason Zhu 				flags,
599e8e29e8dSJason Zhu 				AVB_HASHTREE_ERROR_MODE_RESTART_AND_INVALIDATE,
600e8e29e8dSJason Zhu 				&slot_data[n]);
601e8e29e8dSJason Zhu 	if (verify_result != 0)
602e8e29e8dSJason Zhu 		return CMD_RET_FAILURE;
603e8e29e8dSJason Zhu 
604e8e29e8dSJason Zhu 	avb_ops_user_free(ops);
605e8e29e8dSJason Zhu 
606e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
607e8e29e8dSJason Zhu }
608e8e29e8dSJason Zhu 
609e8e29e8dSJason Zhu int do_avb_flow(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
610e8e29e8dSJason Zhu {
611f0864c7fSJason Zhu 	char slot_partition[2][20] = {{0}, {0}};
612e8e29e8dSJason Zhu 	unsigned long load_address;
613e8e29e8dSJason Zhu 	AvbOps *ops;
614e8e29e8dSJason Zhu 	const char *avb_version;
615e8e29e8dSJason Zhu 	AvbSlotVerifyData *slot_data;
616e8e29e8dSJason Zhu 	AvbSlotVerifyFlags flags;
617e8e29e8dSJason Zhu 	const char *requested_partitions[] = {"boot", "system", NULL};
618e8e29e8dSJason Zhu 	char *command_line;
61937a7bc39SJason Zhu 	bool unlocked;
620e8e29e8dSJason Zhu 	const char *mode_cmdline = NULL;
621e8e29e8dSJason Zhu 	char root_data[70] = "root=PARTUUID=";
62237a7bc39SJason Zhu 	char *vboot_state = "androidboot.verifiedbootstate=";
6239aed1a13SJason Zhu 	char avb_root_data[2000] = {0};
624e8e29e8dSJason Zhu 	size_t guid_buf_size = 37;
625e8e29e8dSJason Zhu 	char guid_buf[37];
626e8e29e8dSJason Zhu 	char verify_flag;
627e8e29e8dSJason Zhu 	char boot_slot_select[5];
62882ee22d4SJason Zhu 	struct android_bootloader_message data;
62982ee22d4SJason Zhu 	const char *fastboot_cmd = env_get("fastbootcmd");
63037a7bc39SJason Zhu 	AvbABFlowResult ab_result;
631e8e29e8dSJason Zhu 
632e8e29e8dSJason Zhu 	if (argc != 2)
633e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
63482ee22d4SJason Zhu 
63582ee22d4SJason Zhu 	bootloader_message_read(&data);
63682ee22d4SJason Zhu 	if (!strcmp("bootonce-bootloader", data.command)) {
63782ee22d4SJason Zhu 		memset(data.command, 0, sizeof(data.command));
63882ee22d4SJason Zhu 		bootloader_message_write(&data);
63982ee22d4SJason Zhu 		if (fastboot_cmd) {
64082ee22d4SJason Zhu 			printf("bootonce-bootloader!\n");
64182ee22d4SJason Zhu 			return run_command(fastboot_cmd, CMD_FLAG_ENV);
64282ee22d4SJason Zhu 		} else {
64382ee22d4SJason Zhu 			printf("The fastbootcmd is NULL!\n");
64437a7bc39SJason Zhu 			goto fail;
64582ee22d4SJason Zhu 		}
64682ee22d4SJason Zhu 	} else if (!strcmp("boot-recovery", data.command)) {
64782ee22d4SJason Zhu 		printf("Enter boot-recovery!\n");
64882ee22d4SJason Zhu 	} else if(!strcmp("boot-normal", data.command)) {
64982ee22d4SJason Zhu 		printf("Enter boot-normal!\n");
65082ee22d4SJason Zhu 		mode_cmdline = "skip_initramfs";
65182ee22d4SJason Zhu 	} else {
6529f7ea89dSWenping Zhang 		/*
6539f7ea89dSWenping Zhang 		 * Firstly, confirm if there is a command in misc partition in
6549f7ea89dSWenping Zhang 		 * previous cases, and then we need to confirm whether user has
6559f7ea89dSWenping Zhang 		 * requested to enter recovery mode by entering "reboot recovery"
6569f7ea89dSWenping Zhang 		 * command through adb or serial console.
6579f7ea89dSWenping Zhang 		 */
6589f7ea89dSWenping Zhang 		char *env_rebootmode = env_get("reboot_mode");
6599f7ea89dSWenping Zhang 
6609f7ea89dSWenping Zhang 		if (env_rebootmode && !strcmp("recovery", env_rebootmode))
6619f7ea89dSWenping Zhang 			printf("Enter recovery mode by command 'reboot recovery'!\n");
6629f7ea89dSWenping Zhang 		else
66382ee22d4SJason Zhu 			mode_cmdline = "skip_initramfs";
66482ee22d4SJason Zhu 	}
66582ee22d4SJason Zhu 
666e8e29e8dSJason Zhu 	avb_version = avb_version_string();
667e8e29e8dSJason Zhu 	printf("Android avb version is %s.\n", avb_version);
668e8e29e8dSJason Zhu 	ops = avb_ops_user_new();
66937a7bc39SJason Zhu 	if (ops == NULL) {
670e8e29e8dSJason Zhu 		printf("avb_ops_user_new() failed!\n");
67137a7bc39SJason Zhu 		goto fail;
67237a7bc39SJason Zhu 	}
673e8e29e8dSJason Zhu 
67437a7bc39SJason Zhu 	if (ops->read_is_device_unlocked(ops, &unlocked) != 0) {
675e8e29e8dSJason Zhu 		printf("Error determining whether device is unlocked.\n");
67637a7bc39SJason Zhu 		unlocked = ANDROID_VBOOT_UNLOCK;
67737a7bc39SJason Zhu 		if (ops->write_is_device_unlocked(ops, &unlocked) != 0) {
67837a7bc39SJason Zhu 			printf("Can not write lock state!\n");
67937a7bc39SJason Zhu 			unlocked = ANDROID_VBOOT_LOCK;
68037a7bc39SJason Zhu 		}
68137a7bc39SJason Zhu 		if (ops->read_is_device_unlocked(ops, &unlocked) != 0) {
68237a7bc39SJason Zhu 			printf("Can not read lock state!\n");
68337a7bc39SJason Zhu 			unlocked = ANDROID_VBOOT_LOCK;
68437a7bc39SJason Zhu 		}
68537a7bc39SJason Zhu 	}
686e8e29e8dSJason Zhu 
687e8e29e8dSJason Zhu 	printf("read_is_device_unlocked() ops returned that device is %s\n",
688e8e29e8dSJason Zhu 	       unlocked ? "UNLOCKED" : "LOCKED");
689e8e29e8dSJason Zhu 
690e8e29e8dSJason Zhu 	flags = AVB_SLOT_VERIFY_FLAGS_NONE;
691e8e29e8dSJason Zhu 	if (unlocked)
692e8e29e8dSJason Zhu 		flags |= AVB_SLOT_VERIFY_FLAGS_ALLOW_VERIFICATION_ERROR;
693e8e29e8dSJason Zhu 
694e8e29e8dSJason Zhu 	verify_flag = argv[1][0];
695e8e29e8dSJason Zhu 	if (verify_flag == 'v') {
696e8e29e8dSJason Zhu 		debug("start with verify!\n");
69737a7bc39SJason Zhu 		ab_result =
69837a7bc39SJason Zhu 		    avb_ab_flow(ops->ab_ops,
699e8e29e8dSJason Zhu 				requested_partitions,
700e8e29e8dSJason Zhu 				flags,
701e8e29e8dSJason Zhu 				AVB_HASHTREE_ERROR_MODE_RESTART_AND_INVALIDATE,
70237a7bc39SJason Zhu 				&slot_data);
70337a7bc39SJason Zhu 		if ((ab_result != AVB_AB_FLOW_RESULT_OK) &&
70437a7bc39SJason Zhu 		    (ab_result !=
70537a7bc39SJason Zhu 		    AVB_AB_FLOW_RESULT_OK_WITH_VERIFICATION_ERROR)) {
7064397fdfdSJason Zhu 			printf("avb_ab_flow() error!\n");
70737a7bc39SJason Zhu 			avb_ops_user_free(ops);
70837a7bc39SJason Zhu 			goto fail;
70937a7bc39SJason Zhu 		}
71037a7bc39SJason Zhu 
71137a7bc39SJason Zhu 		if (ab_result ==\
71237a7bc39SJason Zhu 		    AVB_AB_FLOW_RESULT_OK_WITH_VERIFICATION_ERROR) {
71337a7bc39SJason Zhu 			strcat(avb_root_data, vboot_state);
71437a7bc39SJason Zhu 			strcat(avb_root_data, "orange");
71537a7bc39SJason Zhu 		} else if (ab_result == AVB_AB_FLOW_RESULT_OK) {
71637a7bc39SJason Zhu 			strcat(avb_root_data, vboot_state);
71737a7bc39SJason Zhu 			strcat(avb_root_data, "green");
7184397fdfdSJason Zhu 		}
7194397fdfdSJason Zhu 
720e8e29e8dSJason Zhu 		command_line = android_assemble_cmdline(slot_data->ab_suffix,
721e8e29e8dSJason Zhu 							mode_cmdline);
7229aed1a13SJason Zhu 		strcat(avb_root_data, " ");
7239aed1a13SJason Zhu 		strcat(avb_root_data, command_line);
7249aed1a13SJason Zhu 		strcat(avb_root_data, " ");
7259aed1a13SJason Zhu 		strcat(avb_root_data, slot_data->cmdline);
7269aed1a13SJason Zhu 		env_set("bootargs", avb_root_data);
727e8e29e8dSJason Zhu 		load_address = CONFIG_SYS_LOAD_ADDR;
72837a7bc39SJason Zhu 		if (rk_avb_close_optee_client())
729708de143SJason Zhu 			printf("Can not close optee client!\n");
730708de143SJason Zhu 
731e8e29e8dSJason Zhu 		memcpy((uint8_t*)load_address,
732e8e29e8dSJason Zhu 		       slot_data->loaded_partitions->data,
733e8e29e8dSJason Zhu 		       slot_data->loaded_partitions->data_size);
734e8e29e8dSJason Zhu 		android_bootloader_boot_kernel(load_address);
73537a7bc39SJason Zhu 		avb_ops_user_free(ops);
736e8e29e8dSJason Zhu 	} else if (verify_flag == 'n') {
737e8e29e8dSJason Zhu 		load_address = CONFIG_SYS_LOAD_ADDR;
73837a7bc39SJason Zhu 		rk_avb_ab_slot_select(ops->ab_ops, boot_slot_select);
739e8e29e8dSJason Zhu 		strcat(slot_partition[1], requested_partitions[1]);
740e8e29e8dSJason Zhu 		strcat(slot_partition[1], boot_slot_select);
741e8e29e8dSJason Zhu 		printf("%s\n", slot_partition[1]);
742e8e29e8dSJason Zhu 		ops->get_unique_guid_for_partition(ops,
743e8e29e8dSJason Zhu 						   slot_partition[1],
744e8e29e8dSJason Zhu 						   guid_buf,
745e8e29e8dSJason Zhu 						   guid_buf_size);
746e8e29e8dSJason Zhu 		strcat(root_data, guid_buf);
747e8e29e8dSJason Zhu 		command_line = android_assemble_cmdline(boot_slot_select,
748e8e29e8dSJason Zhu 							mode_cmdline);
749e8e29e8dSJason Zhu 		strcat(root_data, " ");
750e8e29e8dSJason Zhu 		strcat(root_data, command_line);
751e8e29e8dSJason Zhu 		env_set("bootargs", root_data);
75237a7bc39SJason Zhu 		if (android_avb_boot_flow(boot_slot_select, load_address)) {
75337a7bc39SJason Zhu 			printf("Cannot boot the system, goto the fastboot!\n");
75437a7bc39SJason Zhu 			avb_ops_user_free(ops);
75537a7bc39SJason Zhu 			goto fail;
75637a7bc39SJason Zhu 		}
75737a7bc39SJason Zhu 		avb_ops_user_free(ops);
758bf17c627SJason Zhu 	} else if (verify_flag == 'o') {
759bf17c627SJason Zhu 		load_address = CONFIG_SYS_LOAD_ADDR;
760bf17c627SJason Zhu 		strcat(slot_partition[1], requested_partitions[1]);
761bf17c627SJason Zhu 		ops->get_unique_guid_for_partition(ops,
762bf17c627SJason Zhu 						   slot_partition[1],
763bf17c627SJason Zhu 						   guid_buf,
764bf17c627SJason Zhu 						   guid_buf_size);
765bf17c627SJason Zhu 		strcat(root_data, guid_buf);
766bf17c627SJason Zhu 		command_line = android_assemble_cmdline(boot_slot_select,
767bf17c627SJason Zhu 							mode_cmdline);
768bf17c627SJason Zhu 		strcat(root_data, " ");
769bf17c627SJason Zhu 		strcat(root_data, command_line);
770bf17c627SJason Zhu 		env_set("bootargs", root_data);
77137a7bc39SJason Zhu 		if (android_boot_flow(load_address)) {
77237a7bc39SJason Zhu 			printf("Cannot boot the system, goto the fastboot!\n");
77337a7bc39SJason Zhu 			avb_ops_user_free(ops);
77437a7bc39SJason Zhu 			goto fail;
77537a7bc39SJason Zhu 		}
77637a7bc39SJason Zhu 		avb_ops_user_free(ops);
777e8e29e8dSJason Zhu 	} else {
778e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
779e8e29e8dSJason Zhu 	}
780e8e29e8dSJason Zhu 
781e8e29e8dSJason Zhu 	return CMD_RET_SUCCESS;
78237a7bc39SJason Zhu fail:
78337a7bc39SJason Zhu 	if (fastboot_cmd == NULL) {
78437a7bc39SJason Zhu 		printf("fastboot_cmd is null, run default fastboot_cmd!\n");
78537a7bc39SJason Zhu 		fastboot_cmd = "fastboot usb 0";
78637a7bc39SJason Zhu 	}
78737a7bc39SJason Zhu 
78837a7bc39SJason Zhu 	return run_command(fastboot_cmd, CMD_FLAG_ENV);
789e8e29e8dSJason Zhu }
790e8e29e8dSJason Zhu 
791e8e29e8dSJason Zhu static cmd_tbl_t cmd_avb[] = {
792e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(init, 1, 1, do_avb_init_ab_metadata, "", ""),
793e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(version, 1, 1, do_avb_version, "", ""),
794e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(slot_active, 2, 1,
795e8e29e8dSJason Zhu 			 do_avb_ab_mark_slot_active, "", ""),
796e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(slot_unbootable, 2, 1,
797e8e29e8dSJason Zhu 			 do_avb_ab_mark_slot_unbootable, "", ""),
798e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(slot_successful, 2, 1,
799e8e29e8dSJason Zhu 			 do_avb_ab_mark_slot_successful, "", ""),
800e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(read_rollback, 2, 1,
801e8e29e8dSJason Zhu 			 do_avb_read_rollback_index, "", ""),
802e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(write_rollback, 3, 1,
803e8e29e8dSJason Zhu 			 do_avb_write_rollback_index, "", ""),
804e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(read_lock_status, 1, 1,
805e8e29e8dSJason Zhu 			 do_avb_read_is_device_unlocked, "", ""),
806e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(write_lock_status, 2, 1,
807e8e29e8dSJason Zhu 			 do_avb_write_is_device_unlocked, "", ""),
808e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(part_size, 2, 1,
809e8e29e8dSJason Zhu 			 do_avb_get_size_of_partition, "", ""),
810e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(part_guid, 2, 1,
811e8e29e8dSJason Zhu 			 do_avb_get_get_unique_guid_for_partition, "", ""),
812e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(read, 4, 1, do_avb_read, "", ""),
813e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(write, 4, 1, do_avb_write, "", ""),
814e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(readabmisc, 1, 1, do_avb_read_ab_metadata, "", ""),
815e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(writeabmisc, 1, 1, do_avb_write_ab_metadata, "", ""),
816e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(verify, 3, 1, do_avb_verify_partition, "", ""),
817e8e29e8dSJason Zhu 	U_BOOT_CMD_MKENT(flow, 2, 1, do_avb_flow, "", "")
818e8e29e8dSJason Zhu };
819e8e29e8dSJason Zhu 
820e8e29e8dSJason Zhu static int do_boot_avb(cmd_tbl_t *cmdtp,
821e8e29e8dSJason Zhu 		       int flag,
822e8e29e8dSJason Zhu 		       int argc,
823e8e29e8dSJason Zhu 		       char * const argv[])
824e8e29e8dSJason Zhu {
825e8e29e8dSJason Zhu 	cmd_tbl_t *cp;
826e8e29e8dSJason Zhu 
827e8e29e8dSJason Zhu 	cp = find_cmd_tbl(argv[1], cmd_avb, ARRAY_SIZE(cmd_avb));
828e8e29e8dSJason Zhu 
829e8e29e8dSJason Zhu 	argc--;
830e8e29e8dSJason Zhu 	argv++;
831e8e29e8dSJason Zhu 
832e8e29e8dSJason Zhu 	if (cp == NULL || argc > cp->maxargs)
833e8e29e8dSJason Zhu 		return CMD_RET_USAGE;
834e8e29e8dSJason Zhu 	if (flag == CMD_FLAG_REPEAT && !cp->repeatable)
835e8e29e8dSJason Zhu 		return CMD_RET_SUCCESS;
836e8e29e8dSJason Zhu 
837e8e29e8dSJason Zhu 	return cp->cmd(cmdtp, flag, argc, argv);
838e8e29e8dSJason Zhu }
839e8e29e8dSJason Zhu 
840e8e29e8dSJason Zhu U_BOOT_CMD(
841e8e29e8dSJason Zhu 	bootavb, 29, 1, do_boot_avb,
842e8e29e8dSJason Zhu 	"Execute the Android avb a/b boot flow.",
843e8e29e8dSJason Zhu 	"init - initialize the avbabmeta\n"
844e8e29e8dSJason Zhu 	"bootavb version - display info of bootavb version\n"
845e8e29e8dSJason Zhu 	"bootavb slot_active cnt\n"
846e8e29e8dSJason Zhu 	"bootavb slot_unbootable cnt\n"
847e8e29e8dSJason Zhu 	"bootavb slot_successful cnt\n"
848e8e29e8dSJason Zhu 	"bootavb read_rollback rollback_index_location\n"
849e8e29e8dSJason Zhu 	"bootavb write_rollback rollback_index_location out_rollback_index\n"
850e8e29e8dSJason Zhu 	"bootavb read_lock_status\n"
851e8e29e8dSJason Zhu 	"bootavb write_lock_status 0 or 1\n"
852e8e29e8dSJason Zhu 	"bootavb part_size partitions_name\n"
853e8e29e8dSJason Zhu 	"bootavb part_guid partitions_name\n"
854e8e29e8dSJason Zhu 	"bootavb read partition offset_blk cnt\n"
855e8e29e8dSJason Zhu 	"bootavb write partition offset_blk cnt\n"
856e8e29e8dSJason Zhu 	"bootavb readabmisc\n"
857e8e29e8dSJason Zhu 	"bootavb writeabmisc\n"
858e8e29e8dSJason Zhu 	"bootavb verify partition slot_cnt;partion name without '_a' or '_b'\n"
859e8e29e8dSJason Zhu 	"bootavb flow v/n\n"
860e8e29e8dSJason Zhu );
861e8e29e8dSJason Zhu #endif
862