1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * (C) Copyright 2001
4 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
5 */
6
7 #include <common.h>
8 #include <command.h>
9 #include <errno.h>
10 #include <ide.h>
11 #include <malloc.h>
12 #include <part.h>
13 #include <ubifs_uboot.h>
14
15 #undef PART_DEBUG
16
17 #ifdef PART_DEBUG
18 #define PRINTF(fmt,args...) printf (fmt ,##args)
19 #else
20 #define PRINTF(fmt,args...)
21 #endif
22
23 /* Check all partition types */
24 #define PART_TYPE_ALL -1
25
part_driver_lookup_type(struct blk_desc * dev_desc)26 static struct part_driver *part_driver_lookup_type(struct blk_desc *dev_desc)
27 {
28 struct part_driver *drv =
29 ll_entry_start(struct part_driver, part_driver);
30 const int n_ents = ll_entry_count(struct part_driver, part_driver);
31 struct part_driver *entry;
32
33 if (dev_desc->part_type == PART_TYPE_UNKNOWN) {
34 for (entry = drv; entry != drv + n_ents; entry++) {
35 int ret;
36
37 ret = entry->test(dev_desc);
38 if (!ret) {
39 dev_desc->part_type = entry->part_type;
40 return entry;
41 }
42 }
43 } else {
44 for (entry = drv; entry != drv + n_ents; entry++) {
45 if (dev_desc->part_type == entry->part_type)
46 return entry;
47 }
48 }
49
50 /* Not found */
51 return NULL;
52 }
53
54 #ifdef CONFIG_HAVE_BLOCK_DEVICE
get_dev_hwpart(const char * ifname,int dev,int hwpart)55 static struct blk_desc *get_dev_hwpart(const char *ifname, int dev, int hwpart)
56 {
57 struct blk_desc *dev_desc;
58 int ret;
59
60 dev_desc = blk_get_devnum_by_typename(ifname, dev);
61 if (!dev_desc) {
62 debug("%s: No device for iface '%s', dev %d\n", __func__,
63 ifname, dev);
64 return NULL;
65 }
66 ret = blk_dselect_hwpart(dev_desc, hwpart);
67 if (ret) {
68 debug("%s: Failed to select h/w partition: err-%d\n", __func__,
69 ret);
70 return NULL;
71 }
72
73 return dev_desc;
74 }
75
blk_get_dev(const char * ifname,int dev)76 struct blk_desc *blk_get_dev(const char *ifname, int dev)
77 {
78 return get_dev_hwpart(ifname, dev, 0);
79 }
80 #else
get_dev_hwpart(const char * ifname,int dev,int hwpart)81 struct blk_desc *get_dev_hwpart(const char *ifname, int dev, int hwpart)
82 {
83 return NULL;
84 }
85
blk_get_dev(const char * ifname,int dev)86 struct blk_desc *blk_get_dev(const char *ifname, int dev)
87 {
88 return NULL;
89 }
90 #endif
91
92 #ifdef CONFIG_HAVE_BLOCK_DEVICE
93
94 /* ------------------------------------------------------------------------- */
95 /*
96 * reports device info to the user
97 */
98
99 #ifdef CONFIG_LBA48
100 typedef uint64_t lba512_t;
101 #else
102 typedef lbaint_t lba512_t;
103 #endif
104
105 /*
106 * Overflowless variant of (block_count * mul_by / div_by)
107 * when div_by > mul_by
108 */
lba512_muldiv(lba512_t block_count,lba512_t mul_by,lba512_t div_by)109 static lba512_t lba512_muldiv(lba512_t block_count, lba512_t mul_by, lba512_t div_by)
110 {
111 lba512_t bc_quot, bc_rem;
112
113 /* x * m / d == x / d * m + (x % d) * m / d */
114 bc_quot = block_count / div_by;
115 bc_rem = block_count - div_by * bc_quot;
116 return bc_quot * mul_by + (bc_rem * mul_by) / div_by;
117 }
118
dev_print(struct blk_desc * dev_desc)119 void dev_print (struct blk_desc *dev_desc)
120 {
121 lba512_t lba512; /* number of blocks if 512bytes block size */
122
123 if (dev_desc->type == DEV_TYPE_UNKNOWN) {
124 puts ("not available\n");
125 return;
126 }
127
128 switch (dev_desc->if_type) {
129 case IF_TYPE_SCSI:
130 printf ("(%d:%d) Vendor: %s Prod.: %s Rev: %s\n",
131 dev_desc->target,dev_desc->lun,
132 dev_desc->vendor,
133 dev_desc->product,
134 dev_desc->revision);
135 break;
136 case IF_TYPE_ATAPI:
137 case IF_TYPE_IDE:
138 case IF_TYPE_SATA:
139 printf ("Model: %s Firm: %s Ser#: %s\n",
140 dev_desc->vendor,
141 dev_desc->revision,
142 dev_desc->product);
143 break;
144 case IF_TYPE_SD:
145 case IF_TYPE_MMC:
146 case IF_TYPE_USB:
147 case IF_TYPE_NVME:
148 printf ("Vendor: %s Rev: %s Prod: %s\n",
149 dev_desc->vendor,
150 dev_desc->revision,
151 dev_desc->product);
152 break;
153 case IF_TYPE_VIRTIO:
154 printf("%s VirtIO Block Device\n", dev_desc->vendor);
155 break;
156 case IF_TYPE_DOC:
157 puts("device type DOC\n");
158 return;
159 case IF_TYPE_UNKNOWN:
160 puts("device type unknown\n");
161 return;
162 default:
163 printf("Unhandled device type: %i\n", dev_desc->if_type);
164 return;
165 }
166 puts (" Type: ");
167 if (dev_desc->removable)
168 puts ("Removable ");
169 switch (dev_desc->type & 0x1F) {
170 case DEV_TYPE_HARDDISK:
171 puts ("Hard Disk");
172 break;
173 case DEV_TYPE_CDROM:
174 puts ("CD ROM");
175 break;
176 case DEV_TYPE_OPDISK:
177 puts ("Optical Device");
178 break;
179 case DEV_TYPE_TAPE:
180 puts ("Tape");
181 break;
182 default:
183 printf ("# %02X #", dev_desc->type & 0x1F);
184 break;
185 }
186 puts ("\n");
187 if (dev_desc->lba > 0L && dev_desc->blksz > 0L) {
188 ulong mb, mb_quot, mb_rem, gb, gb_quot, gb_rem;
189 lbaint_t lba;
190
191 lba = dev_desc->lba;
192
193 lba512 = (lba * (dev_desc->blksz/512));
194 /* round to 1 digit */
195 /* 2048 = (1024 * 1024) / 512 MB */
196 mb = lba512_muldiv(lba512, 10, 2048);
197
198 mb_quot = mb / 10;
199 mb_rem = mb - (10 * mb_quot);
200
201 gb = mb / 1024;
202 gb_quot = gb / 10;
203 gb_rem = gb - (10 * gb_quot);
204 #ifdef CONFIG_LBA48
205 if (dev_desc->lba48)
206 printf (" Supports 48-bit addressing\n");
207 #endif
208 #if defined(CONFIG_SYS_64BIT_LBA)
209 printf (" Capacity: %lu.%lu MB = %lu.%lu GB (%llu x %lu)\n",
210 mb_quot, mb_rem,
211 gb_quot, gb_rem,
212 lba,
213 dev_desc->blksz);
214 #else
215 printf (" Capacity: %lu.%lu MB = %lu.%lu GB (%lu x %lu)\n",
216 mb_quot, mb_rem,
217 gb_quot, gb_rem,
218 (ulong)lba,
219 dev_desc->blksz);
220 #endif
221 } else {
222 puts (" Capacity: not available\n");
223 }
224 }
225 #endif
226
227 #ifdef CONFIG_HAVE_BLOCK_DEVICE
228
part_init(struct blk_desc * dev_desc)229 void part_init(struct blk_desc *dev_desc)
230 {
231 struct part_driver *drv =
232 ll_entry_start(struct part_driver, part_driver);
233 const int n_ents = ll_entry_count(struct part_driver, part_driver);
234 struct part_driver *entry;
235
236 blkcache_invalidate(dev_desc->if_type, dev_desc->devnum);
237
238 dev_desc->part_type = PART_TYPE_UNKNOWN;
239 for (entry = drv; entry != drv + n_ents; entry++) {
240 int ret;
241
242 ret = entry->test(dev_desc);
243 debug("%s: try '%s': ret=%d\n", __func__, entry->name, ret);
244 if (!ret) {
245 dev_desc->part_type = entry->part_type;
246 break;
247 }
248 }
249 }
250
print_part_header(const char * type,struct blk_desc * dev_desc)251 static void print_part_header(const char *type, struct blk_desc *dev_desc)
252 {
253 #if CONFIG_IS_ENABLED(MAC_PARTITION) || \
254 CONFIG_IS_ENABLED(DOS_PARTITION) || \
255 CONFIG_IS_ENABLED(ISO_PARTITION) || \
256 CONFIG_IS_ENABLED(AMIGA_PARTITION) || \
257 CONFIG_IS_ENABLED(EFI_PARTITION)
258 puts ("\nPartition Map for ");
259 switch (dev_desc->if_type) {
260 case IF_TYPE_IDE:
261 puts ("IDE");
262 break;
263 case IF_TYPE_SATA:
264 puts ("SATA");
265 break;
266 case IF_TYPE_SCSI:
267 puts ("SCSI");
268 break;
269 case IF_TYPE_ATAPI:
270 puts ("ATAPI");
271 break;
272 case IF_TYPE_USB:
273 puts ("USB");
274 break;
275 case IF_TYPE_DOC:
276 puts ("DOC");
277 break;
278 case IF_TYPE_MMC:
279 puts ("MMC");
280 break;
281 case IF_TYPE_HOST:
282 puts ("HOST");
283 break;
284 case IF_TYPE_NVME:
285 puts ("NVMe");
286 break;
287 case IF_TYPE_VIRTIO:
288 puts("VirtIO");
289 break;
290 default:
291 puts ("UNKNOWN");
292 break;
293 }
294 printf (" device %d -- Partition Type: %s\n\n",
295 dev_desc->devnum, type);
296 #endif /* any CONFIG_..._PARTITION */
297 }
298
part_print(struct blk_desc * dev_desc)299 void part_print(struct blk_desc *dev_desc)
300 {
301 struct part_driver *drv;
302
303 drv = part_driver_lookup_type(dev_desc);
304 if (!drv) {
305 printf("## Unknown partition table type %x\n",
306 dev_desc->part_type);
307 return;
308 }
309
310 PRINTF("## Testing for valid %s partition ##\n", drv->name);
311 print_part_header(drv->name, dev_desc);
312 if (drv->print)
313 drv->print(dev_desc);
314 }
315
316 #endif /* CONFIG_HAVE_BLOCK_DEVICE */
317
part_get_info(struct blk_desc * dev_desc,int part,disk_partition_t * info)318 int part_get_info(struct blk_desc *dev_desc, int part,
319 disk_partition_t *info)
320 {
321 #ifdef CONFIG_HAVE_BLOCK_DEVICE
322 struct part_driver *drv;
323
324 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
325 /* The common case is no UUID support */
326 info->uuid[0] = 0;
327 #endif
328 #ifdef CONFIG_PARTITION_TYPE_GUID
329 info->type_guid[0] = 0;
330 #endif
331
332 drv = part_driver_lookup_type(dev_desc);
333 if (!drv) {
334 debug("## Unknown partition table type %x\n",
335 dev_desc->part_type);
336 return -EPROTONOSUPPORT;
337 }
338 if (!drv->get_info) {
339 PRINTF("## Driver %s does not have the get_info() method\n",
340 drv->name);
341 return -ENOSYS;
342 }
343 if (drv->get_info(dev_desc, part, info) == 0) {
344 PRINTF("## Valid %s partition found ##\n", drv->name);
345 return 0;
346 }
347 #endif /* CONFIG_HAVE_BLOCK_DEVICE */
348
349 return -1;
350 }
351
part_get_info_whole_disk(struct blk_desc * dev_desc,disk_partition_t * info)352 int part_get_info_whole_disk(struct blk_desc *dev_desc, disk_partition_t *info)
353 {
354 info->start = 0;
355 info->size = dev_desc->lba;
356 info->blksz = dev_desc->blksz;
357 info->bootable = 0;
358 strcpy((char *)info->type, BOOT_PART_TYPE);
359 strcpy((char *)info->name, "Whole Disk");
360 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
361 info->uuid[0] = 0;
362 #endif
363 #ifdef CONFIG_PARTITION_TYPE_GUID
364 info->type_guid[0] = 0;
365 #endif
366
367 return 0;
368 }
369
blk_get_device_by_str(const char * ifname,const char * dev_hwpart_str,struct blk_desc ** dev_desc)370 int blk_get_device_by_str(const char *ifname, const char *dev_hwpart_str,
371 struct blk_desc **dev_desc)
372 {
373 char *ep;
374 char *dup_str = NULL;
375 const char *dev_str, *hwpart_str;
376 int dev, hwpart;
377
378 hwpart_str = strchr(dev_hwpart_str, '.');
379 if (hwpart_str) {
380 dup_str = strdup(dev_hwpart_str);
381 dup_str[hwpart_str - dev_hwpart_str] = 0;
382 dev_str = dup_str;
383 hwpart_str++;
384 } else {
385 dev_str = dev_hwpart_str;
386 hwpart = 0;
387 }
388
389 dev = simple_strtoul(dev_str, &ep, 16);
390 if (*ep) {
391 printf("** Bad device specification %s %s **\n",
392 ifname, dev_str);
393 dev = -EINVAL;
394 goto cleanup;
395 }
396
397 if (hwpart_str) {
398 hwpart = simple_strtoul(hwpart_str, &ep, 16);
399 if (*ep) {
400 printf("** Bad HW partition specification %s %s **\n",
401 ifname, hwpart_str);
402 dev = -EINVAL;
403 goto cleanup;
404 }
405 }
406
407 *dev_desc = get_dev_hwpart(ifname, dev, hwpart);
408 if (!(*dev_desc) || ((*dev_desc)->type == DEV_TYPE_UNKNOWN)) {
409 debug("** Bad device %s %s **\n", ifname, dev_hwpart_str);
410 dev = -ENOENT;
411 goto cleanup;
412 }
413
414 #ifdef CONFIG_HAVE_BLOCK_DEVICE
415 /*
416 * Updates the partition table for the specified hw partition.
417 * Does not need to be done for hwpart 0 since it is default and
418 * already loaded.
419 */
420 if(hwpart != 0)
421 part_init(*dev_desc);
422 #endif
423
424 cleanup:
425 free(dup_str);
426 return dev;
427 }
428
429 #define PART_UNSPECIFIED -2
430 #define PART_AUTO -1
blk_get_device_part_str(const char * ifname,const char * dev_part_str,struct blk_desc ** dev_desc,disk_partition_t * info,int allow_whole_dev)431 int blk_get_device_part_str(const char *ifname, const char *dev_part_str,
432 struct blk_desc **dev_desc,
433 disk_partition_t *info, int allow_whole_dev)
434 {
435 int ret = -1;
436 const char *part_str;
437 char *dup_str = NULL;
438 const char *dev_str;
439 int dev;
440 char *ep;
441 int p;
442 int part;
443 disk_partition_t tmpinfo;
444
445 #ifdef CONFIG_SANDBOX
446 /*
447 * Special-case a pseudo block device "hostfs", to allow access to the
448 * host's own filesystem.
449 */
450 if (0 == strcmp(ifname, "hostfs")) {
451 *dev_desc = NULL;
452 info->start = 0;
453 info->size = 0;
454 info->blksz = 0;
455 info->bootable = 0;
456 strcpy((char *)info->type, BOOT_PART_TYPE);
457 strcpy((char *)info->name, "Sandbox host");
458 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
459 info->uuid[0] = 0;
460 #endif
461 #ifdef CONFIG_PARTITION_TYPE_GUID
462 info->type_guid[0] = 0;
463 #endif
464
465 return 0;
466 }
467 #endif
468
469 #ifdef CONFIG_CMD_UBIFS
470 /*
471 * Special-case ubi, ubi goes through a mtd, rathen then through
472 * a regular block device.
473 */
474 if (0 == strcmp(ifname, "ubi")) {
475 if (!ubifs_is_mounted()) {
476 printf("UBIFS not mounted, use ubifsmount to mount volume first!\n");
477 return -1;
478 }
479
480 *dev_desc = NULL;
481 memset(info, 0, sizeof(*info));
482 strcpy((char *)info->type, BOOT_PART_TYPE);
483 strcpy((char *)info->name, "UBI");
484 #if CONFIG_IS_ENABLED(PARTITION_UUIDS)
485 info->uuid[0] = 0;
486 #endif
487 return 0;
488 }
489 #endif
490
491 /* If no dev_part_str, use bootdevice environment variable */
492 if (!dev_part_str || !strlen(dev_part_str) ||
493 !strcmp(dev_part_str, "-"))
494 dev_part_str = env_get("bootdevice");
495
496 /* If still no dev_part_str, it's an error */
497 if (!dev_part_str) {
498 printf("** No device specified **\n");
499 goto cleanup;
500 }
501
502 /* Separate device and partition ID specification */
503 part_str = strchr(dev_part_str, ':');
504 if (part_str) {
505 dup_str = strdup(dev_part_str);
506 dup_str[part_str - dev_part_str] = 0;
507 dev_str = dup_str;
508 part_str++;
509 } else {
510 dev_str = dev_part_str;
511 }
512
513 /* Look up the device */
514 dev = blk_get_device_by_str(ifname, dev_str, dev_desc);
515 if (dev < 0)
516 goto cleanup;
517
518 /* Convert partition ID string to number */
519 if (!part_str || !*part_str) {
520 part = PART_UNSPECIFIED;
521 } else if (!strcmp(part_str, "auto")) {
522 part = PART_AUTO;
523 } else {
524 /* Something specified -> use exactly that */
525 part = (int)simple_strtoul(part_str, &ep, 16);
526 /*
527 * Less than whole string converted,
528 * or request for whole device, but caller requires partition.
529 */
530 if (*ep || (part == 0 && !allow_whole_dev)) {
531 printf("** Bad partition specification %s %s **\n",
532 ifname, dev_part_str);
533 goto cleanup;
534 }
535 }
536
537 /*
538 * No partition table on device,
539 * or user requested partition 0 (entire device).
540 */
541 if (((*dev_desc)->part_type == PART_TYPE_UNKNOWN) ||
542 (part == 0)) {
543 if (!(*dev_desc)->lba) {
544 printf("** Bad device size - %s %s **\n", ifname,
545 dev_str);
546 goto cleanup;
547 }
548
549 /*
550 * If user specified a partition ID other than 0,
551 * or the calling command only accepts partitions,
552 * it's an error.
553 */
554 if ((part > 0) || (!allow_whole_dev)) {
555 printf("** No partition table - %s %s **\n", ifname,
556 dev_str);
557 goto cleanup;
558 }
559
560 (*dev_desc)->log2blksz = LOG2((*dev_desc)->blksz);
561
562 part_get_info_whole_disk(*dev_desc, info);
563
564 ret = 0;
565 goto cleanup;
566 }
567
568 /*
569 * Now there's known to be a partition table,
570 * not specifying a partition means to pick partition 1.
571 */
572 if (part == PART_UNSPECIFIED)
573 part = 1;
574
575 /*
576 * If user didn't specify a partition number, or did specify something
577 * other than "auto", use that partition number directly.
578 */
579 if (part != PART_AUTO) {
580 ret = part_get_info(*dev_desc, part, info);
581 if (ret) {
582 printf("** Invalid partition %d **\n", part);
583 goto cleanup;
584 }
585 } else {
586 /*
587 * Find the first bootable partition.
588 * If none are bootable, fall back to the first valid partition.
589 */
590 part = 0;
591 for (p = 1; p <= MAX_SEARCH_PARTITIONS; p++) {
592 ret = part_get_info(*dev_desc, p, info);
593 if (ret)
594 continue;
595
596 /*
597 * First valid partition, or new better partition?
598 * If so, save partition ID.
599 */
600 if (!part || info->bootable)
601 part = p;
602
603 /* Best possible partition? Stop searching. */
604 if (info->bootable)
605 break;
606
607 /*
608 * We now need to search further for best possible.
609 * If we what we just queried was the best so far,
610 * save the info since we over-write it next loop.
611 */
612 if (part == p)
613 tmpinfo = *info;
614 }
615 /* If we found any acceptable partition */
616 if (part) {
617 /*
618 * If we searched all possible partition IDs,
619 * return the first valid partition we found.
620 */
621 if (p == MAX_SEARCH_PARTITIONS + 1)
622 *info = tmpinfo;
623 } else {
624 printf("** No valid partitions found **\n");
625 ret = -1;
626 goto cleanup;
627 }
628 }
629 if (strncmp((char *)info->type, BOOT_PART_TYPE, sizeof(info->type)) != 0) {
630 printf("** Invalid partition type \"%.32s\""
631 " (expect \"" BOOT_PART_TYPE "\")\n",
632 info->type);
633 ret = -1;
634 goto cleanup;
635 }
636
637 (*dev_desc)->log2blksz = LOG2((*dev_desc)->blksz);
638
639 ret = part;
640 goto cleanup;
641
642 cleanup:
643 free(dup_str);
644 return ret;
645 }
646
part_get_info_by_name_type(struct blk_desc * dev_desc,const char * name,disk_partition_t * info,int part_type)647 int part_get_info_by_name_type(struct blk_desc *dev_desc, const char *name,
648 disk_partition_t *info, int part_type)
649 {
650 struct part_driver *part_drv;
651 int ret;
652 int i;
653
654 part_drv = part_driver_lookup_type(dev_desc);
655 if (!part_drv)
656 return -1;
657 for (i = 1; i < part_drv->max_entries; i++) {
658 ret = part_drv->get_info(dev_desc, i, info);
659 if (ret != 0) {
660 /* no more entries in table */
661 break;
662 }
663 if (strcmp(name, (const char *)info->name) == 0) {
664 /* matched */
665 return i;
666 }
667 }
668
669 return -1;
670 }
671
part_get_info_by_name(struct blk_desc * dev_desc,const char * name,disk_partition_t * info)672 int part_get_info_by_name(struct blk_desc *dev_desc, const char *name,
673 disk_partition_t *info)
674 {
675 return part_get_info_by_name_type(dev_desc, name, info, PART_TYPE_ALL);
676 }
677
part_set_generic_name(const struct blk_desc * dev_desc,int part_num,char * name)678 void part_set_generic_name(const struct blk_desc *dev_desc,
679 int part_num, char *name)
680 {
681 char *devtype;
682
683 switch (dev_desc->if_type) {
684 case IF_TYPE_IDE:
685 case IF_TYPE_SATA:
686 case IF_TYPE_ATAPI:
687 devtype = "hd";
688 break;
689 case IF_TYPE_SCSI:
690 devtype = "sd";
691 break;
692 case IF_TYPE_USB:
693 devtype = "usbd";
694 break;
695 case IF_TYPE_DOC:
696 devtype = "docd";
697 break;
698 case IF_TYPE_MMC:
699 case IF_TYPE_SD:
700 devtype = "mmcsd";
701 break;
702 default:
703 devtype = "xx";
704 break;
705 }
706
707 sprintf(name, "%s%c%d", devtype, 'a' + dev_desc->devnum, part_num);
708 }
709