[people/ms/u-boot.git] / common / cmd_sata.c

/*
 * Copyright (C) 2000-2005, DENX Software Engineering
 *		Wolfgang Denk <wd@denx.de>
 * Copyright (C) Procsys. All rights reserved.
 *		Mushtaq Khan <mushtaq_k@procsys.com>
 *			<mushtaqk_921@yahoo.co.in>
 * Copyright (C) 2008 Freescale Semiconductor, Inc.
 *		Dave Liu <daveliu@freescale.com>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <command.h>
#include <part.h>
#include <sata.h>

static int sata_curr_device = -1;
block_dev_desc_t sata_dev_desc[CONFIG_SYS_SATA_MAX_DEVICE];

int __sata_initialize(void)
{
	int rc;
	int i;

	for (i = 0; i < CONFIG_SYS_SATA_MAX_DEVICE; i++) {
		memset(&sata_dev_desc[i], 0, sizeof(struct block_dev_desc));
		sata_dev_desc[i].if_type = IF_TYPE_SATA;
		sata_dev_desc[i].dev = i;
		sata_dev_desc[i].part_type = PART_TYPE_UNKNOWN;
		sata_dev_desc[i].type = DEV_TYPE_HARDDISK;
		sata_dev_desc[i].lba = 0;
		sata_dev_desc[i].blksz = 512;
		sata_dev_desc[i].log2blksz = LOG2(sata_dev_desc[i].blksz);
		sata_dev_desc[i].block_read = sata_read;
		sata_dev_desc[i].block_write = sata_write;

		rc = init_sata(i);
		if (!rc) {
			rc = scan_sata(i);
			if (!rc && (sata_dev_desc[i].lba > 0) &&
				(sata_dev_desc[i].blksz > 0))
				init_part(&sata_dev_desc[i]);
		}
	}
	sata_curr_device = 0;
	return rc;
}
int sata_initialize(void) __attribute__((weak,alias("__sata_initialize")));

#ifdef CONFIG_PARTITIONS
block_dev_desc_t *sata_get_dev(int dev)
{
	return (dev < CONFIG_SYS_SATA_MAX_DEVICE) ? &sata_dev_desc[dev] : NULL;
}
#endif

static int do_sata(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
{
	int rc = 0;

	if (argc == 2 && strcmp(argv[1], "init") == 0)
		return sata_initialize();

	/* If the user has not yet run `sata init`, do it now */
	if (sata_curr_device == -1)
		if (sata_initialize())
			return 1;

	switch (argc) {
	case 0:
	case 1:
		return CMD_RET_USAGE;
	case 2:
		if (strncmp(argv[1],"inf", 3) == 0) {
			int i;
			putc('\n');
			for (i = 0; i < CONFIG_SYS_SATA_MAX_DEVICE; ++i) {
				if (sata_dev_desc[i].type == DEV_TYPE_UNKNOWN)
					continue;
				printf ("SATA device %d: ", i);
				dev_print(&sata_dev_desc[i]);
			}
			return 0;
		} else if (strncmp(argv[1],"dev", 3) == 0) {
			if ((sata_curr_device < 0) || (sata_curr_device >= CONFIG_SYS_SATA_MAX_DEVICE)) {
				puts("\nno SATA devices available\n");
				return 1;
			}
			printf("\nSATA device %d: ", sata_curr_device);
			dev_print(&sata_dev_desc[sata_curr_device]);
			return 0;
		} else if (strncmp(argv[1],"part",4) == 0) {
			int dev, ok;

			for (ok = 0, dev = 0; dev < CONFIG_SYS_SATA_MAX_DEVICE; ++dev) {
				if (sata_dev_desc[dev].part_type != PART_TYPE_UNKNOWN) {
					++ok;
					if (dev)
						putc ('\n');
					print_part(&sata_dev_desc[dev]);
				}
			}
			if (!ok) {
				puts("\nno SATA devices available\n");
				rc ++;
			}
			return rc;
		}
		return CMD_RET_USAGE;
	case 3:
		if (strncmp(argv[1], "dev", 3) == 0) {
			int dev = (int)simple_strtoul(argv[2], NULL, 10);

			printf("\nSATA device %d: ", dev);
			if (dev >= CONFIG_SYS_SATA_MAX_DEVICE) {
				puts ("unknown device\n");
				return 1;
			}
			dev_print(&sata_dev_desc[dev]);

			if (sata_dev_desc[dev].type == DEV_TYPE_UNKNOWN)
				return 1;

			sata_curr_device = dev;

			puts("... is now current device\n");

			return 0;
		} else if (strncmp(argv[1], "part", 4) == 0) {
			int dev = (int)simple_strtoul(argv[2], NULL, 10);

			if (sata_dev_desc[dev].part_type != PART_TYPE_UNKNOWN) {
				print_part(&sata_dev_desc[dev]);
			} else {
				printf("\nSATA device %d not available\n", dev);
				rc = 1;
			}
			return rc;
		}
		return CMD_RET_USAGE;

	default: /* at least 4 args */
		if (strcmp(argv[1], "read") == 0) {
			ulong addr = simple_strtoul(argv[2], NULL, 16);
			ulong cnt = simple_strtoul(argv[4], NULL, 16);
			ulong n;
			lbaint_t blk = simple_strtoul(argv[3], NULL, 16);

			printf("\nSATA read: device %d block # %ld, count %ld ... ",
				sata_curr_device, blk, cnt);

			n = sata_read(sata_curr_device, blk, cnt, (u32 *)addr);

			/* flush cache after read */
			flush_cache(addr, cnt * sata_dev_desc[sata_curr_device].blksz);

			printf("%ld blocks read: %s\n",
				n, (n==cnt) ? "OK" : "ERROR");
			return (n == cnt) ? 0 : 1;
		} else if (strcmp(argv[1], "write") == 0) {
			ulong addr = simple_strtoul(argv[2], NULL, 16);
			ulong cnt = simple_strtoul(argv[4], NULL, 16);
			ulong n;

			lbaint_t blk = simple_strtoul(argv[3], NULL, 16);

			printf("\nSATA write: device %d block # %ld, count %ld ... ",
				sata_curr_device, blk, cnt);

			n = sata_write(sata_curr_device, blk, cnt, (u32 *)addr);

			printf("%ld blocks written: %s\n",
				n, (n == cnt) ? "OK" : "ERROR");
			return (n == cnt) ? 0 : 1;
		} else {
			return CMD_RET_USAGE;
		}

		return rc;
	}
}

