[linux-block.git] / drivers / ide / ide-eh.c


#include <linux/kernel.h>
#include <linux/ide.h>
#include <linux/delay.h>

static ide_startstop_t ide_ata_error(ide_drive_t *drive, struct request *rq,
				     u8 stat, u8 err)
{
	ide_hwif_t *hwif = drive->hwif;

	if ((stat & ATA_BUSY) ||
	    ((stat & ATA_DF) && (drive->dev_flags & IDE_DFLAG_NOWERR) == 0)) {
		/* other bits are useless when BUSY */
		rq->errors |= ERROR_RESET;
	} else if (stat & ATA_ERR) {
		/* err has different meaning on cdrom and tape */
		if (err == ATA_ABORTED) {
			if ((drive->dev_flags & IDE_DFLAG_LBA) &&
			    /* some newer drives don't support ATA_CMD_INIT_DEV_PARAMS */
			    hwif->tp_ops->read_status(hwif) == ATA_CMD_INIT_DEV_PARAMS)
				return ide_stopped;
		} else if ((err & BAD_CRC) == BAD_CRC) {
			/* UDMA crc error, just retry the operation */
			drive->crc_count++;
		} else if (err & (ATA_BBK | ATA_UNC)) {
			/* retries won't help these */
			rq->errors = ERROR_MAX;
		} else if (err & ATA_TRK0NF) {
			/* help it find track zero */
			rq->errors |= ERROR_RECAL;
		}
	}

	if ((stat & ATA_DRQ) && rq_data_dir(rq) == READ &&
	    (hwif->host_flags & IDE_HFLAG_ERROR_STOPS_FIFO) == 0) {
		int nsect = drive->mult_count ? drive->mult_count : 1;

		ide_pad_transfer(drive, READ, nsect * SECTOR_SIZE);
	}

	if (rq->errors >= ERROR_MAX || blk_noretry_request(rq)) {
		ide_kill_rq(drive, rq);
		return ide_stopped;
	}

	if (hwif->tp_ops->read_status(hwif) & (ATA_BUSY | ATA_DRQ))
		rq->errors |= ERROR_RESET;

	if ((rq->errors & ERROR_RESET) == ERROR_RESET) {
		++rq->errors;
		return ide_do_reset(drive);
	}

	if ((rq->errors & ERROR_RECAL) == ERROR_RECAL)
		drive->special_flags |= IDE_SFLAG_RECALIBRATE;

	++rq->errors;

	return ide_stopped;
}

static ide_startstop_t ide_atapi_error(ide_drive_t *drive, struct request *rq,
				       u8 stat, u8 err)
{
	ide_hwif_t *hwif = drive->hwif;

	if ((stat & ATA_BUSY) ||
	    ((stat & ATA_DF) && (drive->dev_flags & IDE_DFLAG_NOWERR) == 0)) {
		/* other bits are useless when BUSY */
		rq->errors |= ERROR_RESET;
	} else {
		/* add decoding error stuff */
	}

	if (hwif->tp_ops->read_status(hwif) & (ATA_BUSY | ATA_DRQ))
		/* force an abort */
		hwif->tp_ops->exec_command(hwif, ATA_CMD_IDLEIMMEDIATE);

	if (rq->errors >= ERROR_MAX) {
		ide_kill_rq(drive, rq);
	} else {
		if ((rq->errors & ERROR_RESET) == ERROR_RESET) {
			++rq->errors;
			return ide_do_reset(drive);
		}
		++rq->errors;
	}

	return ide_stopped;
}

static ide_startstop_t __ide_error(ide_drive_t *drive, struct request *rq,
				   u8 stat, u8 err)
{
	if (drive->media == ide_disk)
		return ide_ata_error(drive, rq, stat, err);
	return ide_atapi_error(drive, rq, stat, err);
}

/**
 *	ide_error	-	handle an error on the IDE
 *	@drive: drive the error occurred on
 *	@msg: message to report
 *	@stat: status bits
 *
 *	ide_error() takes action based on the error returned by the drive.
 *	For normal I/O that may well include retries. We deal with
 *	both new-style (taskfile) and old style command handling here.
 *	In the case of taskfile command handling there is work left to
 *	do
 */

