[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>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */

#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	*
	10	* This program is free software; you can redistribute it and/or
	11	* modify it under the terms of the GNU General Public License as
	12	* published by the Free Software Foundation; either version 2 of
	13	* the License, or (at your option) any later version.
	14	*
	15	* This program is distributed in the hope that it will be useful,
	16	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	17	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	18	* GNU General Public License for more details.
	19	*
	20	* You should have received a copy of the GNU General Public License
	21	* along with this program; if not, write to the Free Software
	22	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	23	* MA 02111-1307 USA
	24	*/
	25
	26	#include <common.h>
	27	#include <command.h>
	28	#include <part.h>
	29	#include <sata.h>
	30
088f1b19	31	static int sata_curr_device = -1;
6d0f6bcf	32	block_dev_desc_t sata_dev_desc[CONFIG_SYS_SATA_MAX_DEVICE];
c7057b52	33
cf7e399f	34	int __sata_initialize(void)
c7057b52 DL	35	{
	36	int rc;
	37	int i;
	38
6d0f6bcf	39	for (i = 0; i < CONFIG_SYS_SATA_MAX_DEVICE; i++) {
c7057b52 DL	40	memset(&sata_dev_desc[i], 0, sizeof(struct block_dev_desc));
	41	sata_dev_desc[i].if_type = IF_TYPE_SATA;
	42	sata_dev_desc[i].dev = i;
	43	sata_dev_desc[i].part_type = PART_TYPE_UNKNOWN;
	44	sata_dev_desc[i].type = DEV_TYPE_HARDDISK;
	45	sata_dev_desc[i].lba = 0;
	46	sata_dev_desc[i].blksz = 512;
0472fbfd	47	sata_dev_desc[i].log2blksz = LOG2(sata_dev_desc[i].blksz);
c7057b52 DL	48	sata_dev_desc[i].block_read = sata_read;
	49	sata_dev_desc[i].block_write = sata_write;
	50
	51	rc = init_sata(i);
71cadda3 SB	52	if (!rc) {
	53	rc = scan_sata(i);
	54	if (!rc && (sata_dev_desc[i].lba > 0) &&
	55	(sata_dev_desc[i].blksz > 0))
	56	init_part(&sata_dev_desc[i]);
	57	}
c7057b52	58	}
569460eb	59	sata_curr_device = 0;
c7057b52 DL	60	return rc;
c7057b52 DL	61	}
cf7e399f	62	int sata_initialize(void) __attribute__((weak,alias("__sata_initialize")));
c7057b52	63
df3fc526	64	#ifdef CONFIG_PARTITIONS
c7057b52 DL	65	block_dev_desc_t *sata_get_dev(int dev)
c7057b52 DL	66	{
6d0f6bcf	67	return (dev < CONFIG_SYS_SATA_MAX_DEVICE) ? &sata_dev_desc[dev] : NULL;
c7057b52	68	}
df3fc526	69	#endif
c7057b52	70
088f1b19	71	static int do_sata(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
c7057b52 DL	72	{
	73	int rc = 0;
	74
cf7e399f MF	75	if (argc == 2 && strcmp(argv[1], "init") == 0)
	76	return sata_initialize();
	77
	78	/* If the user has not yet run `sata init`, do it now */
569460eb	79	if (sata_curr_device == -1)
cf7e399f MF	80	if (sata_initialize())
	81	return 1;
	82
c7057b52 DL	83	switch (argc) {
	84	case 0:
	85	case 1:
4c12eeb8	86	return CMD_RET_USAGE;
c7057b52 DL	87	case 2:
	88	if (strncmp(argv[1],"inf", 3) == 0) {
	89	int i;
	90	putc('\n');
6d0f6bcf	91	for (i = 0; i < CONFIG_SYS_SATA_MAX_DEVICE; ++i) {
c7057b52 DL	92	if (sata_dev_desc[i].type == DEV_TYPE_UNKNOWN)
	93	continue;
	94	printf ("SATA device %d: ", i);
	95	dev_print(&sata_dev_desc[i]);
	96	}
	97	return 0;
	98	} else if (strncmp(argv[1],"dev", 3) == 0) {
569460eb	99	if ((sata_curr_device < 0) \|\| (sata_curr_device >= CONFIG_SYS_SATA_MAX_DEVICE)) {
c7057b52 DL	100	puts("\nno SATA devices available\n");
	101	return 1;
	102	}
569460eb MF	103	printf("\nSATA device %d: ", sata_curr_device);
569460eb MF	104	dev_print(&sata_dev_desc[sata_curr_device]);
c7057b52 DL	105	return 0;
	106	} else if (strncmp(argv[1],"part",4) == 0) {
	107	int dev, ok;
	108
6d0f6bcf	109	for (ok = 0, dev = 0; dev < CONFIG_SYS_SATA_MAX_DEVICE; ++dev) {
c7057b52 DL	110	if (sata_dev_desc[dev].part_type != PART_TYPE_UNKNOWN) {
	111	++ok;
	112	if (dev)
	113	putc ('\n');
	114	print_part(&sata_dev_desc[dev]);
	115	}
	116	}
	117	if (!ok) {
	118	puts("\nno SATA devices available\n");
	119	rc ++;
	120	}
	121	return rc;
	122	}
4c12eeb8	123	return CMD_RET_USAGE;
c7057b52 DL	124	case 3:
	125	if (strncmp(argv[1], "dev", 3) == 0) {
	126	int dev = (int)simple_strtoul(argv[2], NULL, 10);
	127
	128	printf("\nSATA device %d: ", dev);
6d0f6bcf	129	if (dev >= CONFIG_SYS_SATA_MAX_DEVICE) {
c7057b52 DL	130	puts ("unknown device\n");
	131	return 1;
	132	}
	133	dev_print(&sata_dev_desc[dev]);
	134
	135	if (sata_dev_desc[dev].type == DEV_TYPE_UNKNOWN)
	136	return 1;
	137
569460eb	138	sata_curr_device = dev;
c7057b52 DL	139
	140	puts("... is now current device\n");
	141
	142	return 0;
	143	} else if (strncmp(argv[1], "part", 4) == 0) {
	144	int dev = (int)simple_strtoul(argv[2], NULL, 10);
	145
	146	if (sata_dev_desc[dev].part_type != PART_TYPE_UNKNOWN) {
	147	print_part(&sata_dev_desc[dev]);
	148	} else {
	149	printf("\nSATA device %d not available\n", dev);
	150	rc = 1;
	151	}
	152	return rc;
	153	}
4c12eeb8	154	return CMD_RET_USAGE;
c7057b52 DL	155
	156	default: /* at least 4 args */
	157	if (strcmp(argv[1], "read") == 0) {
	158	ulong addr = simple_strtoul(argv[2], NULL, 16);
	159	ulong cnt = simple_strtoul(argv[4], NULL, 16);
	160	ulong n;
	161	lbaint_t blk = simple_strtoul(argv[3], NULL, 16);
	162
	163	printf("\nSATA read: device %d block # %ld, count %ld ... ",
569460eb	164	sata_curr_device, blk, cnt);
c7057b52	165
569460eb	166	n = sata_read(sata_curr_device, blk, cnt, (u32 *)addr);
c7057b52 DL	167
c7057b52 DL	168	/* flush cache after read */
569460eb	169	flush_cache(addr, cnt * sata_dev_desc[sata_curr_device].blksz);
c7057b52 DL	170
	171	printf("%ld blocks read: %s\n",
	172	n, (n==cnt) ? "OK" : "ERROR");
	173	return (n == cnt) ? 0 : 1;
	174	} else if (strcmp(argv[1], "write") == 0) {
	175	ulong addr = simple_strtoul(argv[2], NULL, 16);
	176	ulong cnt = simple_strtoul(argv[4], NULL, 16);
	177	ulong n;
	178
	179	lbaint_t blk = simple_strtoul(argv[3], NULL, 16);
	180
	181	printf("\nSATA write: device %d block # %ld, count %ld ... ",
569460eb	182	sata_curr_device, blk, cnt);
c7057b52	183
569460eb	184	n = sata_write(sata_curr_device, blk, cnt, (u32 *)addr);
c7057b52 DL	185
	186	printf("%ld blocks written: %s\n",
	187	n, (n == cnt) ? "OK" : "ERROR");
	188	return (n == cnt) ? 0 : 1;
	189	} else {
4c12eeb8	190	return CMD_RET_USAGE;
c7057b52 DL	191	}
	192
	193	return rc;
	194	}
	195	}
	196
	197	U_BOOT_CMD(
	198	sata, 5, 1, do_sata,
2fb2604d	199	"SATA sub system",
85dafbb8	200	"init - init SATA sub system\n"
c7057b52 DL	201	"sata info - show available SATA devices\n"
	202	"sata device [dev] - show or set current device\n"
	203	"sata part [dev] - print partition table\n"
	204	"sata read addr blk# cnt\n"
a89c33db WD	205	"sata write addr blk# cnt"
a89c33db WD	206	);