[people/ms/u-boot.git] / disk / part.c

/*
 * (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);
	int (*select_hwpart)(int dev_num, int hwpart);
};

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,
		.select_hwpart = mmc_select_hwpart,
	},
#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_hwpart(const char *ifname, int dev, int hwpart)
{
	const struct block_drvr *drvr = block_drvr;
	block_dev_desc_t* (*reloc_get_dev)(int dev);
	int (*select_hwpart)(int dev_num, int hwpart);
	char *name;
	int ret;

	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;
		select_hwpart = drvr->select_hwpart;
#ifdef CONFIG_NEEDS_MANUAL_RELOC
		name += gd->reloc_off;
		reloc_get_dev += gd->reloc_off;
		if (select_hwpart)
			select_hwpart += gd->reloc_off;
#endif
		if (strncmp(ifname, name, strlen(name)) == 0) {
			block_dev_desc_t *dev_desc = reloc_get_dev(dev);
			if (!dev_desc)
				return NULL;
			if (hwpart == 0 && !select_hwpart)
				return dev_desc;
			if (!select_hwpart)
				return NULL;
			ret = select_hwpart(dev_desc->dev, hwpart);
			if (ret < 0)
				return NULL;
			return dev_desc;
		}
		drvr++;
	}
	return NULL;
}

block_dev_desc_t *get_dev(const char *ifname, int dev)
{
	return get_dev_hwpart(ifname, dev, 0);
}
#else
block_dev_desc_t *get_dev_hwpart(const char *ifname, int dev, int hwpart)
{
	return NULL;
}

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_hwpart_str,
	       block_dev_desc_t **dev_desc)
{
	char *ep;
	char *dup_str = NULL;
	const char *dev_str, *hwpart_str;
	int dev, hwpart;

	hwpart_str = strchr(dev_hwpart_str, '.');
	if (hwpart_str) {
		dup_str = strdup(dev_hwpart_str);
		dup_str[hwpart_str - dev_hwpart_str] = 0;
		dev_str = dup_str;
		hwpart_str++;
	} else {
		dev_str = dev_hwpart_str;
		hwpart = 0;
	}

	dev = simple_strtoul(dev_str, &ep, 16);
	if (*ep) {
		printf("** Bad device specification %s %s **\n",
		       ifname, dev_str);
		dev = -1;
		goto cleanup;
	}

	if (hwpart_str) {
		hwpart = simple_strtoul(hwpart_str, &ep, 16);
		if (*ep) {
			printf("** Bad HW partition specification %s %s **\n",
			    ifname, hwpart_str);
			dev = -1;
			goto cleanup;
		}
	}

	*dev_desc = get_dev_hwpart(ifname, dev, hwpart);
	if (!(*dev_desc) || ((*dev_desc)->type == DEV_TYPE_UNKNOWN)) {
		printf("** Bad device %s %s **\n", ifname, dev_hwpart_str);
		dev = -1;
		goto cleanup;
	}

cleanup:
	free(dup_str);
	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;

	/*
	 * Special-case a psuedo block device "hostfs", to allow access to the
	 * host's own filesystem.
	 */
	if (0 == strcmp(ifname, "hostfs")) {
		*dev_desc = NULL;
		info->start = 0;
		info->size = 0;
		info->blksz = 0;
		info->bootable = 0;
		strcpy((char *)info->type, BOOT_PART_TYPE);
		strcpy((char *)info->name, "Sandbox host");
#ifdef CONFIG_PARTITION_UUIDS
		info->uuid[0] = 0;
#endif

		return 0;
	}

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