[net-next-2.6.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 (rq->cmd_type != REQ_TYPE_FS) {
		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 && rq->cmd_type == REQ_TYPE_SPECIAL &&
	    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: */
33659ebb	125	if (rq->cmd_type != REQ_TYPE_FS) {
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
33659ebb CH	149	if (rq && rq->cmd_type == REQ_TYPE_SPECIAL &&
33659ebb CH	150	rq->cmd[0] == REQ_DRIVE_RESET) {
89f78b32 BZ	151	if (err <= 0 && rq->errors == 0)
89f78b32 BZ	152	rq->errors = -EIO;
5e955245	153	ide_complete_rq(drive, err ? err : 0, blk_rq_bytes(rq));
89f78b32	154	}
327fa1c2 BZ	155	}
	156
	157	/* needed below */
	158	static ide_startstop_t do_reset1(ide_drive_t *, int);
	159
	160	/*
	161	* atapi_reset_pollfunc() gets invoked to poll the interface for completion
	162	* every 50ms during an atapi drive reset operation. If the drive has not yet
	163	* responded, and we have not yet hit our maximum waiting time, then the timer
	164	* is restarted for another 50ms.
	165	*/
	166	static ide_startstop_t atapi_reset_pollfunc(ide_drive_t *drive)
	167	{
	168	ide_hwif_t *hwif = drive->hwif;
fdd88f0a	169	const struct ide_tp_ops *tp_ops = hwif->tp_ops;
327fa1c2 BZ	170	u8 stat;
327fa1c2 BZ	171
fdd88f0a	172	tp_ops->dev_select(drive);
327fa1c2	173	udelay(10);
fdd88f0a	174	stat = tp_ops->read_status(hwif);
327fa1c2 BZ	175
	176	if (OK_STAT(stat, 0, ATA_BUSY))
	177	printk(KERN_INFO "%s: ATAPI reset complete\n", drive->name);
	178	else {
	179	if (time_before(jiffies, hwif->poll_timeout)) {
60c0cd02	180	ide_set_handler(drive, &atapi_reset_pollfunc, HZ/20);
327fa1c2 BZ	181	/* continue polling */
	182	return ide_started;
	183	}
	184	/* end of polling */
	185	hwif->polling = 0;
	186	printk(KERN_ERR "%s: ATAPI reset timed-out, status=0x%02x\n",
	187	drive->name, stat);
	188	/* do it the old fashioned way */
	189	return do_reset1(drive, 1);
	190	}
	191	/* done polling */
	192	hwif->polling = 0;
	193	ide_complete_drive_reset(drive, 0);
	194	return ide_stopped;
	195	}
	196
	197	static void ide_reset_report_error(ide_hwif_t *hwif, u8 err)
	198	{
	199	static const char *err_master_vals[] =
	200	{ NULL, "passed", "formatter device error",
	201	"sector buffer error", "ECC circuitry error",
	202	"controlling MPU error" };
	203
	204	u8 err_master = err & 0x7f;
	205
	206	printk(KERN_ERR "%s: reset: master: ", hwif->name);
	207	if (err_master && err_master < 6)
	208	printk(KERN_CONT "%s", err_master_vals[err_master]);
	209	else
	210	printk(KERN_CONT "error (0x%02x?)", err);
	211	if (err & 0x80)
	212	printk(KERN_CONT "; slave: failed");
	213	printk(KERN_CONT "\n");
	214	}
	215
	216	/*
	217	* reset_pollfunc() gets invoked to poll the interface for completion every 50ms
	218	* during an ide reset operation. If the drives have not yet responded,
	219	* and we have not yet hit our maximum waiting time, then the timer is restarted
	220	* for another 50ms.
	221	*/
	222	static ide_startstop_t reset_pollfunc(ide_drive_t *drive)
	223	{
	224	ide_hwif_t *hwif = drive->hwif;
	225	const struct ide_port_ops *port_ops = hwif->port_ops;
	226	u8 tmp;
	227	int err = 0;
	228
	229	if (port_ops && port_ops->reset_poll) {
	230	err = port_ops->reset_poll(drive);
	231	if (err) {
	232	printk(KERN_ERR "%s: host reset_poll failure for %s.\n",
	233	hwif->name, drive->name);
	234	goto out;
	235	}
	236	}
	237
	238	tmp = hwif->tp_ops->read_status(hwif);
	239
	240	if (!OK_STAT(tmp, 0, ATA_BUSY)) {
	241	if (time_before(jiffies, hwif->poll_timeout)) {
60c0cd02	242	ide_set_handler(drive, &reset_pollfunc, HZ/20);
327fa1c2 BZ	243	/* continue polling */
	244	return ide_started;
	245	}
	246	printk(KERN_ERR "%s: reset timed-out, status=0x%02x\n",
	247	hwif->name, tmp);
	248	drive->failures++;
	249	err = -EIO;
	250	} else {
	251	tmp = ide_read_error(drive);
	252
	253	if (tmp == 1) {
	254	printk(KERN_INFO "%s: reset: success\n", hwif->name);
	255	drive->failures = 0;
	256	} else {
	257	ide_reset_report_error(hwif, tmp);
	258	drive->failures++;
	259	err = -EIO;
	260	}
	261	}
	262	out:
	263	hwif->polling = 0; /* done polling */
	264	ide_complete_drive_reset(drive, err);
	265	return ide_stopped;
	266	}
	267
	268	static void ide_disk_pre_reset(ide_drive_t *drive)
	269	{
	270	int legacy = (drive->id[ATA_ID_CFS_ENABLE_2] & 0x0400) ? 0 : 1;
	271
ca1b96e0 BZ	272	drive->special_flags =
ca1b96e0 BZ	273	legacy ? (IDE_SFLAG_SET_GEOMETRY \| IDE_SFLAG_RECALIBRATE) : 0;
327fa1c2 BZ	274
	275	drive->mult_count = 0;
	276	drive->dev_flags &= ~IDE_DFLAG_PARKED;
	277
	278	if ((drive->dev_flags & IDE_DFLAG_KEEP_SETTINGS) == 0 &&
	279	(drive->dev_flags & IDE_DFLAG_USING_DMA) == 0)
	280	drive->mult_req = 0;
	281
	282	if (drive->mult_req != drive->mult_count)
ca1b96e0	283	drive->special_flags \|= IDE_SFLAG_SET_MULTMODE;
327fa1c2 BZ	284	}
	285
	286	static void pre_reset(ide_drive_t *drive)
	287	{
	288	const struct ide_port_ops *port_ops = drive->hwif->port_ops;
	289
	290	if (drive->media == ide_disk)
	291	ide_disk_pre_reset(drive);
	292	else
	293	drive->dev_flags \|= IDE_DFLAG_POST_RESET;
	294
	295	if (drive->dev_flags & IDE_DFLAG_USING_DMA) {
	296	if (drive->crc_count)
	297	ide_check_dma_crc(drive);
	298	else
	299	ide_dma_off(drive);
	300	}
	301
	302	if ((drive->dev_flags & IDE_DFLAG_KEEP_SETTINGS) == 0) {
	303	if ((drive->dev_flags & IDE_DFLAG_USING_DMA) == 0) {
	304	drive->dev_flags &= ~IDE_DFLAG_UNMASK;
	305	drive->io_32bit = 0;
	306	}
	307	return;
	308	}
	309
	310	if (port_ops && port_ops->pre_reset)
	311	port_ops->pre_reset(drive);
	312
	313	if (drive->current_speed != 0xff)
	314	drive->desired_speed = drive->current_speed;
	315	drive->current_speed = 0xff;
	316	}
	317
	318	/*
	319	* do_reset1() attempts to recover a confused drive by resetting it.
	320	* Unfortunately, resetting a disk drive actually resets all devices on
	321	* the same interface, so it can really be thought of as resetting the
	322	* interface rather than resetting the drive.
	323	*
	324	* ATAPI devices have their own reset mechanism which allows them to be
	325	* individually reset without clobbering other devices on the same interface.
	326	*
	327	* Unfortunately, the IDE interface does not generate an interrupt to let
	328	* us know when the reset operation has finished, so we must poll for this.
	329	* Equally poor, though, is the fact that this may a very long time to complete,
	330	* (up to 30 seconds worstcase). So, instead of busy-waiting here for it,
	331	* we set a timer to poll at 50ms intervals.
	332	*/
	333	static ide_startstop_t do_reset1(ide_drive_t *drive, int do_not_try_atapi)
	334	{
	335	ide_hwif_t *hwif = drive->hwif;
	336	struct ide_io_ports *io_ports = &hwif->io_ports;
	337	const struct ide_tp_ops *tp_ops = hwif->tp_ops;
	338	const struct ide_port_ops *port_ops;
	339	ide_drive_t *tdrive;
	340	unsigned long flags, timeout;
	341	int i;
	342	DEFINE_WAIT(wait);
	343
	344	spin_lock_irqsave(&hwif->lock, flags);
	345
	346	/* We must not reset with running handlers */
	347	BUG_ON(hwif->handler != NULL);
348
349	/* For an ATAPI device, first try an ATAPI SRST. */
350	if (drive->media != ide_disk && !do_not_try_atapi) {
351	pre_reset(drive);
fdd88f0a	352	tp_ops->dev_select(drive);
327fa1c2 BZ	353	udelay(20);
	354	tp_ops->exec_command(hwif, ATA_CMD_DEV_RESET);
	355	ndelay(400);
	356	hwif->poll_timeout = jiffies + WAIT_WORSTCASE;
	357	hwif->polling = 1;
60c0cd02	358	__ide_set_handler(drive, &atapi_reset_pollfunc, HZ/20);
327fa1c2 BZ	359	spin_unlock_irqrestore(&hwif->lock, flags);
	360	return ide_started;
	361	}
	362
	363	/* We must not disturb devices in the IDE_DFLAG_PARKED state. */
	364	do {
	365	unsigned long now;
	366
	367	prepare_to_wait(&ide_park_wq, &wait, TASK_UNINTERRUPTIBLE);
	368	timeout = jiffies;
	369	ide_port_for_each_present_dev(i, tdrive, hwif) {
	370	if ((tdrive->dev_flags & IDE_DFLAG_PARKED) &&
	371	time_after(tdrive->sleep, timeout))
	372	timeout = tdrive->sleep;
	373	}
	374
	375	now = jiffies;
	376	if (time_before_eq(timeout, now))
	377	break;
	378
	379	spin_unlock_irqrestore(&hwif->lock, flags);
	380	timeout = schedule_timeout_uninterruptible(timeout - now);
	381	spin_lock_irqsave(&hwif->lock, flags);
	382	} while (timeout);
	383	finish_wait(&ide_park_wq, &wait);
	384
	385	/*
	386	* First, reset any device state data we were maintaining
	387	* for any of the drives on this interface.
	388	*/
	389	ide_port_for_each_dev(i, tdrive, hwif)
	390	pre_reset(tdrive);
	391
	392	if (io_ports->ctl_addr == 0) {
	393	spin_unlock_irqrestore(&hwif->lock, flags);
	394	ide_complete_drive_reset(drive, -ENXIO);
	395	return ide_stopped;
	396	}
	397
	398	/*
	399	* Note that we also set nIEN while resetting the device,
	400	* to mask unwanted interrupts from the interface during the reset.
	401	* However, due to the design of PC hardware, this will cause an
	402	* immediate interrupt due to the edge transition it produces.
	403	* This single interrupt gives us a "fast poll" for drives that
	404	* recover from reset very quickly, saving us the first 50ms wait time.
327fa1c2 BZ	405	*/
327fa1c2 BZ	406	/* set SRST and nIEN */
ecf3a31d	407	tp_ops->write_devctl(hwif, ATA_SRST \| ATA_NIEN \| ATA_DEVCTL_OBS);
327fa1c2 BZ	408	/* more than enough time */
	409	udelay(10);
	410	/* clear SRST, leave nIEN (unless device is on the quirk list) */
734affdc BZ	411	tp_ops->write_devctl(hwif,
	412	((drive->dev_flags & IDE_DFLAG_NIEN_QUIRK) ? 0 : ATA_NIEN) \|
	413	ATA_DEVCTL_OBS);
327fa1c2 BZ	414	/* more than enough time */
	415	udelay(10);
	416	hwif->poll_timeout = jiffies + WAIT_WORSTCASE;
	417	hwif->polling = 1;
60c0cd02	418	__ide_set_handler(drive, &reset_pollfunc, HZ/20);
327fa1c2 BZ	419
	420	/*
	421	* Some weird controller like resetting themselves to a strange
	422	* state when the disks are reset this way. At least, the Winbond
	423	* 553 documentation says that
	424	*/
	425	port_ops = hwif->port_ops;
	426	if (port_ops && port_ops->resetproc)
	427	port_ops->resetproc(drive);
	428
	429	spin_unlock_irqrestore(&hwif->lock, flags);
	430	return ide_started;
	431	}
	432
	433	/*
	434	* ide_do_reset() is the entry point to the drive/interface reset code.
	435	*/
	436
	437	ide_startstop_t ide_do_reset(ide_drive_t *drive)
	438	{
	439	return do_reset1(drive, 0);
	440	}
	441	EXPORT_SYMBOL(ide_do_reset);