xref: /rk3399_rockchip-uboot/disk/part_efi.c (revision 1afcdfc6b83091af305af477f46c5828c42399d8)
1 /*
2  * Copyright (C) 2008 RuggedCom, Inc.
3  * Richard Retanubun <RichardRetanubun@RuggedCom.com>
4  *
5  * SPDX-License-Identifier:	GPL-2.0+
6  */
7 
8 /*
9  * NOTE:
10  *   when CONFIG_SYS_64BIT_LBA is not defined, lbaint_t is 32 bits; this
11  *   limits the maximum size of addressable storage to < 2 Terra Bytes
12  */
13 #include <asm/unaligned.h>
14 #include <common.h>
15 #include <command.h>
16 #include <fdtdec.h>
17 #include <ide.h>
18 #include <inttypes.h>
19 #include <malloc.h>
20 #include <memalign.h>
21 #include <part_efi.h>
22 #include <linux/compiler.h>
23 #include <linux/ctype.h>
24 
25 DECLARE_GLOBAL_DATA_PTR;
26 
27 #ifdef HAVE_BLOCK_DEVICE
28 /**
29  * efi_crc32() - EFI version of crc32 function
30  * @buf: buffer to calculate crc32 of
31  * @len - length of buf
32  *
33  * Description: Returns EFI-style CRC32 value for @buf
34  */
35 static inline u32 efi_crc32(const void *buf, u32 len)
36 {
37 	return crc32(0, buf, len);
38 }
39 
40 /*
41  * Private function prototypes
42  */
43 
44 static int pmbr_part_valid(struct partition *part);
45 static int is_pmbr_valid(legacy_mbr * mbr);
46 static int is_gpt_valid(struct blk_desc *dev_desc, u64 lba,
47 				gpt_header *pgpt_head, gpt_entry **pgpt_pte);
48 static gpt_entry *alloc_read_gpt_entries(struct blk_desc *dev_desc,
49 					 gpt_header *pgpt_head);
50 static int is_pte_valid(gpt_entry * pte);
51 
52 static char *print_efiname(gpt_entry *pte)
53 {
54 	static char name[PARTNAME_SZ + 1];
55 	int i;
56 	for (i = 0; i < PARTNAME_SZ; i++) {
57 		u8 c;
58 		c = pte->partition_name[i] & 0xff;
59 		c = (c && !isprint(c)) ? '.' : c;
60 		name[i] = c;
61 	}
62 	name[PARTNAME_SZ] = 0;
63 	return name;
64 }
65 
66 static efi_guid_t system_guid = PARTITION_SYSTEM_GUID;
67 
68 static inline int is_bootable(gpt_entry *p)
69 {
70 	return p->attributes.fields.legacy_bios_bootable ||
71 		!memcmp(&(p->partition_type_guid), &system_guid,
72 			sizeof(efi_guid_t));
73 }
74 
75 #define FACTORY_UNKNOWN_LBA (0xffffffff - 34)
76 static int validate_gpt_header(gpt_header *gpt_h, lbaint_t lba,
77 		lbaint_t lastlba)
78 {
79 	uint32_t crc32_backup = 0;
80 	uint32_t calc_crc32;
81 
82 	/* Check the GPT header signature */
83 	if (le64_to_cpu(gpt_h->signature) != GPT_HEADER_SIGNATURE) {
84 		if (le64_to_cpu(gpt_h->signature) != 0)
85 			printf("%s signature is wrong: 0x%llX != 0x%llX\n",
86 			       "GUID Partition Table Header",
87 			       le64_to_cpu(gpt_h->signature),
88 			       GPT_HEADER_SIGNATURE);
89 		return -1;
90 	}
91 
92 	/* Check the GUID Partition Table CRC */
93 	memcpy(&crc32_backup, &gpt_h->header_crc32, sizeof(crc32_backup));
94 	memset(&gpt_h->header_crc32, 0, sizeof(gpt_h->header_crc32));
95 
96 	calc_crc32 = efi_crc32((const unsigned char *)gpt_h,
97 		le32_to_cpu(gpt_h->header_size));
98 
99 	memcpy(&gpt_h->header_crc32, &crc32_backup, sizeof(crc32_backup));
100 
101 	if (calc_crc32 != le32_to_cpu(crc32_backup)) {
102 		printf("%s CRC is wrong: 0x%x != 0x%x\n",
103 		       "GUID Partition Table Header",
104 		       le32_to_cpu(crc32_backup), calc_crc32);
105 		return -1;
106 	}
107 
108 	/*
109 	 * Check that the my_lba entry points to the LBA that contains the GPT
110 	 */
111 	if (le64_to_cpu(gpt_h->my_lba) != lba) {
112 		printf("GPT: my_lba incorrect: %llX != " LBAF "\n",
113 		       le64_to_cpu(gpt_h->my_lba),
114 		       lba);
115 		return -1;
116 	}
117 
118 	/*
119 	 * Check that the first_usable_lba and that the last_usable_lba are
120 	 * within the disk.
121 	 */
122 	if (le64_to_cpu(gpt_h->first_usable_lba) > lastlba) {
123 		printf("GPT: first_usable_lba incorrect: %llX > " LBAF "\n",
124 		       le64_to_cpu(gpt_h->first_usable_lba), lastlba);
125 		return -1;
126 	}
127 	if (le64_to_cpu(gpt_h->last_usable_lba) > lastlba) {
128 		if (le64_to_cpu(gpt_h->last_usable_lba) == FACTORY_UNKNOWN_LBA) {
129 #ifdef CONFIG_SPL_BUILD
130 			printf("GPT: SPL workaround factory last_usable_lba\n");
131 			gpt_h->last_usable_lba = lastlba - 34;
132 			return 0;
133 #else
134 			printf("GPT: last_usable_lba need repair\n");
135 			return 0;
136 #endif
137 		}
138 		printf("GPT: last_usable_lba incorrect: %llX > " LBAF "\n",
139 		       le64_to_cpu(gpt_h->last_usable_lba), lastlba);
140 		return -1;
141 	}
142 
143 	debug("GPT: first_usable_lba: %llX last_usable_lba: %llX last lba: "
144 	      LBAF "\n", le64_to_cpu(gpt_h->first_usable_lba),
145 	      le64_to_cpu(gpt_h->last_usable_lba), lastlba);
146 
147 	return 0;
148 }
149 
150 static int validate_gpt_entries(gpt_header *gpt_h, gpt_entry *gpt_e)
151 {
152 	uint32_t calc_crc32;
153 
154 	/* Check the GUID Partition Table Entry Array CRC */
155 	calc_crc32 = efi_crc32((const unsigned char *)gpt_e,
156 		le32_to_cpu(gpt_h->num_partition_entries) *
157 		le32_to_cpu(gpt_h->sizeof_partition_entry));
158 
159 	if (calc_crc32 != le32_to_cpu(gpt_h->partition_entry_array_crc32)) {
160 		printf("%s: 0x%x != 0x%x\n",
161 		       "GUID Partition Table Entry Array CRC is wrong",
162 		       le32_to_cpu(gpt_h->partition_entry_array_crc32),
163 		       calc_crc32);
164 		return -1;
165 	}
166 
167 	return 0;
168 }
169 
170 static void prepare_backup_gpt_header(gpt_header *gpt_h)
171 {
172 	uint32_t calc_crc32;
173 	uint64_t val;
174 
175 	/* recalculate the values for the Backup GPT Header */
176 	val = le64_to_cpu(gpt_h->my_lba);
177 	gpt_h->my_lba = gpt_h->alternate_lba;
178 	gpt_h->alternate_lba = cpu_to_le64(val);
179 	gpt_h->partition_entry_lba =
180 			cpu_to_le64(le64_to_cpu(gpt_h->last_usable_lba) + 1);
181 	gpt_h->header_crc32 = 0;
182 
183 	calc_crc32 = efi_crc32((const unsigned char *)gpt_h,
184 			       le32_to_cpu(gpt_h->header_size));
185 	gpt_h->header_crc32 = cpu_to_le32(calc_crc32);
186 }
187 
188 #if CONFIG_IS_ENABLED(EFI_PARTITION)
189 /*
190  * Public Functions (include/part.h)
191  */
192 
193 /*
194  * UUID is displayed as 32 hexadecimal digits, in 5 groups,
195  * separated by hyphens, in the form 8-4-4-4-12 for a total of 36 characters
196  */
197 int get_disk_guid(struct blk_desc * dev_desc, char *guid)
198 {
199 	ALLOC_CACHE_ALIGN_BUFFER_PAD(gpt_header, gpt_head, 1, dev_desc->blksz);
200 	gpt_entry *gpt_pte = NULL;
201 	unsigned char *guid_bin;
202 
203 	/* This function validates AND fills in the GPT header and PTE */
204 	if (is_gpt_valid(dev_desc, GPT_PRIMARY_PARTITION_TABLE_LBA,
205 			 gpt_head, &gpt_pte) != 1) {
206 		printf("%s: *** ERROR: Invalid GPT ***\n", __func__);
207 		if (is_gpt_valid(dev_desc, dev_desc->lba - 1,
208 				 gpt_head, &gpt_pte) != 1) {
209 			printf("%s: *** ERROR: Invalid Backup GPT ***\n",
210 			       __func__);
211 			return -EINVAL;
212 		} else {
213 			printf("%s: ***        Using Backup GPT ***\n",
214 			       __func__);
215 		}
216 	}
217 
218 	guid_bin = gpt_head->disk_guid.b;
219 	uuid_bin_to_str(guid_bin, guid, UUID_STR_FORMAT_GUID);
220 
221 	return 0;
222 }
223 
224 void part_print_efi(struct blk_desc *dev_desc)
225 {
226 	ALLOC_CACHE_ALIGN_BUFFER_PAD(gpt_header, gpt_head, 1, dev_desc->blksz);
227 	gpt_entry *gpt_pte = NULL;
228 	int i = 0;
229 	char uuid[UUID_STR_LEN + 1];
230 	unsigned char *uuid_bin;
231 
232 	/* This function validates AND fills in the GPT header and PTE */
233 	if (is_gpt_valid(dev_desc, GPT_PRIMARY_PARTITION_TABLE_LBA,
234 			 gpt_head, &gpt_pte) != 1) {
235 		printf("%s: *** ERROR: Invalid GPT ***\n", __func__);
236 		if (is_gpt_valid(dev_desc, (dev_desc->lba - 1),
237 				 gpt_head, &gpt_pte) != 1) {
238 			printf("%s: *** ERROR: Invalid Backup GPT ***\n",
239 			       __func__);
240 			return;
241 		} else {
242 			printf("%s: ***        Using Backup GPT ***\n",
243 			       __func__);
244 		}
245 	}
246 
247 	debug("%s: gpt-entry at %p\n", __func__, gpt_pte);
248 
249 	printf("Part\tStart LBA\tEnd LBA\t\tName\n");
250 	printf("\tAttributes\n");
251 	printf("\tType GUID\n");
252 	printf("\tPartition GUID\n");
253 
254 	for (i = 0; i < le32_to_cpu(gpt_head->num_partition_entries); i++) {
255 		/* Stop at the first non valid PTE */
256 		if (!is_pte_valid(&gpt_pte[i]))
257 			break;
258 
259 		printf("%3d\t0x%08llx\t0x%08llx\t\"%s\"\n", (i + 1),
260 			le64_to_cpu(gpt_pte[i].starting_lba),
261 			le64_to_cpu(gpt_pte[i].ending_lba),
262 			print_efiname(&gpt_pte[i]));
263 		printf("\tattrs:\t0x%016llx\n", gpt_pte[i].attributes.raw);
264 		uuid_bin = (unsigned char *)gpt_pte[i].partition_type_guid.b;
265 		uuid_bin_to_str(uuid_bin, uuid, UUID_STR_FORMAT_GUID);
266 		printf("\ttype:\t%s\n", uuid);
267 #ifdef CONFIG_PARTITION_TYPE_GUID
268 		if (!uuid_guid_get_str(uuid_bin, uuid))
269 			printf("\ttype:\t%s\n", uuid);
270 #endif
271 		uuid_bin = (unsigned char *)gpt_pte[i].unique_partition_guid.b;
272 		uuid_bin_to_str(uuid_bin, uuid, UUID_STR_FORMAT_GUID);
273 		printf("\tguid:\t%s\n", uuid);
274 	}
275 
276 	/* Remember to free pte */
277 	free(gpt_pte);
278 	return;
279 }
280 
281 int part_get_info_efi(struct blk_desc *dev_desc, int part,
282 		      disk_partition_t *info)
283 {
284 	static gpt_entry *gpt_pte = NULL;
285 	static gpt_header *gpt_head = NULL;
286 
287 	if (!gpt_head)
288 		gpt_head = memalign(ARCH_DMA_MINALIGN, dev_desc->blksz);
289 
290 	/*
291 	 * We suppose different dev have different size, eg. emmc vs sd
292 	 * free the pte first if exist and then will malloc and init a new one.
293 	 */
294 	if (gpt_head && (gpt_head->last_usable_lba + 0x22) != dev_desc->lba) {
295 		if (gpt_pte)
296 			free(gpt_pte);
297 		gpt_pte = NULL;
298 	}
299 
300 	/* "part" argument must be at least 1 */
301 	if (part < 1) {
302 		printf("%s: Invalid Argument(s)\n", __func__);
303 		return -1;
304 	}
305 
306 	/* This function validates AND fills in the GPT header and PTE */
307 	if (is_gpt_valid(dev_desc, GPT_PRIMARY_PARTITION_TABLE_LBA,
308 			gpt_head, &gpt_pte) != 1) {
309 		printf("%s: *** ERROR: Invalid GPT ***\n", __func__);
310 		if (is_gpt_valid(dev_desc, (dev_desc->lba - 1),
311 				 gpt_head, &gpt_pte) != 1) {
312 			printf("%s: *** ERROR: Invalid Backup GPT ***\n",
313 			       __func__);
314 			return -1;
315 		} else {
316 			printf("%s: ***        Using Backup GPT ***\n",
317 			       __func__);
318 		}
319 	}
320 
321 	if (part > le32_to_cpu(gpt_head->num_partition_entries) ||
322 	    !is_pte_valid(&gpt_pte[part - 1])) {
323 		debug("%s: *** ERROR: Invalid partition number %d ***\n",
324 			__func__, part);
325 		return -1;
326 	}
327 
328 	/* The 'lbaint_t' casting may limit the maximum disk size to 2 TB */
329 	info->start = (lbaint_t)le64_to_cpu(gpt_pte[part - 1].starting_lba);
330 	/* The ending LBA is inclusive, to calculate size, add 1 to it */
331 	info->size = (lbaint_t)le64_to_cpu(gpt_pte[part - 1].ending_lba) + 1
332 		     - info->start;
333 	info->blksz = dev_desc->blksz;
334 
335 	sprintf((char *)info->name, "%s",
336 			print_efiname(&gpt_pte[part - 1]));
337 	strcpy((char *)info->type, "U-Boot");
338 	info->bootable = is_bootable(&gpt_pte[part - 1]);
339 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
340 	uuid_bin_to_str(gpt_pte[part - 1].unique_partition_guid.b, info->uuid,
341 			UUID_STR_FORMAT_GUID);
342 #endif
343 #ifdef CONFIG_PARTITION_TYPE_GUID
344 	uuid_bin_to_str(gpt_pte[part - 1].partition_type_guid.b,
345 			info->type_guid, UUID_STR_FORMAT_GUID);
346 #endif
347 
348 	debug("%s: start 0x" LBAF ", size 0x" LBAF ", name %s\n", __func__,
349 	      info->start, info->size, info->name);
350 
351 	return 0;
352 }
353 
354 #ifdef CONFIG_RKIMG_BOOTLOADER
355 #if defined(CONFIG_SPL_KERNEL_BOOT) || !defined(CONFIG_SPL_BUILD)
356 static void gpt_entry_modify(struct blk_desc *dev_desc,
357 			     gpt_entry *gpt_pte,
358 			     gpt_header *gpt_head)
359 {
360 	int i;
361 	uint32_t calc_crc32;
362 
363 	for (i = 0; i < gpt_head->num_partition_entries; i++) {
364 		if (!is_pte_valid(&gpt_pte[i]))
365 			break;
366 	}
367 
368 	if (gpt_pte[i - 1].ending_lba <= (dev_desc->lba - 0x22))
369 		return;
370 
371 	gpt_pte[i - 1].ending_lba = dev_desc->lba - 0x22;
372 	calc_crc32 = efi_crc32((const unsigned char *)gpt_pte,
373 			       le32_to_cpu(gpt_head->num_partition_entries) *
374 			       le32_to_cpu(gpt_head->sizeof_partition_entry));
375 	gpt_head->partition_entry_array_crc32 = calc_crc32;
376 }
377 
378 static int part_efi_repair(struct blk_desc *dev_desc, gpt_entry *gpt_pte,
379 			   gpt_header *gpt_head, int head_gpt_valid,
380 			   int backup_gpt_valid)
381 {
382 	uint32_t calc_crc32;
383 	size_t count = 0, blk_cnt;
384 	lbaint_t blk;
385 
386 	if (head_gpt_valid == 1 && backup_gpt_valid == 1) {
387 		return 0;
388 	} else if (head_gpt_valid == 0 && backup_gpt_valid == 0) {
389 		return -1;
390 	} else if (head_gpt_valid == 1 && backup_gpt_valid == 0) {
391 		gpt_head->header_crc32 = 0;
392 		gpt_head->my_lba = dev_desc->lba - 1;
393 		gpt_head->alternate_lba = 1;
394 		gpt_head->partition_entry_lba = dev_desc->lba - 0x21;
395 		gpt_head->last_usable_lba = cpu_to_le64(dev_desc->lba - 34);
396 		gpt_entry_modify(dev_desc, gpt_pte, gpt_head);
397 		calc_crc32 = efi_crc32((const unsigned char *)gpt_head,
398 				       le32_to_cpu(gpt_head->header_size));
399 		gpt_head->header_crc32 = calc_crc32;
400 		if (blk_dwrite(dev_desc, dev_desc->lba - 1, 1, gpt_head) != 1) {
401 			printf("*** ERROR: Can't write GPT header ***\n");
402 			return -1;
403 		}
404 		count = le32_to_cpu(gpt_head->num_partition_entries) *
405 			le32_to_cpu(gpt_head->sizeof_partition_entry);
406 		blk = le64_to_cpu(gpt_head->partition_entry_lba);
407 		blk_cnt = BLOCK_CNT(count, dev_desc);
408 		if (blk_dwrite(dev_desc, blk, (lbaint_t)blk_cnt, gpt_pte) !=
409 		    blk_cnt) {
410 			printf("*** ERROR: Can't write entry partitions ***\n");
411 			return -1;
412 		}
413 		printf("Repair the backup gpt table OK!\n");
414 	} else if (head_gpt_valid == 0 && backup_gpt_valid == 1) {
415 		gpt_head->header_crc32 = 0;
416 		gpt_head->my_lba = 1;
417 		gpt_head->alternate_lba = dev_desc->lba - 1;
418 		gpt_head->partition_entry_lba = 0x2;
419 		gpt_head->last_usable_lba = cpu_to_le64(dev_desc->lba - 34);
420 		gpt_entry_modify(dev_desc, gpt_pte, gpt_head);
421 		calc_crc32 = efi_crc32((const unsigned char *)gpt_head,
422 				       le32_to_cpu(gpt_head->header_size));
423 		gpt_head->header_crc32 = calc_crc32;
424 		if (blk_dwrite(dev_desc, 1, 1, gpt_head) != 1) {
425 			printf("*** ERROR: Can't write GPT header ***\n");
426 			return -1;
427 		}
428 		count = le32_to_cpu(gpt_head->num_partition_entries) *
429 			le32_to_cpu(gpt_head->sizeof_partition_entry);
430 		blk = le64_to_cpu(gpt_head->partition_entry_lba);
431 		blk_cnt = BLOCK_CNT(count, dev_desc);
432 		if (blk_dwrite(dev_desc, blk, (lbaint_t)blk_cnt, gpt_pte) !=
433 		    blk_cnt) {
434 			printf("*** ERROR: Can't write entry partitions ***\n");
435 			return -1;
436 		}
437 		printf("Repair the Primary gpt table OK!\n");
438 	}
439 
440 	return 0;
441 }
442 #endif
443 #endif
444 
445 static int part_test_efi(struct blk_desc *dev_desc)
446 {
447 	ALLOC_CACHE_ALIGN_BUFFER_PAD(legacy_mbr, legacymbr, 1, dev_desc->blksz);
448 	int ret = 0;
449 
450 	/* Read legacy MBR from block 0 and validate it */
451 	if ((blk_dread(dev_desc, 0, 1, (ulong *)legacymbr) != 1)
452 		|| (is_pmbr_valid(legacymbr) != 1)) {
453 		return -1;
454 	}
455 #ifdef CONFIG_RKIMG_BOOTLOADER
456 #if defined(CONFIG_SPL_KERNEL_BOOT) || !defined(CONFIG_SPL_BUILD)
457 	gpt_entry *h_gpt_pte = NULL;
458 	gpt_header *h_gpt_head = NULL;
459 	gpt_entry *b_gpt_pte = NULL;
460 	gpt_header *b_gpt_head = NULL;
461 	int head_gpt_valid = 0;
462 	int backup_gpt_valid = 0;
463 
464 	if (!h_gpt_head)
465 		h_gpt_head = memalign(ARCH_DMA_MINALIGN, dev_desc->blksz);
466 	if (!b_gpt_head)
467 		b_gpt_head = memalign(ARCH_DMA_MINALIGN, dev_desc->blksz);
468 
469 	head_gpt_valid = is_gpt_valid(dev_desc, GPT_PRIMARY_PARTITION_TABLE_LBA,
470 				      h_gpt_head, &h_gpt_pte);
471 	backup_gpt_valid = is_gpt_valid(dev_desc, (dev_desc->lba - 1),
472 					b_gpt_head, &b_gpt_pte);
473 
474 	if ((head_gpt_valid == 1) &&
475 	    (le64_to_cpu(h_gpt_head->last_usable_lba)
476 	     == FACTORY_UNKNOWN_LBA)) {
477 		if (part_efi_repair(dev_desc, h_gpt_pte, h_gpt_head,
478 				    0, 1))
479 			printf("Primary GPT repair fail!\n");
480 	}
481 
482 	if (head_gpt_valid == 1 && backup_gpt_valid == 0) {
483 		if (part_efi_repair(dev_desc, h_gpt_pte, h_gpt_head,
484 				    head_gpt_valid, backup_gpt_valid))
485 			printf("Backup GPT repair fail!\n");
486 	} else if (head_gpt_valid == 0 && backup_gpt_valid == 1) {
487 		if (part_efi_repair(dev_desc, b_gpt_pte, b_gpt_head,
488 				    head_gpt_valid, backup_gpt_valid))
489 			printf("Primary GPT repair fail!\n");
490 	} else if (head_gpt_valid == 0 && backup_gpt_valid == 0) {
491 		ret = -1;
492 	}
493 
494 	free(h_gpt_pte);
495 	h_gpt_pte = NULL;
496 	free(h_gpt_head);
497 	h_gpt_head = NULL;
498 	free(b_gpt_pte);
499 	b_gpt_pte = NULL;
500 	free(b_gpt_head);
501 	b_gpt_head = NULL;
502 #endif
503 #endif
504 	return ret;
505 }
506 
507 /**
508  * set_protective_mbr(): Set the EFI protective MBR
509  * @param dev_desc - block device descriptor
510  *
511  * @return - zero on success, otherwise error
512  */
513 static int set_protective_mbr(struct blk_desc *dev_desc)
514 {
515 	/* Setup the Protective MBR */
516 	ALLOC_CACHE_ALIGN_BUFFER(legacy_mbr, p_mbr, 1);
517 	memset(p_mbr, 0, sizeof(*p_mbr));
518 
519 	if (p_mbr == NULL) {
520 		printf("%s: calloc failed!\n", __func__);
521 		return -1;
522 	}
523 
524 	/* Read MBR to backup boot code if it exists */
525 	if (blk_dread(dev_desc, 0, 1, p_mbr) != 1) {
526 		pr_err("** Can't read from device %d **\n", dev_desc->devnum);
527 		return -1;
528 	}
529 
530 	/* Append signature */
531 	p_mbr->signature = MSDOS_MBR_SIGNATURE;
532 	p_mbr->partition_record[0].sys_ind = EFI_PMBR_OSTYPE_EFI_GPT;
533 	p_mbr->partition_record[0].start_sect = 1;
534 	p_mbr->partition_record[0].nr_sects = (u32) dev_desc->lba - 1;
535 
536 	/* Write MBR sector to the MMC device */
537 	if (blk_dwrite(dev_desc, 0, 1, p_mbr) != 1) {
538 		printf("** Can't write to device %d **\n",
539 			dev_desc->devnum);
540 		return -1;
541 	}
542 
543 	return 0;
544 }
545 
546 int write_gpt_table(struct blk_desc *dev_desc,
547 		gpt_header *gpt_h, gpt_entry *gpt_e)
548 {
549 	const int pte_blk_cnt = BLOCK_CNT((gpt_h->num_partition_entries
550 					   * sizeof(gpt_entry)), dev_desc);
551 	u32 calc_crc32;
552 
553 	debug("max lba: %x\n", (u32) dev_desc->lba);
554 	/* Setup the Protective MBR */
555 	if (set_protective_mbr(dev_desc) < 0)
556 		goto err;
557 
558 	/* Generate CRC for the Primary GPT Header */
559 	calc_crc32 = efi_crc32((const unsigned char *)gpt_e,
560 			      le32_to_cpu(gpt_h->num_partition_entries) *
561 			      le32_to_cpu(gpt_h->sizeof_partition_entry));
562 	gpt_h->partition_entry_array_crc32 = cpu_to_le32(calc_crc32);
563 
564 	calc_crc32 = efi_crc32((const unsigned char *)gpt_h,
565 			      le32_to_cpu(gpt_h->header_size));
566 	gpt_h->header_crc32 = cpu_to_le32(calc_crc32);
567 
568 	/* Write the First GPT to the block right after the Legacy MBR */
569 	if (blk_dwrite(dev_desc, 1, 1, gpt_h) != 1)
570 		goto err;
571 
572 	if (blk_dwrite(dev_desc, le64_to_cpu(gpt_h->partition_entry_lba),
573 		       pte_blk_cnt, gpt_e) != pte_blk_cnt)
574 		goto err;
575 
576 	prepare_backup_gpt_header(gpt_h);
577 
578 	if (blk_dwrite(dev_desc, (lbaint_t)le64_to_cpu(gpt_h->last_usable_lba)
579 		       + 1, pte_blk_cnt, gpt_e) != pte_blk_cnt)
580 		goto err;
581 
582 	if (blk_dwrite(dev_desc, (lbaint_t)le64_to_cpu(gpt_h->my_lba), 1,
583 		       gpt_h) != 1)
584 		goto err;
585 
586 	debug("GPT successfully written to block device!\n");
587 	return 0;
588 
589  err:
590 	printf("** Can't write to device %d **\n", dev_desc->devnum);
591 	return -1;
592 }
593 
594 int gpt_fill_pte(struct blk_desc *dev_desc,
595 		 gpt_header *gpt_h, gpt_entry *gpt_e,
596 		 disk_partition_t *partitions, int parts)
597 {
598 	lbaint_t offset = (lbaint_t)le64_to_cpu(gpt_h->first_usable_lba);
599 	lbaint_t last_usable_lba = (lbaint_t)
600 			le64_to_cpu(gpt_h->last_usable_lba);
601 	int i, k;
602 	size_t efiname_len, dosname_len;
603 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
604 	char *str_uuid;
605 	unsigned char *bin_uuid;
606 #endif
607 #ifdef CONFIG_PARTITION_TYPE_GUID
608 	char *str_type_guid;
609 	unsigned char *bin_type_guid;
610 #endif
611 	size_t hdr_start = gpt_h->my_lba;
612 	size_t hdr_end = hdr_start + 1;
613 
614 	size_t pte_start = gpt_h->partition_entry_lba;
615 	size_t pte_end = pte_start +
616 		gpt_h->num_partition_entries * gpt_h->sizeof_partition_entry /
617 		dev_desc->blksz;
618 
619 	for (i = 0; i < parts; i++) {
620 		/* partition starting lba */
621 		lbaint_t start = partitions[i].start;
622 		lbaint_t size = partitions[i].size;
623 
624 		if (start) {
625 			offset = start + size;
626 		} else {
627 			start = offset;
628 			offset += size;
629 		}
630 
631 		/*
632 		 * If our partition overlaps with either the GPT
633 		 * header, or the partition entry, reject it.
634 		 */
635 		if (((start < hdr_end && hdr_start < (start + size)) ||
636 		     (start < pte_end && pte_start < (start + size)))) {
637 			printf("Partition overlap\n");
638 			return -1;
639 		}
640 
641 		gpt_e[i].starting_lba = cpu_to_le64(start);
642 
643 		if (offset > (last_usable_lba + 1)) {
644 			printf("Partitions layout exceds disk size\n");
645 			return -1;
646 		}
647 		/* partition ending lba */
648 		if ((i == parts - 1) && (size == 0))
649 			/* extend the last partition to maximuim */
650 			gpt_e[i].ending_lba = gpt_h->last_usable_lba;
651 		else
652 			gpt_e[i].ending_lba = cpu_to_le64(offset - 1);
653 
654 #ifdef CONFIG_PARTITION_TYPE_GUID
655 		str_type_guid = partitions[i].type_guid;
656 		bin_type_guid = gpt_e[i].partition_type_guid.b;
657 		if (strlen(str_type_guid)) {
658 			if (uuid_str_to_bin(str_type_guid, bin_type_guid,
659 					    UUID_STR_FORMAT_GUID)) {
660 				printf("Partition no. %d: invalid type guid: %s\n",
661 				       i, str_type_guid);
662 				return -1;
663 			}
664 		} else {
665 			/* default partition type GUID */
666 			memcpy(bin_type_guid,
667 			       &PARTITION_BASIC_DATA_GUID, 16);
668 		}
669 #else
670 		/* partition type GUID */
671 		memcpy(gpt_e[i].partition_type_guid.b,
672 			&PARTITION_BASIC_DATA_GUID, 16);
673 #endif
674 
675 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
676 		str_uuid = partitions[i].uuid;
677 		bin_uuid = gpt_e[i].unique_partition_guid.b;
678 
679 		if (uuid_str_to_bin(str_uuid, bin_uuid, UUID_STR_FORMAT_GUID)) {
680 			printf("Partition no. %d: invalid guid: %s\n",
681 				i, str_uuid);
682 			return -1;
683 		}
684 #endif
685 
686 		/* partition attributes */
687 		memset(&gpt_e[i].attributes, 0,
688 		       sizeof(gpt_entry_attributes));
689 
690 		if (partitions[i].bootable)
691 			gpt_e[i].attributes.fields.legacy_bios_bootable = 1;
692 
693 		/* partition name */
694 		efiname_len = sizeof(gpt_e[i].partition_name)
695 			/ sizeof(efi_char16_t);
696 		dosname_len = sizeof(partitions[i].name);
697 
698 		memset(gpt_e[i].partition_name, 0,
699 		       sizeof(gpt_e[i].partition_name));
700 
701 		for (k = 0; k < min(dosname_len, efiname_len); k++)
702 			gpt_e[i].partition_name[k] =
703 				(efi_char16_t)(partitions[i].name[k]);
704 
705 		debug("%s: name: %s offset[%d]: 0x" LBAF
706 		      " size[%d]: 0x" LBAF "\n",
707 		      __func__, partitions[i].name, i,
708 		      offset, i, size);
709 	}
710 
711 	return 0;
712 }
713 
714 static uint32_t partition_entries_offset(struct blk_desc *dev_desc)
715 {
716 	uint32_t offset_blks = 2;
717 	uint32_t __maybe_unused offset_bytes;
718 	int __maybe_unused config_offset;
719 
720 #if defined(CONFIG_EFI_PARTITION_ENTRIES_OFF)
721 	/*
722 	 * Some architectures require their SPL loader at a fixed
723 	 * address within the first 16KB of the disk.  To avoid an
724 	 * overlap with the partition entries of the EFI partition
725 	 * table, the first safe offset (in bytes, from the start of
726 	 * the disk) for the entries can be set in
727 	 * CONFIG_EFI_PARTITION_ENTRIES_OFF.
728 	 */
729 	offset_bytes =
730 		PAD_TO_BLOCKSIZE(CONFIG_EFI_PARTITION_ENTRIES_OFF, dev_desc);
731 	offset_blks = offset_bytes / dev_desc->blksz;
732 #endif
733 
734 #if defined(CONFIG_OF_CONTROL)
735 	/*
736 	 * Allow the offset of the first partition entires (in bytes
737 	 * from the start of the device) to be specified as a property
738 	 * of the device tree '/config' node.
739 	 */
740 	config_offset = fdtdec_get_config_int(gd->fdt_blob,
741 					      "u-boot,efi-partition-entries-offset",
742 					      -EINVAL);
743 	if (config_offset != -EINVAL) {
744 		offset_bytes = PAD_TO_BLOCKSIZE(config_offset, dev_desc);
745 		offset_blks = offset_bytes / dev_desc->blksz;
746 	}
747 #endif
748 
749 	debug("efi: partition entries offset (in blocks): %d\n", offset_blks);
750 
751 	/*
752 	 * The earliest LBA this can be at is LBA#2 (i.e. right behind
753 	 * the (protective) MBR and the GPT header.
754 	 */
755 	if (offset_blks < 2)
756 		offset_blks = 2;
757 
758 	return offset_blks;
759 }
760 
761 int gpt_fill_header(struct blk_desc *dev_desc, gpt_header *gpt_h,
762 		char *str_guid, int parts_count)
763 {
764 	gpt_h->signature = cpu_to_le64(GPT_HEADER_SIGNATURE);
765 	gpt_h->revision = cpu_to_le32(GPT_HEADER_REVISION_V1);
766 	gpt_h->header_size = cpu_to_le32(sizeof(gpt_header));
767 	gpt_h->my_lba = cpu_to_le64(1);
768 	gpt_h->alternate_lba = cpu_to_le64(dev_desc->lba - 1);
769 	gpt_h->last_usable_lba = cpu_to_le64(dev_desc->lba - 34);
770 	gpt_h->partition_entry_lba =
771 		cpu_to_le64(partition_entries_offset(dev_desc));
772 	gpt_h->first_usable_lba =
773 		cpu_to_le64(le64_to_cpu(gpt_h->partition_entry_lba) + 32);
774 	gpt_h->num_partition_entries = cpu_to_le32(GPT_ENTRY_NUMBERS);
775 	gpt_h->sizeof_partition_entry = cpu_to_le32(sizeof(gpt_entry));
776 	gpt_h->header_crc32 = 0;
777 	gpt_h->partition_entry_array_crc32 = 0;
778 
779 	if (uuid_str_to_bin(str_guid, gpt_h->disk_guid.b, UUID_STR_FORMAT_GUID))
780 		return -1;
781 
782 	return 0;
783 }
784 
785 int gpt_restore(struct blk_desc *dev_desc, char *str_disk_guid,
786 		disk_partition_t *partitions, int parts_count)
787 {
788 	gpt_header *gpt_h;
789 	gpt_entry *gpt_e;
790 	int ret, size;
791 
792 	size = PAD_TO_BLOCKSIZE(sizeof(gpt_header), dev_desc);
793 	gpt_h = malloc_cache_aligned(size);
794 	if (gpt_h == NULL) {
795 		printf("%s: calloc failed!\n", __func__);
796 		return -1;
797 	}
798 	memset(gpt_h, 0, size);
799 
800 	size = PAD_TO_BLOCKSIZE(GPT_ENTRY_NUMBERS * sizeof(gpt_entry),
801 				dev_desc);
802 	gpt_e = malloc_cache_aligned(size);
803 	if (gpt_e == NULL) {
804 		printf("%s: calloc failed!\n", __func__);
805 		free(gpt_h);
806 		return -1;
807 	}
808 	memset(gpt_e, 0, size);
809 
810 	/* Generate Primary GPT header (LBA1) */
811 	ret = gpt_fill_header(dev_desc, gpt_h, str_disk_guid, parts_count);
812 	if (ret)
813 		goto err;
814 
815 	/* Generate partition entries */
816 	ret = gpt_fill_pte(dev_desc, gpt_h, gpt_e, partitions, parts_count);
817 	if (ret)
818 		goto err;
819 
820 	/* Write GPT partition table */
821 	ret = write_gpt_table(dev_desc, gpt_h, gpt_e);
822 
823 err:
824 	free(gpt_e);
825 	free(gpt_h);
826 	return ret;
827 }
828 
829 static void gpt_convert_efi_name_to_char(char *s, efi_char16_t *es, int n)
830 {
831 	char *ess = (char *)es;
832 	int i, j;
833 
834 	memset(s, '\0', n);
835 
836 	for (i = 0, j = 0; j < n; i += 2, j++) {
837 		s[j] = ess[i];
838 		if (!ess[i])
839 			return;
840 	}
841 }
842 
843 int gpt_verify_headers(struct blk_desc *dev_desc, gpt_header *gpt_head,
844 		       gpt_entry **gpt_pte)
845 {
846 	/*
847 	 * This function validates AND
848 	 * fills in the GPT header and PTE
849 	 */
850 	if (is_gpt_valid(dev_desc,
851 			 GPT_PRIMARY_PARTITION_TABLE_LBA,
852 			 gpt_head, gpt_pte) != 1) {
853 		printf("%s: *** ERROR: Invalid GPT ***\n",
854 		       __func__);
855 		return -1;
856 	}
857 	if (is_gpt_valid(dev_desc, (dev_desc->lba - 1),
858 			 gpt_head, gpt_pte) != 1) {
859 		printf("%s: *** ERROR: Invalid Backup GPT ***\n",
860 		       __func__);
861 		return -1;
862 	}
863 
864 	return 0;
865 }
866 
867 int gpt_verify_partitions(struct blk_desc *dev_desc,
868 			  disk_partition_t *partitions, int parts,
869 			  gpt_header *gpt_head, gpt_entry **gpt_pte)
870 {
871 	char efi_str[PARTNAME_SZ + 1];
872 	u64 gpt_part_size;
873 	gpt_entry *gpt_e;
874 	int ret, i;
875 
876 	ret = gpt_verify_headers(dev_desc, gpt_head, gpt_pte);
877 	if (ret)
878 		return ret;
879 
880 	gpt_e = *gpt_pte;
881 
882 	for (i = 0; i < parts; i++) {
883 		if (i == gpt_head->num_partition_entries) {
884 			pr_err("More partitions than allowed!\n");
885 			return -1;
886 		}
887 
888 		/* Check if GPT and ENV partition names match */
889 		gpt_convert_efi_name_to_char(efi_str, gpt_e[i].partition_name,
890 					     PARTNAME_SZ + 1);
891 
892 		debug("%s: part: %2d name - GPT: %16s, ENV: %16s ",
893 		      __func__, i, efi_str, partitions[i].name);
894 
895 		if (strncmp(efi_str, (char *)partitions[i].name,
896 			    sizeof(partitions->name))) {
897 			pr_err("Partition name: %s does not match %s!\n",
898 			      efi_str, (char *)partitions[i].name);
899 			return -1;
900 		}
901 
902 		/* Check if GPT and ENV sizes match */
903 		gpt_part_size = le64_to_cpu(gpt_e[i].ending_lba) -
904 			le64_to_cpu(gpt_e[i].starting_lba) + 1;
905 		debug("size(LBA) - GPT: %8llu, ENV: %8llu ",
906 		      (unsigned long long)gpt_part_size,
907 		      (unsigned long long)partitions[i].size);
908 
909 		if (le64_to_cpu(gpt_part_size) != partitions[i].size) {
910 			/* We do not check the extend partition size */
911 			if ((i == parts - 1) && (partitions[i].size == 0))
912 				continue;
913 
914 			pr_err("Partition %s size: %llu does not match %llu!\n",
915 			      efi_str, (unsigned long long)gpt_part_size,
916 			      (unsigned long long)partitions[i].size);
917 			return -1;
918 		}
919 
920 		/*
921 		 * Start address is optional - check only if provided
922 		 * in '$partition' variable
923 		 */
924 		if (!partitions[i].start) {
925 			debug("\n");
926 			continue;
927 		}
928 
929 		/* Check if GPT and ENV start LBAs match */
930 		debug("start LBA - GPT: %8llu, ENV: %8llu\n",
931 		      le64_to_cpu(gpt_e[i].starting_lba),
932 		      (unsigned long long)partitions[i].start);
933 
934 		if (le64_to_cpu(gpt_e[i].starting_lba) != partitions[i].start) {
935 			pr_err("Partition %s start: %llu does not match %llu!\n",
936 			      efi_str, le64_to_cpu(gpt_e[i].starting_lba),
937 			      (unsigned long long)partitions[i].start);
938 			return -1;
939 		}
940 	}
941 
942 	return 0;
943 }
944 
945 int is_valid_gpt_buf(struct blk_desc *dev_desc, void *buf)
946 {
947 	gpt_header *gpt_h;
948 	gpt_entry *gpt_e;
949 
950 	/* determine start of GPT Header in the buffer */
951 	gpt_h = buf + (GPT_PRIMARY_PARTITION_TABLE_LBA *
952 		       dev_desc->blksz);
953 
954 	if ((le64_to_cpu(gpt_h->alternate_lba) + 1)
955 			!= cpu_to_le64(dev_desc->lba)) {
956 		printf("%s: failed checking '%s'\n", __func__,
957 		       "invalid GPT Disk Size");
958 		return -1;
959 	}
960 
961 	if (validate_gpt_header(gpt_h, GPT_PRIMARY_PARTITION_TABLE_LBA,
962 				dev_desc->lba))
963 		return -1;
964 
965 	/* determine start of GPT Entries in the buffer */
966 	gpt_e = buf + (le64_to_cpu(gpt_h->partition_entry_lba) *
967 		       dev_desc->blksz);
968 	if (validate_gpt_entries(gpt_h, gpt_e))
969 		return -1;
970 
971 	return 0;
972 }
973 
974 int write_mbr_and_gpt_partitions(struct blk_desc *dev_desc, void *buf)
975 {
976 	gpt_header *gpt_h;
977 	gpt_entry *gpt_e;
978 	int gpt_e_blk_cnt;
979 	lbaint_t lba;
980 	int cnt;
981 
982 	if (is_valid_gpt_buf(dev_desc, buf))
983 		return -1;
984 
985 	/* determine start of GPT Header in the buffer */
986 	gpt_h = buf + (GPT_PRIMARY_PARTITION_TABLE_LBA *
987 		       dev_desc->blksz);
988 
989 	/* determine start of GPT Entries in the buffer */
990 	gpt_e = buf + (le64_to_cpu(gpt_h->partition_entry_lba) *
991 		       dev_desc->blksz);
992 	gpt_e_blk_cnt = BLOCK_CNT((le32_to_cpu(gpt_h->num_partition_entries) *
993 				   le32_to_cpu(gpt_h->sizeof_partition_entry)),
994 				  dev_desc);
995 
996 	/* write MBR */
997 	lba = 0;	/* MBR is always at 0 */
998 	cnt = 1;	/* MBR (1 block) */
999 	if (blk_dwrite(dev_desc, lba, cnt, buf) != cnt) {
1000 		printf("%s: failed writing '%s' (%d blks at 0x" LBAF ")\n",
1001 		       __func__, "MBR", cnt, lba);
1002 		return 1;
1003 	}
1004 
1005 	/* write Primary GPT */
1006 	lba = GPT_PRIMARY_PARTITION_TABLE_LBA;
1007 	cnt = 1;	/* GPT Header (1 block) */
1008 	if (blk_dwrite(dev_desc, lba, cnt, gpt_h) != cnt) {
1009 		printf("%s: failed writing '%s' (%d blks at 0x" LBAF ")\n",
1010 		       __func__, "Primary GPT Header", cnt, lba);
1011 		return 1;
1012 	}
1013 
1014 	lba = le64_to_cpu(gpt_h->partition_entry_lba);
1015 	cnt = gpt_e_blk_cnt;
1016 	if (blk_dwrite(dev_desc, lba, cnt, gpt_e) != cnt) {
1017 		printf("%s: failed writing '%s' (%d blks at 0x" LBAF ")\n",
1018 		       __func__, "Primary GPT Entries", cnt, lba);
1019 		return 1;
1020 	}
1021 
1022 	prepare_backup_gpt_header(gpt_h);
1023 
1024 	/* write Backup GPT */
1025 	lba = le64_to_cpu(gpt_h->partition_entry_lba);
1026 	cnt = gpt_e_blk_cnt;
1027 	if (blk_dwrite(dev_desc, lba, cnt, gpt_e) != cnt) {
1028 		printf("%s: failed writing '%s' (%d blks at 0x" LBAF ")\n",
1029 		       __func__, "Backup GPT Entries", cnt, lba);
1030 		return 1;
1031 	}
1032 
1033 	lba = le64_to_cpu(gpt_h->my_lba);
1034 	cnt = 1;	/* GPT Header (1 block) */
1035 	if (blk_dwrite(dev_desc, lba, cnt, gpt_h) != cnt) {
1036 		printf("%s: failed writing '%s' (%d blks at 0x" LBAF ")\n",
1037 		       __func__, "Backup GPT Header", cnt, lba);
1038 		return 1;
1039 	}
1040 
1041 	return 0;
1042 }
1043 #endif
1044 
1045 /*
1046  * Private functions
1047  */
1048 /*
1049  * pmbr_part_valid(): Check for EFI partition signature
1050  *
1051  * Returns: 1 if EFI GPT partition type is found.
1052  */
1053 static int pmbr_part_valid(struct partition *part)
1054 {
1055 	if (part->sys_ind == EFI_PMBR_OSTYPE_EFI_GPT &&
1056 		get_unaligned_le32(&part->start_sect) == 1UL) {
1057 		return 1;
1058 	}
1059 
1060 	return 0;
1061 }
1062 
1063 /*
1064  * is_pmbr_valid(): test Protective MBR for validity
1065  *
1066  * Returns: 1 if PMBR is valid, 0 otherwise.
1067  * Validity depends on two things:
1068  *  1) MSDOS signature is in the last two bytes of the MBR
1069  *  2) One partition of type 0xEE is found, checked by pmbr_part_valid()
1070  */
1071 static int is_pmbr_valid(legacy_mbr * mbr)
1072 {
1073 	int i = 0;
1074 
1075 	if (!mbr || le16_to_cpu(mbr->signature) != MSDOS_MBR_SIGNATURE)
1076 		return 0;
1077 
1078 #ifdef CONFIG_ARCH_ROCKCHIP
1079 	/*
1080 	 * In sd-update card, we use RKPARM partition in bootloader to load
1081 	 * firmware, and use MS-DOS partition in recovery to update system.
1082 	 * Now, we want to use gpt in bootloader and abandon the RKPARM
1083 	 * partition. So in new sd-update card, we write the MS-DOS partition
1084 	 * table and gpt to sd card. Then we must return 1 directly when test
1085 	 * the mbr sector otherwise the gpt is unavailable.
1086 	 */
1087 	return 1;
1088 #endif
1089 	for (i = 0; i < 4; i++) {
1090 		if (pmbr_part_valid(&mbr->partition_record[i])) {
1091 			return 1;
1092 		}
1093 	}
1094 	return 0;
1095 }
1096 
1097 /**
1098  * is_gpt_valid() - tests one GPT header and PTEs for validity
1099  *
1100  * lba is the logical block address of the GPT header to test
1101  * gpt is a GPT header ptr, filled on return.
1102  * ptes is a PTEs ptr, filled on return.
1103  *
1104  * Description: returns 1 if valid,  0 on error.
1105  * If valid, returns pointers to PTEs.
1106  */
1107 static int is_gpt_valid(struct blk_desc *dev_desc, u64 lba,
1108 			gpt_header *pgpt_head, gpt_entry **pgpt_pte)
1109 {
1110 	/* Confirm valid arguments prior to allocation. */
1111 	if (!dev_desc || !pgpt_head) {
1112 		printf("%s: Invalid Argument(s)\n", __func__);
1113 		return 0;
1114 	}
1115 
1116 	/* Re-use pte if it's not NULL */
1117 	if (*pgpt_pte)
1118 		return 1;
1119 
1120 	ALLOC_CACHE_ALIGN_BUFFER(legacy_mbr, mbr, dev_desc->blksz);
1121 
1122 	/* Read MBR Header from device */
1123 	if (blk_dread(dev_desc, 0, 1, (ulong *)mbr) != 1) {
1124 		printf("*** ERROR: Can't read MBR header ***\n");
1125 		return 0;
1126 	}
1127 
1128 	/* Read GPT Header from device */
1129 	if (blk_dread(dev_desc, (lbaint_t)lba, 1, pgpt_head) != 1) {
1130 		printf("*** ERROR: Can't read GPT header ***\n");
1131 		return 0;
1132 	}
1133 
1134 	if (validate_gpt_header(pgpt_head, (lbaint_t)lba, dev_desc->lba))
1135 		return 0;
1136 
1137 	if (dev_desc->sig_type == SIG_TYPE_NONE) {
1138 		efi_guid_t empty = {};
1139 		if (memcmp(&pgpt_head->disk_guid, &empty, sizeof(empty))) {
1140 			dev_desc->sig_type = SIG_TYPE_GUID;
1141 			memcpy(&dev_desc->guid_sig, &pgpt_head->disk_guid,
1142 			      sizeof(empty));
1143 		} else if (mbr->unique_mbr_signature != 0) {
1144 			dev_desc->sig_type = SIG_TYPE_MBR;
1145 			dev_desc->mbr_sig = mbr->unique_mbr_signature;
1146 		}
1147 	}
1148 
1149 	/* Read and allocate Partition Table Entries */
1150 	*pgpt_pte = alloc_read_gpt_entries(dev_desc, pgpt_head);
1151 	if (*pgpt_pte == NULL) {
1152 		printf("GPT: Failed to allocate memory for PTE\n");
1153 		return 0;
1154 	}
1155 
1156 	if (validate_gpt_entries(pgpt_head, *pgpt_pte)) {
1157 		free(*pgpt_pte);
1158 		*pgpt_pte = NULL;
1159 		return 0;
1160 	}
1161 
1162 	/* We're done, all's well */
1163 	return 1;
1164 }
1165 
1166 /**
1167  * alloc_read_gpt_entries(): reads partition entries from disk
1168  * @dev_desc
1169  * @gpt - GPT header
1170  *
1171  * Description: Returns ptes on success,  NULL on error.
1172  * Allocates space for PTEs based on information found in @gpt.
1173  * Notes: remember to free pte when you're done!
1174  */
1175 static gpt_entry *alloc_read_gpt_entries(struct blk_desc *dev_desc,
1176 					 gpt_header *pgpt_head)
1177 {
1178 	size_t count = 0, blk_cnt;
1179 	lbaint_t blk;
1180 	gpt_entry *pte = NULL;
1181 
1182 	if (!dev_desc || !pgpt_head) {
1183 		printf("%s: Invalid Argument(s)\n", __func__);
1184 		return NULL;
1185 	}
1186 
1187 	count = le32_to_cpu(pgpt_head->num_partition_entries) *
1188 		le32_to_cpu(pgpt_head->sizeof_partition_entry);
1189 
1190 	debug("%s: count = %u * %u = %lu\n", __func__,
1191 	      (u32) le32_to_cpu(pgpt_head->num_partition_entries),
1192 	      (u32) le32_to_cpu(pgpt_head->sizeof_partition_entry),
1193 	      (ulong)count);
1194 
1195 	/* Allocate memory for PTE, remember to FREE */
1196 	if (count != 0) {
1197 		pte = memalign(ARCH_DMA_MINALIGN,
1198 			       PAD_TO_BLOCKSIZE(count, dev_desc));
1199 	}
1200 
1201 	if (count == 0 || pte == NULL) {
1202 		printf("%s: ERROR: Can't allocate %#lX bytes for GPT Entries\n",
1203 		       __func__, (ulong)count);
1204 		return NULL;
1205 	}
1206 
1207 	/* Read GPT Entries from device */
1208 	blk = le64_to_cpu(pgpt_head->partition_entry_lba);
1209 	blk_cnt = BLOCK_CNT(count, dev_desc);
1210 	if (blk_dread(dev_desc, blk, (lbaint_t)blk_cnt, pte) != blk_cnt) {
1211 		printf("*** ERROR: Can't read GPT Entries ***\n");
1212 		free(pte);
1213 		return NULL;
1214 	}
1215 	return pte;
1216 }
1217 
1218 /**
1219  * is_pte_valid(): validates a single Partition Table Entry
1220  * @gpt_entry - Pointer to a single Partition Table Entry
1221  *
1222  * Description: returns 1 if valid,  0 on error.
1223  */
1224 static int is_pte_valid(gpt_entry * pte)
1225 {
1226 	efi_guid_t unused_guid;
1227 
1228 	if (!pte) {
1229 		printf("%s: Invalid Argument(s)\n", __func__);
1230 		return 0;
1231 	}
1232 
1233 	/* Only one validation for now:
1234 	 * The GUID Partition Type != Unused Entry (ALL-ZERO)
1235 	 */
1236 	memset(unused_guid.b, 0, sizeof(unused_guid.b));
1237 
1238 	if (memcmp(pte->partition_type_guid.b, unused_guid.b,
1239 		sizeof(unused_guid.b)) == 0) {
1240 
1241 		debug("%s: Found an unused PTE GUID at 0x%08X\n", __func__,
1242 		      (unsigned int)(uintptr_t)pte);
1243 
1244 		return 0;
1245 	} else {
1246 		return 1;
1247 	}
1248 }
1249 
1250 /*
1251  * Add an 'a_' prefix so it comes before 'dos' in the linker list. We need to
1252  * check EFI first, since a DOS partition is often used as a 'protective MBR'
1253  * with EFI.
1254  */
1255 U_BOOT_PART_TYPE(a_efi) = {
1256 	.name		= "EFI",
1257 	.part_type	= PART_TYPE_EFI,
1258 	.max_entries	= GPT_ENTRY_NUMBERS,
1259 	.get_info	= part_get_info_ptr(part_get_info_efi),
1260 	.print		= part_print_ptr(part_print_efi),
1261 	.test		= part_test_efi,
1262 };
1263 #endif
1264