ide_startstop_t ide_error(ide_drive_t *drive, const char *msg, u8 stat)
{
	struct request *rq;
	u8 err;

	err = ide_dump_status(drive, msg, stat);

	rq = drive->hwif->rq;
	if (rq == NULL)
		return ide_stopped;

	/* retry only "normal" I/O: */
	if (!blk_fs_request(rq)) {
		if (rq->cmd_type == REQ_TYPE_ATA_TASKFILE) {
			struct ide_cmd *cmd = rq->special;

			if (cmd)
				ide_complete_cmd(drive, cmd, stat, err);
		} else if (blk_pm_request(rq)) {
			rq->errors = 1;
			ide_complete_pm_rq(drive, rq);
			return ide_stopped;
		}
		rq->errors = err;
		ide_complete_rq(drive, err ? -EIO : 0, blk_rq_bytes(rq));
		return ide_stopped;
	}

	return __ide_error(drive, rq, stat, err);
}
EXPORT_SYMBOL_GPL(ide_error);

static inline void ide_complete_drive_reset(ide_drive_t *drive, int err)
{
	struct request *rq = drive->hwif->rq;

	if (rq && blk_special_request(rq) && rq->cmd[0] == REQ_DRIVE_RESET) {
		if (err <= 0 && rq->errors == 0)
			rq->errors = -EIO;
		ide_complete_rq(drive, err ? err : 0, blk_rq_bytes(rq));
	}
}

/* needed below */
static ide_startstop_t do_reset1(ide_drive_t *, int);

/*
 * atapi_reset_pollfunc() gets invoked to poll the interface for completion
 * every 50ms during an atapi drive reset operation.  If the drive has not yet
 * responded, and we have not yet hit our maximum waiting time, then the timer
 * is restarted for another 50ms.
 */
static ide_startstop_t atapi_reset_pollfunc(ide_drive_t *drive)
{
	ide_hwif_t *hwif = drive->hwif;
	const struct ide_tp_ops *tp_ops = hwif->tp_ops;
	u8 stat;

	tp_ops->dev_select(drive);
	udelay(10);
	stat = tp_ops->read_status(hwif);

	if (OK_STAT(stat, 0, ATA_BUSY))
		printk(KERN_INFO "%s: ATAPI reset complete\n", drive->name);
	else {
		if (time_before(jiffies, hwif->poll_timeout)) {
			ide_set_handler(drive, &atapi_reset_pollfunc, HZ/20);
			/* continue polling */
			return ide_started;
		}
		/* end of polling */
		hwif->polling = 0;
		printk(KERN_ERR "%s: ATAPI reset timed-out, status=0x%02x\n",
			drive->name, stat);
		/* do it the old fashioned way */
		return do_reset1(drive, 1);
	}
	/* done polling */
	hwif->polling = 0;
	ide_complete_drive_reset(drive, 0);
	return ide_stopped;
}

static void ide_reset_report_error(ide_hwif_t *hwif, u8 err)
{
	static const char *err_master_vals[] =
		{ NULL, "passed", "formatter device error",
		  "sector buffer error", "ECC circuitry error",
		  "controlling MPU error" };

	u8 err_master = err & 0x7f;

	printk(KERN_ERR "%s: reset: master: ", hwif->name);
	if (err_master && err_master < 6)
		printk(KERN_CONT "%s", err_master_vals[err_master]);
	else
		printk(KERN_CONT "error (0x%02x?)", err);
	if (err & 0x80)
		printk(KERN_CONT "; slave: failed");
	printk(KERN_CONT "\n");
}

/*
 * reset_pollfunc() gets invoked to poll the interface for completion every 50ms
 * during an ide reset operation. If the drives have not yet responded,
 * and we have not yet hit our maximum waiting time, then the timer is restarted
 * for another 50ms.
 */
static ide_startstop_t reset_pollfunc(ide_drive_t *drive)
{
	ide_hwif_t *hwif = drive->hwif;
	const struct ide_port_ops *port_ops = hwif->port_ops;
	u8 tmp;
	int err = 0;

	if (port_ops && port_ops->reset_poll) {
		err = port_ops->reset_poll(drive);
		if (err) {
			printk(KERN_ERR "%s: host reset_poll failure for %s.\n",
				hwif->name, drive->name);
			goto out;
		}
	}

	tmp = hwif->tp_ops->read_status(hwif);

	if (!OK_STAT(tmp, 0, ATA_BUSY)) {
		if (time_before(jiffies, hwif->poll_timeout)) {
			ide_set_handler(drive, &reset_pollfunc, HZ/20);
			/* continue polling */
			return ide_started;
		}
		printk(KERN_ERR "%s: reset timed-out, status=0x%02x\n",
			hwif->name, tmp);
		drive->failures++;
		err = -EIO;
	} else  {
		tmp = ide_read_error(drive);

		if (tmp == 1) {
			printk(KERN_INFO "%s: reset: success\n", hwif->name);
			drive->failures = 0;
		} else {
			ide_reset_report_error(hwif, tmp);
			drive->failures++;
			err = -EIO;
		}
	}
out:
	hwif->polling = 0;	/* done polling */
	ide_complete_drive_reset(drive, err);
	return ide_stopped;
}

