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