Skip to content
Snippets Groups Projects
cmd_ide.c 35.4 KiB
Newer Older
Wolfgang Denk's avatar
Wolfgang Denk committed
/*
 * (C) Copyright 2000-2011
Wolfgang Denk's avatar
Wolfgang Denk committed
 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 *
 * SPDX-License-Identifier:	GPL-2.0+
Wolfgang Denk's avatar
Wolfgang Denk committed
 */

/*
 * IDE support
 */
Wolfgang Denk's avatar
Wolfgang Denk committed
#include <common.h>
#include <config.h>
#include <watchdog.h>
#include <command.h>
#include <image.h>
#include <asm/byteorder.h>
Wolfgang Denk's avatar
Wolfgang Denk committed
#if defined(CONFIG_IDE_8xx_DIRECT) || defined(CONFIG_IDE_PCMCIA)
# include <pcmcia.h>
#endif
Wolfgang Denk's avatar
Wolfgang Denk committed
#include <ide.h>
#include <ata.h>
Wolfgang Denk's avatar
Wolfgang Denk committed
#ifdef CONFIG_STATUS_LED
# include <status_led.h>
#endif
#ifdef __PPC__
# define EIEIO		__asm__ volatile ("eieio")
# define SYNC		__asm__ volatile ("sync")
Wolfgang Denk's avatar
Wolfgang Denk committed
#endif

/* ------------------------------------------------------------------------- */

/* Current I/O Device	*/
static int curr_device = -1;

/* Current offset for IDE0 / IDE1 bus access	*/
ulong ide_bus_offset[CONFIG_SYS_IDE_MAXBUS] = {
#if defined(CONFIG_SYS_ATA_IDE0_OFFSET)
	CONFIG_SYS_ATA_IDE0_OFFSET,
Wolfgang Denk's avatar
Wolfgang Denk committed
#endif
#if defined(CONFIG_SYS_ATA_IDE1_OFFSET) && (CONFIG_SYS_IDE_MAXBUS > 1)
	CONFIG_SYS_ATA_IDE1_OFFSET,
Wolfgang Denk's avatar
Wolfgang Denk committed
#endif
};

static int ide_bus_ok[CONFIG_SYS_IDE_MAXBUS];
Wolfgang Denk's avatar
Wolfgang Denk committed

block_dev_desc_t ide_dev_desc[CONFIG_SYS_IDE_MAXDEVICE];
Wolfgang Denk's avatar
Wolfgang Denk committed
/* ------------------------------------------------------------------------- */

#ifdef CONFIG_IDE_RESET
static void  ide_reset (void);
#else
#define ide_reset()	/* dummy */
#endif

static void  ide_ident (block_dev_desc_t *dev_desc);
static uchar ide_wait  (int dev, ulong t);

#define IDE_TIME_OUT	2000	/* 2 sec timeout */

#define ATAPI_TIME_OUT	7000	/* 7 sec timeout (5 sec seems to work...) */

#define IDE_SPIN_UP_TIME_OUT 5000 /* 5 sec spin-up timeout */

static void ident_cpy (unsigned char *dest, unsigned char *src, unsigned int len);

#ifndef CONFIG_SYS_ATA_PORT_ADDR
#define CONFIG_SYS_ATA_PORT_ADDR(port) (port)
Wolfgang Denk's avatar
Wolfgang Denk committed

#ifdef CONFIG_ATAPI
static void	atapi_inquiry(block_dev_desc_t *dev_desc);
static ulong atapi_read(int device, ulong blknr, lbaint_t blkcnt,
			void *buffer);
Wolfgang Denk's avatar
Wolfgang Denk committed
#endif


/* ------------------------------------------------------------------------- */