static void ide_disk_pre_reset(ide_drive_t *drive)
{
	int legacy = (drive->id[ATA_ID_CFS_ENABLE_2] & 0x0400) ? 0 : 1;

	drive->special_flags =
		legacy ? (IDE_SFLAG_SET_GEOMETRY | IDE_SFLAG_RECALIBRATE) : 0;

	drive->mult_count = 0;
	drive->dev_flags &= ~IDE_DFLAG_PARKED;

	if ((drive->dev_flags & IDE_DFLAG_KEEP_SETTINGS) == 0 &&
	    (drive->dev_flags & IDE_DFLAG_USING_DMA) == 0)
		drive->mult_req = 0;

	if (drive->mult_req != drive->mult_count)
		drive->special_flags |= IDE_SFLAG_SET_MULTMODE;
}

static void pre_reset(ide_drive_t *drive)
{
	const struct ide_port_ops *port_ops = drive->hwif->port_ops;

	if (drive->media == ide_disk)
		ide_disk_pre_reset(drive);
	else
		drive->dev_flags |= IDE_DFLAG_POST_RESET;

	if (drive->dev_flags & IDE_DFLAG_USING_DMA) {
		if (drive->crc_count)
			ide_check_dma_crc(drive);
		else
			ide_dma_off(drive);
	}

	if ((drive->dev_flags & IDE_DFLAG_KEEP_SETTINGS) == 0) {
		if ((drive->dev_flags & IDE_DFLAG_USING_DMA) == 0) {
			drive->dev_flags &= ~IDE_DFLAG_UNMASK;
			drive->io_32bit = 0;
		}
		return;
	}

	if (port_ops && port_ops->pre_reset)
		port_ops->pre_reset(drive);

	if (drive->current_speed != 0xff)
		drive->desired_speed = drive->current_speed;
	drive->current_speed = 0xff;
}

/*
 * do_reset1() attempts to recover a confused drive by resetting it.
 * Unfortunately, resetting a disk drive actually resets all devices on
 * the same interface, so it can really be thought of as resetting the
 * interface rather than resetting the drive.
 *
 * ATAPI devices have their own reset mechanism which allows them to be
 * individually reset without clobbering other devices on the same interface.
 *
 * Unfortunately, the IDE interface does not generate an interrupt to let
 * us know when the reset operation has finished, so we must poll for this.
 * Equally poor, though, is the fact that this may a very long time to complete,
 * (up to 30 seconds worstcase).  So, instead of busy-waiting here for it,
 * we set a timer to poll at 50ms intervals.
 */
