| /* |
| * (C) Copyright 2001 |
| * Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
| * |
| * SPDX-License-Identifier: GPL-2.0+ |
| */ |
| |
| #include <common.h> |
| #include <command.h> |
| #include <ide.h> |
| #include <malloc.h> |
| #include <part.h> |
| |
| #undef PART_DEBUG |
| |
| #ifdef PART_DEBUG |
| #define PRINTF(fmt,args...) printf (fmt ,##args) |
| #else |
| #define PRINTF(fmt,args...) |
| #endif |
| |
| struct block_drvr { |
| char *name; |
| block_dev_desc_t* (*get_dev)(int dev); |
| }; |
| |
| static const struct block_drvr block_drvr[] = { |
| #if defined(CONFIG_CMD_IDE) |
| { .name = "ide", .get_dev = ide_get_dev, }, |
| #endif |
| #if defined(CONFIG_CMD_SATA) |
| {.name = "sata", .get_dev = sata_get_dev, }, |
| #endif |
| #if defined(CONFIG_CMD_SCSI) |
| { .name = "scsi", .get_dev = scsi_get_dev, }, |
| #endif |
| #if defined(CONFIG_CMD_USB) && defined(CONFIG_USB_STORAGE) |
| { .name = "usb", .get_dev = usb_stor_get_dev, }, |
| #endif |
| #if defined(CONFIG_MMC) |
| { .name = "mmc", .get_dev = mmc_get_dev, }, |
| #endif |
| #if defined(CONFIG_SYSTEMACE) |
| { .name = "ace", .get_dev = systemace_get_dev, }, |
| #endif |
| #if defined(CONFIG_SANDBOX) |
| { .name = "host", .get_dev = host_get_dev, }, |
| #endif |
| { }, |
| }; |
| |
| DECLARE_GLOBAL_DATA_PTR; |
| |
| #ifdef HAVE_BLOCK_DEVICE |
| block_dev_desc_t *get_dev(const char *ifname, int dev) |
| { |
| const struct block_drvr *drvr = block_drvr; |
| block_dev_desc_t* (*reloc_get_dev)(int dev); |
| char *name; |
| |
| if (!ifname) |
| return NULL; |
| |
| name = drvr->name; |
| #ifdef CONFIG_NEEDS_MANUAL_RELOC |
| name += gd->reloc_off; |
| #endif |
| while (drvr->name) { |
| name = drvr->name; |
| reloc_get_dev = drvr->get_dev; |
| #ifdef CONFIG_NEEDS_MANUAL_RELOC |
| name += gd->reloc_off; |
| reloc_get_dev += gd->reloc_off; |
| #endif |
| if (strncmp(ifname, name, strlen(name)) == 0) |
| return reloc_get_dev(dev); |
| drvr++; |
| } |
| return NULL; |
| } |
| #else |
| block_dev_desc_t *get_dev(const char *ifname, int dev) |
| { |
| return NULL; |
| } |
| #endif |
| |
| #ifdef HAVE_BLOCK_DEVICE |
| |
| /* ------------------------------------------------------------------------- */ |
| /* |
| * reports device info to the user |
| */ |
| |
| #ifdef CONFIG_LBA48 |
| typedef uint64_t lba512_t; |
| #else |
| typedef lbaint_t lba512_t; |
| #endif |
| |
| /* |
| * Overflowless variant of (block_count * mul_by / div_by) |
| * when div_by > mul_by |
| */ |
| static lba512_t lba512_muldiv (lba512_t block_count, lba512_t mul_by, lba512_t div_by) |
| { |
| lba512_t bc_quot, bc_rem; |
| |
| /* x * m / d == x / d * m + (x % d) * m / d */ |
| bc_quot = block_count / div_by; |
| bc_rem = block_count - div_by * bc_quot; |
| return bc_quot * mul_by + (bc_rem * mul_by) / div_by; |
| } |
| |
| void dev_print (block_dev_desc_t *dev_desc) |
| { |
| lba512_t lba512; /* number of blocks if 512bytes block size */ |
| |
| if (dev_desc->type == DEV_TYPE_UNKNOWN) { |
| puts ("not available\n"); |
| return; |
| } |
| |
| switch (dev_desc->if_type) { |
| case IF_TYPE_SCSI: |
| printf ("(%d:%d) Vendor: %s Prod.: %s Rev: %s\n", |
| dev_desc->target,dev_desc->lun, |
| dev_desc->vendor, |
| dev_desc->product, |
| dev_desc->revision); |
| break; |
| case IF_TYPE_ATAPI: |
| case IF_TYPE_IDE: |
| case IF_TYPE_SATA: |
| printf ("Model: %s Firm: %s Ser#: %s\n", |
| dev_desc->vendor, |
| dev_desc->revision, |
| dev_desc->product); |
| break; |
| case IF_TYPE_SD: |
| case IF_TYPE_MMC: |
| case IF_TYPE_USB: |
| printf ("Vendor: %s Rev: %s Prod: %s\n", |
| dev_desc->vendor, |
| dev_desc->revision, |
| dev_desc->product); |
| break; |
| case IF_TYPE_DOC: |
| puts("device type DOC\n"); |
| return; |
| case IF_TYPE_UNKNOWN: |
| puts("device type unknown\n"); |
| return; |
| default: |
| printf("Unhandled device type: %i\n", dev_desc->if_type); |
| return; |
| } |
| puts (" Type: "); |
| if (dev_desc->removable) |
| puts ("Removable "); |
| switch (dev_desc->type & 0x1F) { |
| case DEV_TYPE_HARDDISK: |
| puts ("Hard Disk"); |
| break; |
| case DEV_TYPE_CDROM: |
| puts ("CD ROM"); |
| break; |
| case DEV_TYPE_OPDISK: |
| puts ("Optical Device"); |
| break; |
| case DEV_TYPE_TAPE: |
| puts ("Tape"); |
| break; |
| default: |
| printf ("# %02X #", dev_desc->type & 0x1F); |
| break; |
| } |
| puts ("\n"); |
| if (dev_desc->lba > 0L && dev_desc->blksz > 0L) { |
| ulong mb, mb_quot, mb_rem, gb, gb_quot, gb_rem; |
| lbaint_t lba; |
| |
| lba = dev_desc->lba; |
| |
| lba512 = (lba * (dev_desc->blksz/512)); |
| /* round to 1 digit */ |
| mb = lba512_muldiv(lba512, 10, 2048); /* 2048 = (1024 * 1024) / 512 MB */ |
| |
| mb_quot = mb / 10; |
| mb_rem = mb - (10 * mb_quot); |
| |
| gb = mb / 1024; |
| gb_quot = gb / 10; |
| gb_rem = gb - (10 * gb_quot); |
| #ifdef CONFIG_LBA48 |
| if (dev_desc->lba48) |
| printf (" Supports 48-bit addressing\n"); |
| #endif |
| #if defined(CONFIG_SYS_64BIT_LBA) |
| printf (" Capacity: %ld.%ld MB = %ld.%ld GB (%Ld x %ld)\n", |
| mb_quot, mb_rem, |
| gb_quot, gb_rem, |
| lba, |
| dev_desc->blksz); |
| #else |
| printf (" Capacity: %ld.%ld MB = %ld.%ld GB (%ld x %ld)\n", |
| mb_quot, mb_rem, |
| gb_quot, gb_rem, |
| (ulong)lba, |
| dev_desc->blksz); |
| #endif |
| } else { |
| puts (" Capacity: not available\n"); |
| } |
| } |
| #endif |
| |
| #ifdef HAVE_BLOCK_DEVICE |
| |
| void init_part (block_dev_desc_t * dev_desc) |
| { |
| #ifdef CONFIG_ISO_PARTITION |
| if (test_part_iso(dev_desc) == 0) { |
| dev_desc->part_type = PART_TYPE_ISO; |
| return; |
| } |
| #endif |
| |
| #ifdef CONFIG_MAC_PARTITION |
| if (test_part_mac(dev_desc) == 0) { |
| dev_desc->part_type = PART_TYPE_MAC; |
| return; |
| } |
| #endif |
| |
| /* must be placed before DOS partition detection */ |
| #ifdef CONFIG_EFI_PARTITION |
| if (test_part_efi(dev_desc) == 0) { |
| dev_desc->part_type = PART_TYPE_EFI; |
| return; |
| } |
| #endif |
| |
| #ifdef CONFIG_DOS_PARTITION |
| if (test_part_dos(dev_desc) == 0) { |
| dev_desc->part_type = PART_TYPE_DOS; |
| return; |
| } |
| #endif |
| |
| #ifdef CONFIG_AMIGA_PARTITION |
| if (test_part_amiga(dev_desc) == 0) { |
| dev_desc->part_type = PART_TYPE_AMIGA; |
| return; |
| } |
| #endif |
| dev_desc->part_type = PART_TYPE_UNKNOWN; |
| } |
| |
| |
| #if defined(CONFIG_MAC_PARTITION) || \ |
| defined(CONFIG_DOS_PARTITION) || \ |
| defined(CONFIG_ISO_PARTITION) || \ |
| defined(CONFIG_AMIGA_PARTITION) || \ |
| defined(CONFIG_EFI_PARTITION) |
| |
| static void print_part_header (const char *type, block_dev_desc_t * dev_desc) |
| { |
| puts ("\nPartition Map for "); |
| switch (dev_desc->if_type) { |
| case IF_TYPE_IDE: |
| puts ("IDE"); |
| break; |
| case IF_TYPE_SATA: |
| puts ("SATA"); |
| break; |
| case IF_TYPE_SCSI: |
| puts ("SCSI"); |
| break; |
| case IF_TYPE_ATAPI: |
| puts ("ATAPI"); |
| break; |
| case IF_TYPE_USB: |
| puts ("USB"); |
| break; |
| case IF_TYPE_DOC: |
| puts ("DOC"); |
| break; |
| case IF_TYPE_MMC: |
| puts ("MMC"); |
| break; |
| case IF_TYPE_HOST: |
| puts("HOST"); |
| break; |
| default: |
| puts ("UNKNOWN"); |
| break; |
| } |
| printf (" device %d -- Partition Type: %s\n\n", |
| dev_desc->dev, type); |
| } |
| |
| #endif /* any CONFIG_..._PARTITION */ |
| |
| void print_part (block_dev_desc_t * dev_desc) |
| { |
| |
| switch (dev_desc->part_type) { |
| #ifdef CONFIG_MAC_PARTITION |
| case PART_TYPE_MAC: |
| PRINTF ("## Testing for valid MAC partition ##\n"); |
| print_part_header ("MAC", dev_desc); |
| print_part_mac (dev_desc); |
| return; |
| #endif |
| #ifdef CONFIG_DOS_PARTITION |
| case PART_TYPE_DOS: |
| PRINTF ("## Testing for valid DOS partition ##\n"); |
| print_part_header ("DOS", dev_desc); |
| print_part_dos (dev_desc); |
| return; |
| #endif |
| |
| #ifdef CONFIG_ISO_PARTITION |
| case PART_TYPE_ISO: |
| PRINTF ("## Testing for valid ISO Boot partition ##\n"); |
| print_part_header ("ISO", dev_desc); |
| print_part_iso (dev_desc); |
| return; |
| #endif |
| |
| #ifdef CONFIG_AMIGA_PARTITION |
| case PART_TYPE_AMIGA: |
| PRINTF ("## Testing for a valid Amiga partition ##\n"); |
| print_part_header ("AMIGA", dev_desc); |
| print_part_amiga (dev_desc); |
| return; |
| #endif |
| |
| #ifdef CONFIG_EFI_PARTITION |
| case PART_TYPE_EFI: |
| PRINTF ("## Testing for valid EFI partition ##\n"); |
| print_part_header ("EFI", dev_desc); |
| print_part_efi (dev_desc); |
| return; |
| #endif |
| } |
| puts ("## Unknown partition table\n"); |
| } |
| |
| #endif /* HAVE_BLOCK_DEVICE */ |
| |
| int get_partition_info(block_dev_desc_t *dev_desc, int part |
| , disk_partition_t *info) |
| { |
| #ifdef HAVE_BLOCK_DEVICE |
| |
| #ifdef CONFIG_PARTITION_UUIDS |
| /* The common case is no UUID support */ |
| info->uuid[0] = 0; |
| #endif |
| |
| switch (dev_desc->part_type) { |
| #ifdef CONFIG_MAC_PARTITION |
| case PART_TYPE_MAC: |
| if (get_partition_info_mac(dev_desc, part, info) == 0) { |
| PRINTF("## Valid MAC partition found ##\n"); |
| return 0; |
| } |
| break; |
| #endif |
| |
| #ifdef CONFIG_DOS_PARTITION |
| case PART_TYPE_DOS: |
| if (get_partition_info_dos(dev_desc, part, info) == 0) { |
| PRINTF("## Valid DOS partition found ##\n"); |
| return 0; |
| } |
| break; |
| #endif |
| |
| #ifdef CONFIG_ISO_PARTITION |
| case PART_TYPE_ISO: |
| if (get_partition_info_iso(dev_desc, part, info) == 0) { |
| PRINTF("## Valid ISO boot partition found ##\n"); |
| return 0; |
| } |
| break; |
| #endif |
| |
| #ifdef CONFIG_AMIGA_PARTITION |
| case PART_TYPE_AMIGA: |
| if (get_partition_info_amiga(dev_desc, part, info) == 0) { |
| PRINTF("## Valid Amiga partition found ##\n"); |
| return 0; |
| } |
| break; |
| #endif |
| |
| #ifdef CONFIG_EFI_PARTITION |
| case PART_TYPE_EFI: |
| if (get_partition_info_efi(dev_desc, part, info) == 0) { |
| PRINTF("## Valid EFI partition found ##\n"); |
| return 0; |
| } |
| break; |
| #endif |
| default: |
| break; |
| } |
| #endif /* HAVE_BLOCK_DEVICE */ |
| |
| return -1; |
| } |
| |
| int get_device(const char *ifname, const char *dev_str, |
| block_dev_desc_t **dev_desc) |
| { |
| char *ep; |
| int dev; |
| |
| dev = simple_strtoul(dev_str, &ep, 16); |
| if (*ep) { |
| printf("** Bad device specification %s %s **\n", |
| ifname, dev_str); |
| return -1; |
| } |
| |
| *dev_desc = get_dev(ifname, dev); |
| if (!(*dev_desc) || ((*dev_desc)->type == DEV_TYPE_UNKNOWN)) { |
| printf("** Bad device %s %s **\n", ifname, dev_str); |
| return -1; |
| } |
| |
| return dev; |
| } |
| |
| #define PART_UNSPECIFIED -2 |
| #define PART_AUTO -1 |
| #define MAX_SEARCH_PARTITIONS 16 |
| int get_device_and_partition(const char *ifname, const char *dev_part_str, |
| block_dev_desc_t **dev_desc, |
| disk_partition_t *info, int allow_whole_dev) |
| { |
| int ret = -1; |
| const char *part_str; |
| char *dup_str = NULL; |
| const char *dev_str; |
| int dev; |
| char *ep; |
| int p; |
| int part; |
| disk_partition_t tmpinfo; |
| |
| /* If no dev_part_str, use bootdevice environment variable */ |
| if (!dev_part_str || !strlen(dev_part_str) || |
| !strcmp(dev_part_str, "-")) |
| dev_part_str = getenv("bootdevice"); |
| |
| /* If still no dev_part_str, it's an error */ |
| if (!dev_part_str) { |
| printf("** No device specified **\n"); |
| goto cleanup; |
| } |
| |
| /* Separate device and partition ID specification */ |
| part_str = strchr(dev_part_str, ':'); |
| if (part_str) { |
| dup_str = strdup(dev_part_str); |
| dup_str[part_str - dev_part_str] = 0; |
| dev_str = dup_str; |
| part_str++; |
| } else { |
| dev_str = dev_part_str; |
| } |
| |
| /* Look up the device */ |
| dev = get_device(ifname, dev_str, dev_desc); |
| if (dev < 0) |
| goto cleanup; |
| |
| /* Convert partition ID string to number */ |
| if (!part_str || !*part_str) { |
| part = PART_UNSPECIFIED; |
| } else if (!strcmp(part_str, "auto")) { |
| part = PART_AUTO; |
| } else { |
| /* Something specified -> use exactly that */ |
| part = (int)simple_strtoul(part_str, &ep, 16); |
| /* |
| * Less than whole string converted, |
| * or request for whole device, but caller requires partition. |
| */ |
| if (*ep || (part == 0 && !allow_whole_dev)) { |
| printf("** Bad partition specification %s %s **\n", |
| ifname, dev_part_str); |
| goto cleanup; |
| } |
| } |
| |
| /* |
| * No partition table on device, |
| * or user requested partition 0 (entire device). |
| */ |
| if (((*dev_desc)->part_type == PART_TYPE_UNKNOWN) || |
| (part == 0)) { |
| if (!(*dev_desc)->lba) { |
| printf("** Bad device size - %s %s **\n", ifname, |
| dev_str); |
| goto cleanup; |
| } |
| |
| /* |
| * If user specified a partition ID other than 0, |
| * or the calling command only accepts partitions, |
| * it's an error. |
| */ |
| if ((part > 0) || (!allow_whole_dev)) { |
| printf("** No partition table - %s %s **\n", ifname, |
| dev_str); |
| goto cleanup; |
| } |
| |
| (*dev_desc)->log2blksz = LOG2((*dev_desc)->blksz); |
| |
| info->start = 0; |
| info->size = (*dev_desc)->lba; |
| info->blksz = (*dev_desc)->blksz; |
| info->bootable = 0; |
| strcpy((char *)info->type, BOOT_PART_TYPE); |
| strcpy((char *)info->name, "Whole Disk"); |
| #ifdef CONFIG_PARTITION_UUIDS |
| info->uuid[0] = 0; |
| #endif |
| |
| ret = 0; |
| goto cleanup; |
| } |
| |
| /* |
| * Now there's known to be a partition table, |
| * not specifying a partition means to pick partition 1. |
| */ |
| if (part == PART_UNSPECIFIED) |
| part = 1; |
| |
| /* |
| * If user didn't specify a partition number, or did specify something |
| * other than "auto", use that partition number directly. |
| */ |
| if (part != PART_AUTO) { |
| ret = get_partition_info(*dev_desc, part, info); |
| if (ret) { |
| printf("** Invalid partition %d **\n", part); |
| goto cleanup; |
| } |
| } else { |
| /* |
| * Find the first bootable partition. |
| * If none are bootable, fall back to the first valid partition. |
| */ |
| part = 0; |
| for (p = 1; p <= MAX_SEARCH_PARTITIONS; p++) { |
| ret = get_partition_info(*dev_desc, p, info); |
| if (ret) |
| continue; |
| |
| /* |
| * First valid partition, or new better partition? |
| * If so, save partition ID. |
| */ |
| if (!part || info->bootable) |
| part = p; |
| |
| /* Best possible partition? Stop searching. */ |
| if (info->bootable) |
| break; |
| |
| /* |
| * We now need to search further for best possible. |
| * If we what we just queried was the best so far, |
| * save the info since we over-write it next loop. |
| */ |
| if (part == p) |
| tmpinfo = *info; |
| } |
| /* If we found any acceptable partition */ |
| if (part) { |
| /* |
| * If we searched all possible partition IDs, |
| * return the first valid partition we found. |
| */ |
| if (p == MAX_SEARCH_PARTITIONS + 1) |
| *info = tmpinfo; |
| } else { |
| printf("** No valid partitions found **\n"); |
| ret = -1; |
| goto cleanup; |
| } |
| } |
| if (strncmp((char *)info->type, BOOT_PART_TYPE, sizeof(info->type)) != 0) { |
| printf("** Invalid partition type \"%.32s\"" |
| " (expect \"" BOOT_PART_TYPE "\")\n", |
| info->type); |
| ret = -1; |
| goto cleanup; |
| } |
| |
| (*dev_desc)->log2blksz = LOG2((*dev_desc)->blksz); |
| |
| ret = part; |
| goto cleanup; |
| |
| cleanup: |
| free(dup_str); |
| return ret; |
| } |