[mirror_ubuntu-hirsute-kernel.git] / drivers / ide / ide-eh.c

// SPDX-License-Identifier: GPL-2.0-only

#include <linux/kernel.h>
#include <linux/export.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 */
		scsi_req(rq)->result |= 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 */
			scsi_req(rq)->result = ERROR_MAX;
		} else if (err & ATA_TRK0NF) {
			/* help it find track zero */
			scsi_req(rq)->result |= 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 (scsi_req(rq)->result >= 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))
		scsi_req(rq)->result |= ERROR_RESET;

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

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

	++scsi_req(rq)->result;

	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 */
		scsi_req(rq)->result |= 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 (scsi_req(rq)->result >= ERROR_MAX) {
		ide_kill_rq(drive, rq);
	} else {
		if ((scsi_req(rq)->result & ERROR_RESET) == ERROR_RESET) {
			++scsi_req(rq)->result;
			return ide_do_reset(drive);
		}
		++scsi_req(rq)->result;
	}

	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_rq_is_passthrough(rq)) {
		if (ata_taskfile_request(rq)) {
			struct ide_cmd *cmd = ide_req(rq)->special;

			if (cmd)
				ide_complete_cmd(drive, cmd, stat, err);
		} else if (ata_pm_request(rq)) {
			scsi_req(rq)->result = 1;
			ide_complete_pm_rq(drive, rq);
			return ide_stopped;
		}
		scsi_req(rq)->result = err;
		ide_complete_rq(drive, err ? BLK_STS_IOERR : BLK_STS_OK, 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, blk_status_t err)
{
	struct request *rq = drive->hwif->rq;

	if (rq && ata_misc_request(rq) &&
	    scsi_req(rq)->cmd[0] == REQ_DRIVE_RESET) {
		if (err <= 0 && scsi_req(rq)->result == 0)
			scsi_req(rq)->result = -EIO;
		ide_complete_rq(drive, err, 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, BLK_STS_OK);
	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;
	blk_status_t err = BLK_STS_OK;

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