static ide_startstop_t do_reset1(ide_drive_t *drive, int do_not_try_atapi)
{
	ide_hwif_t *hwif = drive->hwif;
	struct ide_io_ports *io_ports = &hwif->io_ports;
	const struct ide_tp_ops *tp_ops = hwif->tp_ops;
	const struct ide_port_ops *port_ops;
	ide_drive_t *tdrive;
	unsigned long flags, timeout;
	int i;
	DEFINE_WAIT(wait);

	spin_lock_irqsave(&hwif->lock, flags);

	/* We must not reset with running handlers */
	BUG_ON(hwif->handler != NULL);

	/* For an ATAPI device, first try an ATAPI SRST. */
	if (drive->media != ide_disk && !do_not_try_atapi) {
		pre_reset(drive);
		tp_ops->dev_select(drive);
		udelay(20);
		tp_ops->exec_command(hwif, ATA_CMD_DEV_RESET);
		ndelay(400);
		hwif->poll_timeout = jiffies + WAIT_WORSTCASE;
		hwif->polling = 1;
		__ide_set_handler(drive, &atapi_reset_pollfunc, HZ/20);
		spin_unlock_irqrestore(&hwif->lock, flags);
		return ide_started;
	}

	/* We must not disturb devices in the IDE_DFLAG_PARKED state. */
	do {
		unsigned long now;

		prepare_to_wait(&ide_park_wq, &wait, TASK_UNINTERRUPTIBLE);
		timeout = jiffies;
		ide_port_for_each_present_dev(i, tdrive, hwif) {
			if ((tdrive->dev_flags & IDE_DFLAG_PARKED) &&
			    time_after(tdrive->sleep, timeout))
				timeout = tdrive->sleep;
		}

		now = jiffies;
		if (time_before_eq(timeout, now))
			break;

		spin_unlock_irqrestore(&hwif->lock, flags);
		timeout = schedule_timeout_uninterruptible(timeout - now);
		spin_lock_irqsave(&hwif->lock, flags);
	} while (timeout);
	finish_wait(&ide_park_wq, &wait);

	/*
	 * First, reset any device state data we were maintaining
	 * for any of the drives on this interface.
	 */
	ide_port_for_each_dev(i, tdrive, hwif)
		pre_reset(tdrive);

	if (io_ports->ctl_addr == 0) {
		spin_unlock_irqrestore(&hwif->lock, flags);
		ide_complete_drive_reset(drive, -ENXIO);
		return ide_stopped;
	}

	/*
	 * Note that we also set nIEN while resetting the device,
	 * to mask unwanted interrupts from the interface during the reset.
	 * However, due to the design of PC hardware, this will cause an
	 * immediate interrupt due to the edge transition it produces.
	 * This single interrupt gives us a "fast poll" for drives that
	 * recover from reset very quickly, saving us the first 50ms wait time.
	 */
	/* set SRST and nIEN */
	tp_ops->write_devctl(hwif, ATA_SRST | ATA_NIEN | ATA_DEVCTL_OBS);
	/* more than enough time */
	udelay(10);
	/* clear SRST, leave nIEN (unless device is on the quirk list) */
	tp_ops->write_devctl(hwif,
		((drive->dev_flags & IDE_DFLAG_NIEN_QUIRK) ? 0 : ATA_NIEN) |
		 ATA_DEVCTL_OBS);
	/* more than enough time */
	udelay(10);
	hwif->poll_timeout = jiffies + WAIT_WORSTCASE;
	hwif->polling = 1;
	__ide_set_handler(drive, &reset_pollfunc, HZ/20);

	/*
	 * Some weird controller like resetting themselves to a strange
	 * state when the disks are reset this way. At least, the Winbond
	 * 553 documentation says that
	 */
	port_ops = hwif->port_ops;
	if (port_ops && port_ops->resetproc)
		port_ops->resetproc(drive);

	spin_unlock_irqrestore(&hwif->lock, flags);
	return ide_started;
}

/*
 * ide_do_reset() is the entry point to the drive/interface reset code.
 */