int do_ide(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
Wolfgang Denk's avatar
Wolfgang Denk committed
{
	int rcode = 0;

	switch (argc) {
	case 0:
	case 1:
	case 2:
		if (strncmp(argv[1], "res", 3) == 0) {
			puts("\nReset IDE"
Wolfgang Denk's avatar
Wolfgang Denk committed
#ifdef CONFIG_IDE_8xx_DIRECT
			     " on PCMCIA " PCMCIA_SLOT_MSG
Wolfgang Denk's avatar
Wolfgang Denk committed
#endif
Wolfgang Denk's avatar
Wolfgang Denk committed

			ide_init();
			return 0;
		} else if (strncmp(argv[1], "inf", 3) == 0) {
			int i;
Wolfgang Denk's avatar
Wolfgang Denk committed

			putc('\n');
Wolfgang Denk's avatar
Wolfgang Denk committed

			for (i = 0; i < CONFIG_SYS_IDE_MAXDEVICE; ++i) {
				if (ide_dev_desc[i].type == DEV_TYPE_UNKNOWN)
					continue;  /* list only known devices */
				printf("IDE device %d: ", i);
				dev_print(&ide_dev_desc[i]);
			}
			return 0;
Wolfgang Denk's avatar
Wolfgang Denk committed

		} else if (strncmp(argv[1], "dev", 3) == 0) {
			if ((curr_device < 0)
			    || (curr_device >= CONFIG_SYS_IDE_MAXDEVICE)) {
				puts("\nno IDE devices available\n");
				return 1;
Wolfgang Denk's avatar
Wolfgang Denk committed
			}
			printf("\nIDE device %d: ", curr_device);
			dev_print(&ide_dev_desc[curr_device]);
			return 0;
		} else if (strncmp(argv[1], "part", 4) == 0) {
			int dev, ok;

			for (ok = 0, dev = 0;
			     dev < CONFIG_SYS_IDE_MAXDEVICE;
			     ++dev) {
				if (ide_dev_desc[dev].part_type !=
				    PART_TYPE_UNKNOWN) {
					++ok;
					if (dev)
						putc('\n');
					print_part(&ide_dev_desc[dev]);
				}
			}
			if (!ok) {
				puts("\nno IDE devices available\n");
				rcode++;
			}
			return rcode;
Wolfgang Denk's avatar
Wolfgang Denk committed
		}
	case 3:
		if (strncmp(argv[1], "dev", 3) == 0) {
			int dev = (int) simple_strtoul(argv[2], NULL, 10);
Wolfgang Denk's avatar
Wolfgang Denk committed

			printf("\nIDE device %d: ", dev);
			if (dev >= CONFIG_SYS_IDE_MAXDEVICE) {
				puts("unknown device\n");
				return 1;
			}
			dev_print(&ide_dev_desc[dev]);
			/*ide_print (dev); */
Wolfgang Denk's avatar
Wolfgang Denk committed

			if (ide_dev_desc[dev].type == DEV_TYPE_UNKNOWN)
				return 1;
Wolfgang Denk's avatar
Wolfgang Denk committed

			curr_device = dev;
Wolfgang Denk's avatar
Wolfgang Denk committed

			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);
Wolfgang Denk's avatar
Wolfgang Denk committed

			if (ide_dev_desc[dev].part_type != PART_TYPE_UNKNOWN) {
Wolfgang Denk's avatar
Wolfgang Denk committed
				print_part(&ide_dev_desc[dev]);
			} else {
				printf("\nIDE device %d not available\n",
				       dev);
				rcode = 1;
			}
			return rcode;
Wolfgang Denk's avatar
Wolfgang Denk committed
		}

	default:
		/* at least 4 args */
Wolfgang Denk's avatar
Wolfgang Denk committed

		if (strcmp(argv[1], "read") == 0) {
			ulong addr = simple_strtoul(argv[2], NULL, 16);
			ulong cnt = simple_strtoul(argv[4], NULL, 16);
			ulong n;
Wolfgang Denk's avatar
Wolfgang Denk committed

#ifdef CONFIG_SYS_64BIT_LBA
			lbaint_t blk = simple_strtoull(argv[3], NULL, 16);
Wolfgang Denk's avatar
Wolfgang Denk committed

			printf("\nIDE read: device %d block # %lld, count %ld ... ",
				curr_device, blk, cnt);
			lbaint_t blk = simple_strtoul(argv[3], NULL, 16);

			printf("\nIDE read: device %d block # %ld, count %ld ... ",
				curr_device, blk, cnt);
#endif

			n = ide_dev_desc[curr_device].block_read(curr_device,
								 blk, cnt,
								 (ulong *)addr);
			/* flush cache after read */
			flush_cache(addr,
				    cnt * ide_dev_desc[curr_device].blksz);

			printf("%ld blocks read: %s\n",
			       n, (n == cnt) ? "OK" : "ERROR");
			if (n == cnt)
				return 0;
			else
				return 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;
Wolfgang Denk's avatar
Wolfgang Denk committed

#ifdef CONFIG_SYS_64BIT_LBA
			lbaint_t blk = simple_strtoull(argv[3], NULL, 16);
Wolfgang Denk's avatar
Wolfgang Denk committed

			printf("\nIDE write: device %d block # %lld, count %ld ... ",
				curr_device, blk, cnt);
			lbaint_t blk = simple_strtoul(argv[3], NULL, 16);
			printf("\nIDE write: device %d block # %ld, count %ld ... ",
				curr_device, blk, cnt);
			n = ide_write(curr_device, blk, cnt, (ulong *) addr);
Wolfgang Denk's avatar
Wolfgang Denk committed

			printf("%ld blocks written: %s\n",
				n, (n == cnt) ? "OK" : "ERROR");
			if (n == cnt)
				return 0;
			else
				return 1;
		} else {
Wolfgang Denk's avatar
Wolfgang Denk committed

		return rcode;
int do_diskboot(cmd_tbl_t *cmdtp, int flag, int argc, char *const argv[])
Wolfgang Denk's avatar
Wolfgang Denk committed
{
	return common_diskboot(cmdtp, "ide", argc, argv);
Wolfgang Denk's avatar
Wolfgang Denk committed
}

/* ------------------------------------------------------------------------- */

__weak void ide_led(uchar led, uchar status)
{
#if defined(CONFIG_IDE_LED) && defined(PER8_BASE) /* required by LED_PORT */
	static uchar led_buffer;	/* Buffer for current LED status */

	uchar *led_port = LED_PORT;

	if (status)		/* switch LED on        */
		led_buffer |= led;
	else			/* switch LED off       */
		led_buffer &= ~led;

	*led_port = led_buffer;
#endif
}

#ifndef CONFIG_IDE_LED	/* define LED macros, they are not used anyways */
# define DEVICE_LED(x) 0
# define LED_IDE1 1
# define LED_IDE2 2
#endif

/* ------------------------------------------------------------------------- */

__weak void ide_outb(int dev, int port, unsigned char val)
Stefan Roese's avatar
Stefan Roese committed
{
	debug("ide_outb (dev= %d, port= 0x%x, val= 0x%02x) : @ 0x%08lx\n",
	      dev, port, val,
	      (ATA_CURR_BASE(dev) + CONFIG_SYS_ATA_PORT_ADDR(port)));

#if defined(CONFIG_IDE_AHB)
	if (port) {
		/* write command */
		ide_write_register(dev, port, val);
	} else {
		/* write data */
		outb(val, (ATA_CURR_BASE(dev)));
	}
#else
	outb(val, (ATA_CURR_BASE(dev) + CONFIG_SYS_ATA_PORT_ADDR(port)));
Stefan Roese's avatar
Stefan Roese committed
}
__weak unsigned char ide_inb(int dev, int port)
Stefan Roese's avatar
Stefan Roese committed
{
	uchar val;

#if defined(CONFIG_IDE_AHB)
	val = ide_read_register(dev, port);
#else
	val = inb((ATA_CURR_BASE(dev) + CONFIG_SYS_ATA_PORT_ADDR(port)));
	debug("ide_inb (dev= %d, port= 0x%x) : @ 0x%08lx -> 0x%02x\n",
	      dev, port,
	      (ATA_CURR_BASE(dev) + CONFIG_SYS_ATA_PORT_ADDR(port)), val);
Stefan Roese's avatar
Stefan Roese committed
	return val;
}

void ide_init(void)
Wolfgang Denk's avatar
Wolfgang Denk committed
{
	unsigned char c;
	int i, bus;
#ifdef CONFIG_IDE_8xx_PCCARD
	extern int ide_devices_found;	/* Initialized in check_ide_device() */
#endif /* CONFIG_IDE_8xx_PCCARD */

#ifdef CONFIG_IDE_PREINIT
	WATCHDOG_RESET();

	if (ide_preinit()) {
		puts("ide_preinit failed\n");
#endif /* CONFIG_IDE_PREINIT */
Wolfgang Denk's avatar
Wolfgang Denk committed

	WATCHDOG_RESET();

	/*
	 * Reset the IDE just to be sure.
Wolfgang Denk's avatar
Wolfgang Denk committed
	 * Light LED's to show
	 */
	ide_led((LED_IDE1 | LED_IDE2), 1);	/* LED's on     */

	/* ATAPI Drives seems to need a proper IDE Reset */
	ide_reset();
Wolfgang Denk's avatar
Wolfgang Denk committed

#ifdef CONFIG_IDE_INIT_POSTRESET
	WATCHDOG_RESET();
Wolfgang Denk's avatar
Wolfgang Denk committed

	if (ide_init_postreset()) {
		puts("ide_preinit_postreset failed\n");
		return;
	}
#endif /* CONFIG_IDE_INIT_POSTRESET */
Wolfgang Denk's avatar
Wolfgang Denk committed

	/*
	 * Wait for IDE to get ready.
	 * According to spec, this can take up to 31 seconds!
	 */
	for (bus = 0; bus < CONFIG_SYS_IDE_MAXBUS; ++bus) {
		int dev =
			bus * (CONFIG_SYS_IDE_MAXDEVICE /
			       CONFIG_SYS_IDE_MAXBUS);
Wolfgang Denk's avatar
Wolfgang Denk committed

#ifdef CONFIG_IDE_8xx_PCCARD
		/* Skip non-ide devices from probing */
		if ((ide_devices_found & (1 << bus)) == 0) {
			ide_led((LED_IDE1 | LED_IDE2), 0);	/* LED's off */
		printf("Bus %d: ", bus);
Wolfgang Denk's avatar
Wolfgang Denk committed

		ide_bus_ok[bus] = 0;

		/* Select device
		 */
		udelay(100000);	/* 100 ms */
		ide_outb(dev, ATA_DEV_HD, ATA_LBA | ATA_DEVICE(dev));
		udelay(100000);	/* 100 ms */
Wolfgang Denk's avatar
Wolfgang Denk committed
		i = 0;
		do {
			udelay(10000);	/* 10 ms */
Wolfgang Denk's avatar
Wolfgang Denk committed

			c = ide_inb(dev, ATA_STATUS);
Wolfgang Denk's avatar
Wolfgang Denk committed
			i++;
			if (i > (ATA_RESET_TIME * 100)) {
				puts("** Timeout **\n");
				/* LED's off */
				ide_led((LED_IDE1 | LED_IDE2), 0);
Wolfgang Denk's avatar
Wolfgang Denk committed
				return;
			}
			if ((i >= 100) && ((i % 100) == 0))
				putc('.');

Wolfgang Denk's avatar
Wolfgang Denk committed
		} while (c & ATA_STAT_BUSY);

		if (c & (ATA_STAT_BUSY | ATA_STAT_FAULT)) {
			puts("not available  ");
			debug("Status = 0x%02X ", c);
#ifndef CONFIG_ATAPI		/* ATAPI Devices do not set DRDY */
		} else if ((c & ATA_STAT_READY) == 0) {
			puts("not available  ");
			debug("Status = 0x%02X ", c);
Wolfgang Denk's avatar
Wolfgang Denk committed
#endif
		} else {
			puts("OK ");
Wolfgang Denk's avatar
Wolfgang Denk committed
			ide_bus_ok[bus] = 1;
		}
		WATCHDOG_RESET();
	}
	putc('\n');
Wolfgang Denk's avatar
Wolfgang Denk committed

	ide_led((LED_IDE1 | LED_IDE2), 0);	/* LED's off    */
Wolfgang Denk's avatar
Wolfgang Denk committed

	curr_device = -1;
	for (i = 0; i < CONFIG_SYS_IDE_MAXDEVICE; ++i) {
Wolfgang Denk's avatar
Wolfgang Denk committed
		int led = (IDE_BUS(i) == 0) ? LED_IDE1 : LED_IDE2;
		ide_dev_desc[i].type = DEV_TYPE_UNKNOWN;
		ide_dev_desc[i].if_type = IF_TYPE_IDE;
		ide_dev_desc[i].dev = i;
		ide_dev_desc[i].part_type = PART_TYPE_UNKNOWN;
		ide_dev_desc[i].blksz = 0;
		ide_dev_desc[i].log2blksz =
			LOG2_INVALID(typeof(ide_dev_desc[i].log2blksz));
		ide_dev_desc[i].lba = 0;
		ide_dev_desc[i].block_read = ide_read;
		ide_dev_desc[i].block_write = ide_write;
Wolfgang Denk's avatar
Wolfgang Denk committed
		if (!ide_bus_ok[IDE_BUS(i)])
			continue;
		ide_led(led, 1);	/* LED on       */
Wolfgang Denk's avatar
Wolfgang Denk committed
		ide_ident(&ide_dev_desc[i]);
		ide_led(led, 0);	/* LED off      */
Wolfgang Denk's avatar
Wolfgang Denk committed
		dev_print(&ide_dev_desc[i]);
Wolfgang Denk's avatar
Wolfgang Denk committed
		if ((ide_dev_desc[i].lba > 0) && (ide_dev_desc[i].blksz > 0)) {
			/* initialize partition type */
			init_part(&ide_dev_desc[i]);
Wolfgang Denk's avatar
Wolfgang Denk committed
			if (curr_device < 0)
				curr_device = i;
		}
	}
	WATCHDOG_RESET();
}

/* ------------------------------------------------------------------------- */

#ifdef CONFIG_PARTITIONS
block_dev_desc_t *ide_get_dev(int dev)
Wolfgang Denk's avatar
Wolfgang Denk committed
{
	return (dev < CONFIG_SYS_IDE_MAXDEVICE) ? &ide_dev_desc[dev] : NULL;
Wolfgang Denk's avatar
Wolfgang Denk committed
}
Wolfgang Denk's avatar
Wolfgang Denk committed

/* ------------------------------------------------------------------------- */

/* We only need to swap data if we are running on a big endian cpu. */
#if defined(__LITTLE_ENDIAN)
__weak void ide_input_swap_data(int dev, ulong *sect_buf, int words)
__weak void ide_input_swap_data(int dev, ulong *sect_buf, int words)
Wolfgang Denk's avatar
Wolfgang Denk committed
{
	volatile ushort *pbuf =
		(ushort *) (ATA_CURR_BASE(dev) + ATA_DATA_REG);
	ushort *dbuf = (ushort *) sect_buf;
	debug("in input swap data base for read is %lx\n",
	      (unsigned long) pbuf);
Loading
Loading full blame...