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