ide_startstop_t ide_do_reset(ide_drive_t *drive)
{
	return do_reset1(drive, 0);
}
EXPORT_SYMBOL(ide_do_reset);
Commit	Line	Data
327fa1c2 BZ	1
	2	#include <linux/kernel.h>
	3	#include <linux/ide.h>
	4	#include <linux/delay.h>
	5
	6	static ide_startstop_t ide_ata_error(ide_drive_t drive, struct request rq,
	7	u8 stat, u8 err)
	8	{
	9	ide_hwif_t *hwif = drive->hwif;
	10
	11	if ((stat & ATA_BUSY) \|\|
	12	((stat & ATA_DF) && (drive->dev_flags & IDE_DFLAG_NOWERR) == 0)) {
	13	/* other bits are useless when BUSY */
	14	rq->errors \|= ERROR_RESET;
	15	} else if (stat & ATA_ERR) {
	16	/* err has different meaning on cdrom and tape */
	17	if (err == ATA_ABORTED) {
	18	if ((drive->dev_flags & IDE_DFLAG_LBA) &&
	19	/* some newer drives don't support ATA_CMD_INIT_DEV_PARAMS */
	20	hwif->tp_ops->read_status(hwif) == ATA_CMD_INIT_DEV_PARAMS)
	21	return ide_stopped;
	22	} else if ((err & BAD_CRC) == BAD_CRC) {
	23	/* UDMA crc error, just retry the operation */
	24	drive->crc_count++;
	25	} else if (err & (ATA_BBK \| ATA_UNC)) {
	26	/* retries won't help these */
	27	rq->errors = ERROR_MAX;
	28	} else if (err & ATA_TRK0NF) {
	29	/* help it find track zero */
	30	rq->errors \|= ERROR_RECAL;
	31	}
	32	}
	33
	34	if ((stat & ATA_DRQ) && rq_data_dir(rq) == READ &&
	35	(hwif->host_flags & IDE_HFLAG_ERROR_STOPS_FIFO) == 0) {
	36	int nsect = drive->mult_count ? drive->mult_count : 1;
	37
	38	ide_pad_transfer(drive, READ, nsect * SECTOR_SIZE);
	39	}
	40
	41	if (rq->errors >= ERROR_MAX \|\| blk_noretry_request(rq)) {
	42	ide_kill_rq(drive, rq);
	43	return ide_stopped;
	44	}
	45
	46	if (hwif->tp_ops->read_status(hwif) & (ATA_BUSY \| ATA_DRQ))
	47	rq->errors \|= ERROR_RESET;
	48
	49	if ((rq->errors & ERROR_RESET) == ERROR_RESET) {
	50	++rq->errors;
	51	return ide_do_reset(drive);
	52	}
	53
	54	if ((rq->errors & ERROR_RECAL) == ERROR_RECAL)
ca1b96e0	55	drive->special_flags \|= IDE_SFLAG_RECALIBRATE;
327fa1c2 BZ	56
	57	++rq->errors;
	58
	59	return ide_stopped;
	60	}
	61
	62	static ide_startstop_t ide_atapi_error(ide_drive_t drive, struct request rq,
	63	u8 stat, u8 err)
	64	{
	65	ide_hwif_t *hwif = drive->hwif;
	66
	67	if ((stat & ATA_BUSY) \|\|
	68	((stat & ATA_DF) && (drive->dev_flags & IDE_DFLAG_NOWERR) == 0)) {
	69	/* other bits are useless when BUSY */
	70	rq->errors \|= ERROR_RESET;
	71	} else {
	72	/* add decoding error stuff */
	73	}
	74
	75	if (hwif->tp_ops->read_status(hwif) & (ATA_BUSY \| ATA_DRQ))
	76	/* force an abort */
	77	hwif->tp_ops->exec_command(hwif, ATA_CMD_IDLEIMMEDIATE);
	78
	79	if (rq->errors >= ERROR_MAX) {
	80	ide_kill_rq(drive, rq);
	81	} else {
	82	if ((rq->errors & ERROR_RESET) == ERROR_RESET) {
	83	++rq->errors;
	84	return ide_do_reset(drive);
	85	}
	86	++rq->errors;
	87	}
	88
	89	return ide_stopped;
	90	}
	91
	92	static ide_startstop_t __ide_error(ide_drive_t drive, struct request rq,
	93	u8 stat, u8 err)
	94	{
	95	if (drive->media == ide_disk)
	96	return ide_ata_error(drive, rq, stat, err);
	97	return ide_atapi_error(drive, rq, stat, err);
	98	}
	99
	100	/**
	101	* ide_error - handle an error on the IDE
	102	* @drive: drive the error occurred on
	103	* @msg: message to report
	104	* @stat: status bits
	105	*
	106	* ide_error() takes action based on the error returned by the drive.
	107	* For normal I/O that may well include retries. We deal with
	108	* both new-style (taskfile) and old style command handling here.
	109	* In the case of taskfile command handling there is work left to
	110	* do
	111	*/
	112
	113	ide_startstop_t ide_error(ide_drive_t drive, const char msg, u8 stat)
	114	{
	115	struct request *rq;
	116	u8 err;
	117
	118	err = ide_dump_status(drive, msg, stat);
	119
120	rq = drive->hwif->rq;
121	if (rq == NULL)
122	return ide_stopped;
123
124	/* retry only "normal" I/O: */
125	if (!blk_fs_request(rq)) {
a09485df	126	if (rq->cmd_type == REQ_TYPE_ATA_TASKFILE) {
22aa4b32	127	struct ide_cmd *cmd = rq->special;
a09485df	128
22aa4b32 BZ	129	if (cmd)
22aa4b32 BZ	130	ide_complete_cmd(drive, cmd, stat, err);
a09485df	131	} else if (blk_pm_request(rq)) {
6902a533	132	rq->errors = 1;
a09485df BZ	133	ide_complete_pm_rq(drive, rq);
	134	return ide_stopped;
	135	}
6902a533	136	rq->errors = err;
f974b196	137	ide_complete_rq(drive, err ? -EIO : 0, blk_rq_bytes(rq));
327fa1c2 BZ	138	return ide_stopped;
	139	}
	140
	141	return __ide_error(drive, rq, stat, err);
	142	}
	143	EXPORT_SYMBOL_GPL(ide_error);
	144
	145	static inline void ide_complete_drive_reset(ide_drive_t *drive, int err)
	146	{
	147	struct request *rq = drive->hwif->rq;
	148
89f78b32 BZ	149	if (rq && blk_special_request(rq) && rq->cmd[0] == REQ_DRIVE_RESET) {
	150	if (err <= 0 && rq->errors == 0)
	151	rq->errors = -EIO;
5e955245	152	ide_complete_rq(drive, err ? err : 0, blk_rq_bytes(rq));
89f78b32	153	}
327fa1c2 BZ	154	}
	155
	156	/* needed below */
	157	static ide_startstop_t do_reset1(ide_drive_t *, int);
	158
	159	/*
	160	* atapi_reset_pollfunc() gets invoked to poll the interface for completion
	161	* every 50ms during an atapi drive reset operation. If the drive has not yet
	162	* responded, and we have not yet hit our maximum waiting time, then the timer
	163	* is restarted for another 50ms.
	164	*/
	165	static ide_startstop_t atapi_reset_pollfunc(ide_drive_t *drive)
	166	{
	167	ide_hwif_t *hwif = drive->hwif;
fdd88f0a	168	const struct ide_tp_ops *tp_ops = hwif->tp_ops;
327fa1c2 BZ	169	u8 stat;
327fa1c2 BZ	170
fdd88f0a	171	tp_ops->dev_select(drive);
327fa1c2	172	udelay(10);
fdd88f0a	173	stat = tp_ops->read_status(hwif);
327fa1c2 BZ	174
	175	if (OK_STAT(stat, 0, ATA_BUSY))
	176	printk(KERN_INFO "%s: ATAPI reset complete\n", drive->name);
	177	else {
	178	if (time_before(jiffies, hwif->poll_timeout)) {
60c0cd02	179	ide_set_handler(drive, &atapi_reset_pollfunc, HZ/20);
327fa1c2 BZ	180	/* continue polling */
	181	return ide_started;
	182	}
	183	/* end of polling */
	184	hwif->polling = 0;
	185	printk(KERN_ERR "%s: ATAPI reset timed-out, status=0x%02x\n",
	186	drive->name, stat);
	187	/* do it the old fashioned way */
	188	return do_reset1(drive, 1);
	189	}
	190	/* done polling */
	191	hwif->polling = 0;
	192	ide_complete_drive_reset(drive, 0);
	193	return ide_stopped;
	194	}
	195
	196	static void ide_reset_report_error(ide_hwif_t *hwif, u8 err)
	197	{
	198	static const char *err_master_vals[] =
	199	{ NULL, "passed", "formatter device error",
	200	"sector buffer error", "ECC circuitry error",
	201	"controlling MPU error" };
	202
	203	u8 err_master = err & 0x7f;
	204
	205	printk(KERN_ERR "%s: reset: master: ", hwif->name);
	206	if (err_master && err_master < 6)
	207	printk(KERN_CONT "%s", err_master_vals[err_master]);
	208	else
	209	printk(KERN_CONT "error (0x%02x?)", err);
	210	if (err & 0x80)
	211	printk(KERN_CONT "; slave: failed");
	212	printk(KERN_CONT "\n");
	213	}
	214
	215	/*
	216	* reset_pollfunc() gets invoked to poll the interface for completion every 50ms
	217	* during an ide reset operation. If the drives have not yet responded,
	218	* and we have not yet hit our maximum waiting time, then the timer is restarted
	219	* for another 50ms.
	220	*/
	221	static ide_startstop_t reset_pollfunc(ide_drive_t *drive)
	222	{
	223	ide_hwif_t *hwif = drive->hwif;
	224	const struct ide_port_ops *port_ops = hwif->port_ops;
	225	u8 tmp;
	226	int err = 0;
	227
	228	if (port_ops && port_ops->reset_poll) {
	229	err = port_ops->reset_poll(drive);
	230	if (err) {
	231	printk(KERN_ERR "%s: host reset_poll failure for %s.\n",
	232	hwif->name, drive->name);
	233	goto out;
	234	}
	235	}
	236
	237	tmp = hwif->tp_ops->read_status(hwif);
	238
	239	if (!OK_STAT(tmp, 0, ATA_BUSY)) {
	240	if (time_before(jiffies, hwif->poll_timeout)) {
60c0cd02	241	ide_set_handler(drive, &reset_pollfunc, HZ/20);
327fa1c2 BZ	242	/* continue polling */
	243	return ide_started;
	244	}
	245	printk(KERN_ERR "%s: reset timed-out, status=0x%02x\n",
	246	hwif->name, tmp);
	247	drive->failures++;
	248	err = -EIO;
	249	} else {
	250	tmp = ide_read_error(drive);
	251
	252	if (tmp == 1) {
	253	printk(KERN_INFO "%s: reset: success\n", hwif->name);
	254	drive->failures = 0;
	255	} else {
	256	ide_reset_report_error(hwif, tmp);
	257	drive->failures++;
	258	err = -EIO;
	259	}
	260	}
	261	out:
	262	hwif->polling = 0; /* done polling */
	263	ide_complete_drive_reset(drive, err);
	264	return ide_stopped;
	265	}
	266
	267	static void ide_disk_pre_reset(ide_drive_t *drive)
	268	{
	269	int legacy = (drive->id[ATA_ID_CFS_ENABLE_2] & 0x0400) ? 0 : 1;
	270
ca1b96e0 BZ	271	drive->special_flags =
ca1b96e0 BZ	272	legacy ? (IDE_SFLAG_SET_GEOMETRY \| IDE_SFLAG_RECALIBRATE) : 0;
327fa1c2 BZ	273
	274	drive->mult_count = 0;
	275	drive->dev_flags &= ~IDE_DFLAG_PARKED;
	276
	277	if ((drive->dev_flags & IDE_DFLAG_KEEP_SETTINGS) == 0 &&
	278	(drive->dev_flags & IDE_DFLAG_USING_DMA) == 0)
	279	drive->mult_req = 0;
	280
	281	if (drive->mult_req != drive->mult_count)
ca1b96e0	282	drive->special_flags \|= IDE_SFLAG_SET_MULTMODE;
327fa1c2 BZ	283	}
	284
	285	static void pre_reset(ide_drive_t *drive)
	286	{
	287	const struct ide_port_ops *port_ops = drive->hwif->port_ops;
	288
	289	if (drive->media == ide_disk)
	290	ide_disk_pre_reset(drive);
	291	else
	292	drive->dev_flags \|= IDE_DFLAG_POST_RESET;
	293
	294	if (drive->dev_flags & IDE_DFLAG_USING_DMA) {
	295	if (drive->crc_count)
	296	ide_check_dma_crc(drive);
	297	else
	298	ide_dma_off(drive);
	299	}
	300
	301	if ((drive->dev_flags & IDE_DFLAG_KEEP_SETTINGS) == 0) {
	302	if ((drive->dev_flags & IDE_DFLAG_USING_DMA) == 0) {
	303	drive->dev_flags &= ~IDE_DFLAG_UNMASK;
	304	drive->io_32bit = 0;
	305	}
	306	return;
	307	}
	308
	309	if (port_ops && port_ops->pre_reset)
	310	port_ops->pre_reset(drive);
	311
	312	if (drive->current_speed != 0xff)
	313	drive->desired_speed = drive->current_speed;
	314	drive->current_speed = 0xff;
	315	}
	316
	317	/*
	318	* do_reset1() attempts to recover a confused drive by resetting it.
	319	* Unfortunately, resetting a disk drive actually resets all devices on
	320	* the same interface, so it can really be thought of as resetting the
	321	* interface rather than resetting the drive.
	322	*
	323	* ATAPI devices have their own reset mechanism which allows them to be
	324	* individually reset without clobbering other devices on the same interface.
	325	*
	326	* Unfortunately, the IDE interface does not generate an interrupt to let
	327	* us know when the reset operation has finished, so we must poll for this.
	328	* Equally poor, though, is the fact that this may a very long time to complete,
	329	* (up to 30 seconds worstcase). So, instead of busy-waiting here for it,
	330	* we set a timer to poll at 50ms intervals.
	331	*/
	332	static ide_startstop_t do_reset1(ide_drive_t *drive, int do_not_try_atapi)
	333	{
	334	ide_hwif_t *hwif = drive->hwif;
	335	struct ide_io_ports *io_ports = &hwif->io_ports;
	336	const struct ide_tp_ops *tp_ops = hwif->tp_ops;
	337	const struct ide_port_ops *port_ops;
	338	ide_drive_t *tdrive;
	339	unsigned long flags, timeout;
	340	int i;
	341	DEFINE_WAIT(wait);
	342
	343	spin_lock_irqsave(&hwif->lock, flags);
	344
	345	/* We must not reset with running handlers */
	346	BUG_ON(hwif->handler != NULL);
347
348	/* For an ATAPI device, first try an ATAPI SRST. */
349	if (drive->media != ide_disk && !do_not_try_atapi) {
350	pre_reset(drive);
fdd88f0a	351	tp_ops->dev_select(drive);
327fa1c2 BZ	352	udelay(20);
	353	tp_ops->exec_command(hwif, ATA_CMD_DEV_RESET);
	354	ndelay(400);
	355	hwif->poll_timeout = jiffies + WAIT_WORSTCASE;
	356	hwif->polling = 1;
60c0cd02	357	__ide_set_handler(drive, &atapi_reset_pollfunc, HZ/20);
327fa1c2 BZ	358	spin_unlock_irqrestore(&hwif->lock, flags);
	359	return ide_started;
	360	}
	361
	362	/* We must not disturb devices in the IDE_DFLAG_PARKED state. */
	363	do {
	364	unsigned long now;
	365
	366	prepare_to_wait(&ide_park_wq, &wait, TASK_UNINTERRUPTIBLE);
	367	timeout = jiffies;
	368	ide_port_for_each_present_dev(i, tdrive, hwif) {
	369	if ((tdrive->dev_flags & IDE_DFLAG_PARKED) &&
	370	time_after(tdrive->sleep, timeout))
	371	timeout = tdrive->sleep;
	372	}
	373
	374	now = jiffies;
	375	if (time_before_eq(timeout, now))
	376	break;
	377
	378	spin_unlock_irqrestore(&hwif->lock, flags);
	379	timeout = schedule_timeout_uninterruptible(timeout - now);
	380	spin_lock_irqsave(&hwif->lock, flags);
	381	} while (timeout);
	382	finish_wait(&ide_park_wq, &wait);
	383
	384	/*
	385	* First, reset any device state data we were maintaining
	386	* for any of the drives on this interface.
	387	*/
	388	ide_port_for_each_dev(i, tdrive, hwif)
	389	pre_reset(tdrive);
	390
	391	if (io_ports->ctl_addr == 0) {
	392	spin_unlock_irqrestore(&hwif->lock, flags);
	393	ide_complete_drive_reset(drive, -ENXIO);
	394	return ide_stopped;
	395	}
	396
	397	/*
	398	* Note that we also set nIEN while resetting the device,
	399	* to mask unwanted interrupts from the interface during the reset.
	400	* However, due to the design of PC hardware, this will cause an
	401	* immediate interrupt due to the edge transition it produces.
	402	* This single interrupt gives us a "fast poll" for drives that
	403	* recover from reset very quickly, saving us the first 50ms wait time.
327fa1c2 BZ	404	*/
327fa1c2 BZ	405	/* set SRST and nIEN */
ecf3a31d	406	tp_ops->write_devctl(hwif, ATA_SRST \| ATA_NIEN \| ATA_DEVCTL_OBS);
327fa1c2 BZ	407	/* more than enough time */
	408	udelay(10);
	409	/* clear SRST, leave nIEN (unless device is on the quirk list) */
734affdc BZ	410	tp_ops->write_devctl(hwif,
	411	((drive->dev_flags & IDE_DFLAG_NIEN_QUIRK) ? 0 : ATA_NIEN) \|
	412	ATA_DEVCTL_OBS);
327fa1c2 BZ	413	/* more than enough time */
	414	udelay(10);
	415	hwif->poll_timeout = jiffies + WAIT_WORSTCASE;
	416	hwif->polling = 1;
60c0cd02	417	__ide_set_handler(drive, &reset_pollfunc, HZ/20);
327fa1c2 BZ	418
	419	/*
	420	* Some weird controller like resetting themselves to a strange
	421	* state when the disks are reset this way. At least, the Winbond
	422	* 553 documentation says that
	423	*/
	424	port_ops = hwif->port_ops;
	425	if (port_ops && port_ops->resetproc)
	426	port_ops->resetproc(drive);
	427
	428	spin_unlock_irqrestore(&hwif->lock, flags);
	429	return ide_started;
	430	}
	431
	432	/*
	433	* ide_do_reset() is the entry point to the drive/interface reset code.
	434	*/
	435
	436	ide_startstop_t ide_do_reset(ide_drive_t *drive)
	437	{
	438	return do_reset1(drive, 0);
	439	}
	440	EXPORT_SYMBOL(ide_do_reset);