U_BOOT_CMD(
	sata, 5, 1, do_sata,
	"SATA sub system",
	"init - init SATA sub system\n"
	"sata info - show available SATA devices\n"
	"sata device [dev] - show or set current device\n"
	"sata part [dev] - print partition table\n"
	"sata read addr blk# cnt\n"
	"sata write addr blk# cnt"
);
Commit	Line	Data
c7057b52 DL	1	/*
	2	* Copyright (C) 2000-2005, DENX Software Engineering
	3	* Wolfgang Denk <wd@denx.de>
	4	* Copyright (C) Procsys. All rights reserved.
	5	* Mushtaq Khan <mushtaq_k@procsys.com>
	6	* <mushtaqk_921@yahoo.co.in>
	7	* Copyright (C) 2008 Freescale Semiconductor, Inc.
	8	* Dave Liu <daveliu@freescale.com>
	9	*
1a459660	10	* SPDX-License-Identifier: GPL-2.0+
c7057b52 DL	11	*/
	12
	13	#include <common.h>
	14	#include <command.h>
	15	#include <part.h>
	16	#include <sata.h>
	17
088f1b19	18	static int sata_curr_device = -1;
6d0f6bcf	19	block_dev_desc_t sata_dev_desc[CONFIG_SYS_SATA_MAX_DEVICE];
c7057b52	20
cf7e399f	21	int __sata_initialize(void)
c7057b52 DL	22	{
	23	int rc;
	24	int i;
	25
6d0f6bcf	26	for (i = 0; i < CONFIG_SYS_SATA_MAX_DEVICE; i++) {
c7057b52 DL	27	memset(&sata_dev_desc[i], 0, sizeof(struct block_dev_desc));
	28	sata_dev_desc[i].if_type = IF_TYPE_SATA;
	29	sata_dev_desc[i].dev = i;
	30	sata_dev_desc[i].part_type = PART_TYPE_UNKNOWN;
	31	sata_dev_desc[i].type = DEV_TYPE_HARDDISK;
	32	sata_dev_desc[i].lba = 0;
	33	sata_dev_desc[i].blksz = 512;
0472fbfd	34	sata_dev_desc[i].log2blksz = LOG2(sata_dev_desc[i].blksz);
c7057b52 DL	35	sata_dev_desc[i].block_read = sata_read;
	36	sata_dev_desc[i].block_write = sata_write;
	37
	38	rc = init_sata(i);
71cadda3 SB	39	if (!rc) {
	40	rc = scan_sata(i);
	41	if (!rc && (sata_dev_desc[i].lba > 0) &&
	42	(sata_dev_desc[i].blksz > 0))
	43	init_part(&sata_dev_desc[i]);
	44	}
c7057b52	45	}
569460eb	46	sata_curr_device = 0;
c7057b52 DL	47	return rc;
c7057b52 DL	48	}
cf7e399f	49	int sata_initialize(void) __attribute__((weak,alias("__sata_initialize")));
c7057b52	50
df3fc526	51	#ifdef CONFIG_PARTITIONS
c7057b52 DL	52	block_dev_desc_t *sata_get_dev(int dev)
c7057b52 DL	53	{
6d0f6bcf	54	return (dev < CONFIG_SYS_SATA_MAX_DEVICE) ? &sata_dev_desc[dev] : NULL;
c7057b52	55	}
df3fc526	56	#endif
c7057b52	57
088f1b19	58	static int do_sata(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
c7057b52 DL	59	{
	60	int rc = 0;
	61
cf7e399f MF	62	if (argc == 2 && strcmp(argv[1], "init") == 0)
	63	return sata_initialize();
	64
	65	/* If the user has not yet run `sata init`, do it now */
569460eb	66	if (sata_curr_device == -1)
cf7e399f MF	67	if (sata_initialize())
	68	return 1;
	69
c7057b52 DL	70	switch (argc) {
	71	case 0:
	72	case 1:
4c12eeb8	73	return CMD_RET_USAGE;
c7057b52 DL	74	case 2:
	75	if (strncmp(argv[1],"inf", 3) == 0) {
	76	int i;
	77	putc('\n');
6d0f6bcf	78	for (i = 0; i < CONFIG_SYS_SATA_MAX_DEVICE; ++i) {
c7057b52 DL	79	if (sata_dev_desc[i].type == DEV_TYPE_UNKNOWN)
	80	continue;
	81	printf ("SATA device %d: ", i);
	82	dev_print(&sata_dev_desc[i]);
	83	}
	84	return 0;
	85	} else if (strncmp(argv[1],"dev", 3) == 0) {
569460eb	86	if ((sata_curr_device < 0) \|\| (sata_curr_device >= CONFIG_SYS_SATA_MAX_DEVICE)) {
c7057b52 DL	87	puts("\nno SATA devices available\n");
	88	return 1;
	89	}
569460eb MF	90	printf("\nSATA device %d: ", sata_curr_device);
569460eb MF	91	dev_print(&sata_dev_desc[sata_curr_device]);
c7057b52 DL	92	return 0;
	93	} else if (strncmp(argv[1],"part",4) == 0) {
	94	int dev, ok;
	95
6d0f6bcf	96	for (ok = 0, dev = 0; dev < CONFIG_SYS_SATA_MAX_DEVICE; ++dev) {
c7057b52 DL	97	if (sata_dev_desc[dev].part_type != PART_TYPE_UNKNOWN) {
	98	++ok;
	99	if (dev)
	100	putc ('\n');
	101	print_part(&sata_dev_desc[dev]);
	102	}
	103	}
	104	if (!ok) {
	105	puts("\nno SATA devices available\n");
	106	rc ++;
	107	}
	108	return rc;
	109	}
4c12eeb8	110	return CMD_RET_USAGE;
c7057b52 DL	111	case 3:
	112	if (strncmp(argv[1], "dev", 3) == 0) {
	113	int dev = (int)simple_strtoul(argv[2], NULL, 10);
	114
	115	printf("\nSATA device %d: ", dev);
6d0f6bcf	116	if (dev >= CONFIG_SYS_SATA_MAX_DEVICE) {
c7057b52 DL	117	puts ("unknown device\n");
	118	return 1;
	119	}
	120	dev_print(&sata_dev_desc[dev]);
	121
	122	if (sata_dev_desc[dev].type == DEV_TYPE_UNKNOWN)
	123	return 1;
	124
569460eb	125	sata_curr_device = dev;
c7057b52 DL	126
	127	puts("... is now current device\n");
	128
	129	return 0;
	130	} else if (strncmp(argv[1], "part", 4) == 0) {
	131	int dev = (int)simple_strtoul(argv[2], NULL, 10);
	132
	133	if (sata_dev_desc[dev].part_type != PART_TYPE_UNKNOWN) {
	134	print_part(&sata_dev_desc[dev]);
	135	} else {
	136	printf("\nSATA device %d not available\n", dev);
	137	rc = 1;
	138	}
	139	return rc;
	140	}
4c12eeb8	141	return CMD_RET_USAGE;
c7057b52 DL	142
	143	default: /* at least 4 args */
	144	if (strcmp(argv[1], "read") == 0) {
	145	ulong addr = simple_strtoul(argv[2], NULL, 16);
	146	ulong cnt = simple_strtoul(argv[4], NULL, 16);
	147	ulong n;
	148	lbaint_t blk = simple_strtoul(argv[3], NULL, 16);
	149
	150	printf("\nSATA read: device %d block # %ld, count %ld ... ",
569460eb	151	sata_curr_device, blk, cnt);
c7057b52	152
569460eb	153	n = sata_read(sata_curr_device, blk, cnt, (u32 *)addr);
c7057b52 DL	154
c7057b52 DL	155	/* flush cache after read */
569460eb	156	flush_cache(addr, cnt * sata_dev_desc[sata_curr_device].blksz);
c7057b52 DL	157
	158	printf("%ld blocks read: %s\n",
	159	n, (n==cnt) ? "OK" : "ERROR");
	160	return (n == cnt) ? 0 : 1;
	161	} else if (strcmp(argv[1], "write") == 0) {
	162	ulong addr = simple_strtoul(argv[2], NULL, 16);
	163	ulong cnt = simple_strtoul(argv[4], NULL, 16);
	164	ulong n;
	165
	166	lbaint_t blk = simple_strtoul(argv[3], NULL, 16);
	167
	168	printf("\nSATA write: device %d block # %ld, count %ld ... ",
569460eb	169	sata_curr_device, blk, cnt);
c7057b52	170
569460eb	171	n = sata_write(sata_curr_device, blk, cnt, (u32 *)addr);
c7057b52 DL	172
	173	printf("%ld blocks written: %s\n",
	174	n, (n == cnt) ? "OK" : "ERROR");
	175	return (n == cnt) ? 0 : 1;
	176	} else {
4c12eeb8	177	return CMD_RET_USAGE;
c7057b52 DL	178	}
	179
	180	return rc;
	181	}
	182	}
	183
	184	U_BOOT_CMD(
	185	sata, 5, 1, do_sata,
2fb2604d	186	"SATA sub system",
85dafbb8	187	"init - init SATA sub system\n"
c7057b52 DL	188	"sata info - show available SATA devices\n"
	189	"sata device [dev] - show or set current device\n"
	190	"sata part [dev] - print partition table\n"
	191	"sata read addr blk# cnt\n"
a89c33db WD	192	"sata write addr blk# cnt"
a89c33db WD	193	);