[deliverable/linux.git] / drivers / ide / ide-io-std.c


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

#if defined(CONFIG_ARM) || defined(CONFIG_M68K) || defined(CONFIG_MIPS) || \
    defined(CONFIG_PARISC) || defined(CONFIG_PPC) || defined(CONFIG_SPARC)
#include <asm/ide.h>
#else
#include <asm-generic/ide_iops.h>
#endif

/*
 *	Conventional PIO operations for ATA devices
 */

static u8 ide_inb(unsigned long port)
{
	return (u8) inb(port);
}

static void ide_outb(u8 val, unsigned long port)
{
	outb(val, port);
}

/*
 *	MMIO operations, typically used for SATA controllers
 */

static u8 ide_mm_inb(unsigned long port)
{
	return (u8) readb((void __iomem *) port);
}

static void ide_mm_outb(u8 value, unsigned long port)
{
	writeb(value, (void __iomem *) port);
}

void ide_exec_command(ide_hwif_t *hwif, u8 cmd)
{
	if (hwif->host_flags & IDE_HFLAG_MMIO)
		writeb(cmd, (void __iomem *)hwif->io_ports.command_addr);
	else
		outb(cmd, hwif->io_ports.command_addr);
}
EXPORT_SYMBOL_GPL(ide_exec_command);

u8 ide_read_status(ide_hwif_t *hwif)
{
	if (hwif->host_flags & IDE_HFLAG_MMIO)
		return readb((void __iomem *)hwif->io_ports.status_addr);
	else
		return inb(hwif->io_ports.status_addr);
}
EXPORT_SYMBOL_GPL(ide_read_status);

u8 ide_read_altstatus(ide_hwif_t *hwif)
{
	if (hwif->host_flags & IDE_HFLAG_MMIO)
		return readb((void __iomem *)hwif->io_ports.ctl_addr);
	else
		return inb(hwif->io_ports.ctl_addr);
}
EXPORT_SYMBOL_GPL(ide_read_altstatus);

void ide_write_devctl(ide_hwif_t *hwif, u8 ctl)
{
	if (hwif->host_flags & IDE_HFLAG_MMIO)
		writeb(ctl, (void __iomem *)hwif->io_ports.ctl_addr);
	else
		outb(ctl, hwif->io_ports.ctl_addr);
}
EXPORT_SYMBOL_GPL(ide_write_devctl);

void ide_tf_load(ide_drive_t *drive, struct ide_cmd *cmd)
{
	ide_hwif_t *hwif = drive->hwif;
	struct ide_io_ports *io_ports = &hwif->io_ports;
	struct ide_taskfile *tf = &cmd->tf;
	void (*tf_outb)(u8 addr, unsigned long port);
	u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
	u8 HIHI = (cmd->tf_flags & IDE_TFLAG_LBA48) ? 0xE0 : 0xEF;

	if (mmio)
		tf_outb = ide_mm_outb;
	else
		tf_outb = ide_outb;

	if (cmd->ftf_flags & IDE_FTFLAG_FLAGGED)
		HIHI = 0xFF;

	if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_FEATURE)
		tf_outb(tf->hob_feature, io_ports->feature_addr);
	if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_NSECT)
		tf_outb(tf->hob_nsect, io_ports->nsect_addr);
	if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAL)
		tf_outb(tf->hob_lbal, io_ports->lbal_addr);
	if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAM)
		tf_outb(tf->hob_lbam, io_ports->lbam_addr);
	if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAH)
		tf_outb(tf->hob_lbah, io_ports->lbah_addr);

	if (cmd->tf_flags & IDE_TFLAG_OUT_FEATURE)
		tf_outb(tf->feature, io_ports->feature_addr);
	if (cmd->tf_flags & IDE_TFLAG_OUT_NSECT)
		tf_outb(tf->nsect, io_ports->nsect_addr);
	if (cmd->tf_flags & IDE_TFLAG_OUT_LBAL)
		tf_outb(tf->lbal, io_ports->lbal_addr);
	if (cmd->tf_flags & IDE_TFLAG_OUT_LBAM)
		tf_outb(tf->lbam, io_ports->lbam_addr);
	if (cmd->tf_flags & IDE_TFLAG_OUT_LBAH)
		tf_outb(tf->lbah, io_ports->lbah_addr);

	if (cmd->tf_flags & IDE_TFLAG_OUT_DEVICE)
		tf_outb((tf->device & HIHI) | drive->select,
			 io_ports->device_addr);
}
EXPORT_SYMBOL_GPL(ide_tf_load);

void ide_tf_read(ide_drive_t *drive, struct ide_cmd *cmd)
{
	ide_hwif_t *hwif = drive->hwif;
	struct ide_io_ports *io_ports = &hwif->io_ports;
	struct ide_taskfile *tf = &cmd->tf;
	void (*tf_outb)(u8 addr, unsigned long port);
	u8 (*tf_inb)(unsigned long port);
	u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;

	if (mmio) {
		tf_outb = ide_mm_outb;
		tf_inb  = ide_mm_inb;
	} else {
		tf_outb = ide_outb;
		tf_inb  = ide_inb;
	}

	/* be sure we're looking at the low order bits */
	tf_outb(ATA_DEVCTL_OBS, io_ports->ctl_addr);

	if (cmd->tf_flags & IDE_TFLAG_IN_ERROR)
		tf->error  = tf_inb(io_ports->feature_addr);
	if (cmd->tf_flags & IDE_TFLAG_IN_NSECT)
		tf->nsect  = tf_inb(io_ports->nsect_addr);
	if (cmd->tf_flags & IDE_TFLAG_IN_LBAL)
		tf->lbal   = tf_inb(io_ports->lbal_addr);
	if (cmd->tf_flags & IDE_TFLAG_IN_LBAM)
		tf->lbam   = tf_inb(io_ports->lbam_addr);
	if (cmd->tf_flags & IDE_TFLAG_IN_LBAH)
		tf->lbah   = tf_inb(io_ports->lbah_addr);
	if (cmd->tf_flags & IDE_TFLAG_IN_DEVICE)
		tf->device = tf_inb(io_ports->device_addr);

	if (cmd->tf_flags & IDE_TFLAG_LBA48) {
		tf_outb(ATA_HOB | ATA_DEVCTL_OBS, io_ports->ctl_addr);

		if (cmd->tf_flags & IDE_TFLAG_IN_HOB_ERROR)
			tf->hob_error = tf_inb(io_ports->feature_addr);
		if (cmd->tf_flags & IDE_TFLAG_IN_HOB_NSECT)
			tf->hob_nsect = tf_inb(io_ports->nsect_addr);
		if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAL)
			tf->hob_lbal  = tf_inb(io_ports->lbal_addr);
		if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAM)
			tf->hob_lbam  = tf_inb(io_ports->lbam_addr);
		if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAH)
			tf->hob_lbah  = tf_inb(io_ports->lbah_addr);
	}
}
EXPORT_SYMBOL_GPL(ide_tf_read);

/*
 * Some localbus EIDE interfaces require a special access sequence
 * when using 32-bit I/O instructions to transfer data.  We call this
 * the "vlb_sync" sequence, which consists of three successive reads
 * of the sector count register location, with interrupts disabled
 * to ensure that the reads all happen together.
 */
static void ata_vlb_sync(unsigned long port)
{
	(void)inb(port);
	(void)inb(port);
	(void)inb(port);
}

/*
 * This is used for most PIO data transfers *from* the IDE interface
 *
 * These routines will round up any request for an odd number of bytes,
 * so if an odd len is specified, be sure that there's at least one
 * extra byte allocated for the buffer.
 */
void ide_input_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf,
		    unsigned int len)
{
	ide_hwif_t *hwif = drive->hwif;
	struct ide_io_ports *io_ports = &hwif->io_ports;
	unsigned long data_addr = io_ports->data_addr;
	unsigned int words = (len + 1) >> 1;
	u8 io_32bit = drive->io_32bit;
	u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;

	if (io_32bit) {
		unsigned long uninitialized_var(flags);

		if ((io_32bit & 2) && !mmio) {
			local_irq_save(flags);
			ata_vlb_sync(io_ports->nsect_addr);
		}

		words >>= 1;
		if (mmio)
			__ide_mm_insl((void __iomem *)data_addr, buf, words);
		else
			insl(data_addr, buf, words);

		if ((io_32bit & 2) && !mmio)
			local_irq_restore(flags);

		if (((len + 1) & 3) < 2)
			return;

		buf += len & ~3;
		words = 1;
	}

	if (mmio)
		__ide_mm_insw((void __iomem *)data_addr, buf, words);
	else
		insw(data_addr, buf, words);
}
EXPORT_SYMBOL_GPL(ide_input_data);

/*
 * This is used for most PIO data transfers *to* the IDE interface
 */
void ide_output_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf,
		     unsigned int len)
{
	ide_hwif_t *hwif = drive->hwif;
	struct ide_io_ports *io_ports = &hwif->io_ports;
	unsigned long data_addr = io_ports->data_addr;
	unsigned int words = (len + 1) >> 1;
	u8 io_32bit = drive->io_32bit;
	u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;

	if (io_32bit) {
		unsigned long uninitialized_var(flags);

		if ((io_32bit & 2) && !mmio) {
			local_irq_save(flags);
			ata_vlb_sync(io_ports->nsect_addr);
		}

		words >>= 1;
		if (mmio)
			__ide_mm_outsl((void __iomem *)data_addr, buf, words);
		else
			outsl(data_addr, buf, words);

		if ((io_32bit & 2) && !mmio)
			local_irq_restore(flags);

		if (((len + 1) & 3) < 2)
			return;

		buf += len & ~3;
		words = 1;
	}

	if (mmio)
		__ide_mm_outsw((void __iomem *)data_addr, buf, words);
	else
		outsw(data_addr, buf, words);
}
EXPORT_SYMBOL_GPL(ide_output_data);

const struct ide_tp_ops default_tp_ops = {
	.exec_command		= ide_exec_command,
	.read_status		= ide_read_status,
	.read_altstatus		= ide_read_altstatus,
	.write_devctl		= ide_write_devctl,

	.tf_load		= ide_tf_load,
	.tf_read		= ide_tf_read,

	.input_data		= ide_input_data,
	.output_data		= ide_output_data,
};
Commit	Line	Data
	1
	2	#include <linux/kernel.h>
	3	#include <linux/ide.h>
	4
	5	#if defined(CONFIG_ARM) \|\| defined(CONFIG_M68K) \|\| defined(CONFIG_MIPS) \|\| \
	6	defined(CONFIG_PARISC) \|\| defined(CONFIG_PPC) \|\| defined(CONFIG_SPARC)
	7	#include <asm/ide.h>
	8	#else
	9	#include <asm-generic/ide_iops.h>
	10	#endif
	11
	12	/*
	13	* Conventional PIO operations for ATA devices
	14	*/
	15
	16	static u8 ide_inb(unsigned long port)
	17	{
	18	return (u8) inb(port);
	19	}
	20
	21	static void ide_outb(u8 val, unsigned long port)
	22	{
	23	outb(val, port);
	24	}
	25
	26	/*
	27	* MMIO operations, typically used for SATA controllers
	28	*/
	29
	30	static u8 ide_mm_inb(unsigned long port)
	31	{
	32	return (u8) readb((void __iomem *) port);
	33	}
	34
	35	static void ide_mm_outb(u8 value, unsigned long port)
	36	{
	37	writeb(value, (void __iomem *) port);
	38	}
	39
	40	void ide_exec_command(ide_hwif_t *hwif, u8 cmd)
	41	{
	42	if (hwif->host_flags & IDE_HFLAG_MMIO)
	43	writeb(cmd, (void __iomem *)hwif->io_ports.command_addr);
	44	else
	45	outb(cmd, hwif->io_ports.command_addr);
	46	}
	47	EXPORT_SYMBOL_GPL(ide_exec_command);
	48
	49	u8 ide_read_status(ide_hwif_t *hwif)
	50	{
	51	if (hwif->host_flags & IDE_HFLAG_MMIO)
	52	return readb((void __iomem *)hwif->io_ports.status_addr);
	53	else
	54	return inb(hwif->io_ports.status_addr);
	55	}
	56	EXPORT_SYMBOL_GPL(ide_read_status);
	57
	58	u8 ide_read_altstatus(ide_hwif_t *hwif)
	59	{
	60	if (hwif->host_flags & IDE_HFLAG_MMIO)
	61	return readb((void __iomem *)hwif->io_ports.ctl_addr);
	62	else
	63	return inb(hwif->io_ports.ctl_addr);
	64	}
	65	EXPORT_SYMBOL_GPL(ide_read_altstatus);
	66
	67	void ide_write_devctl(ide_hwif_t *hwif, u8 ctl)
	68	{
	69	if (hwif->host_flags & IDE_HFLAG_MMIO)
	70	writeb(ctl, (void __iomem *)hwif->io_ports.ctl_addr);
	71	else
	72	outb(ctl, hwif->io_ports.ctl_addr);
	73	}
	74	EXPORT_SYMBOL_GPL(ide_write_devctl);
	75
	76	void ide_tf_load(ide_drive_t drive, struct ide_cmd cmd)
	77	{
	78	ide_hwif_t *hwif = drive->hwif;
	79	struct ide_io_ports *io_ports = &hwif->io_ports;
	80	struct ide_taskfile *tf = &cmd->tf;
	81	void (*tf_outb)(u8 addr, unsigned long port);
	82	u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
	83	u8 HIHI = (cmd->tf_flags & IDE_TFLAG_LBA48) ? 0xE0 : 0xEF;
	84
	85	if (mmio)
	86	tf_outb = ide_mm_outb;
	87	else
	88	tf_outb = ide_outb;
	89
	90	if (cmd->ftf_flags & IDE_FTFLAG_FLAGGED)
	91	HIHI = 0xFF;
	92
	93	if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_FEATURE)
	94	tf_outb(tf->hob_feature, io_ports->feature_addr);
	95	if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_NSECT)
	96	tf_outb(tf->hob_nsect, io_ports->nsect_addr);
	97	if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAL)
	98	tf_outb(tf->hob_lbal, io_ports->lbal_addr);
	99	if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAM)
	100	tf_outb(tf->hob_lbam, io_ports->lbam_addr);
	101	if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAH)
	102	tf_outb(tf->hob_lbah, io_ports->lbah_addr);
	103
	104	if (cmd->tf_flags & IDE_TFLAG_OUT_FEATURE)
	105	tf_outb(tf->feature, io_ports->feature_addr);
	106	if (cmd->tf_flags & IDE_TFLAG_OUT_NSECT)
	107	tf_outb(tf->nsect, io_ports->nsect_addr);
	108	if (cmd->tf_flags & IDE_TFLAG_OUT_LBAL)
	109	tf_outb(tf->lbal, io_ports->lbal_addr);
	110	if (cmd->tf_flags & IDE_TFLAG_OUT_LBAM)
	111	tf_outb(tf->lbam, io_ports->lbam_addr);
	112	if (cmd->tf_flags & IDE_TFLAG_OUT_LBAH)
	113	tf_outb(tf->lbah, io_ports->lbah_addr);
	114
	115	if (cmd->tf_flags & IDE_TFLAG_OUT_DEVICE)
	116	tf_outb((tf->device & HIHI) \| drive->select,
	117	io_ports->device_addr);
	118	}
	119	EXPORT_SYMBOL_GPL(ide_tf_load);
	120
	121	void ide_tf_read(ide_drive_t drive, struct ide_cmd cmd)
	122	{
	123	ide_hwif_t *hwif = drive->hwif;
	124	struct ide_io_ports *io_ports = &hwif->io_ports;
	125	struct ide_taskfile *tf = &cmd->tf;
	126	void (*tf_outb)(u8 addr, unsigned long port);
	127	u8 (*tf_inb)(unsigned long port);
	128	u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
	129
	130	if (mmio) {
	131	tf_outb = ide_mm_outb;
	132	tf_inb = ide_mm_inb;
	133	} else {
	134	tf_outb = ide_outb;
	135	tf_inb = ide_inb;
	136	}
	137
	138	/* be sure we're looking at the low order bits */
	139	tf_outb(ATA_DEVCTL_OBS, io_ports->ctl_addr);
	140
	141	if (cmd->tf_flags & IDE_TFLAG_IN_ERROR)
	142	tf->error = tf_inb(io_ports->feature_addr);
	143	if (cmd->tf_flags & IDE_TFLAG_IN_NSECT)
	144	tf->nsect = tf_inb(io_ports->nsect_addr);
	145	if (cmd->tf_flags & IDE_TFLAG_IN_LBAL)
	146	tf->lbal = tf_inb(io_ports->lbal_addr);
	147	if (cmd->tf_flags & IDE_TFLAG_IN_LBAM)
	148	tf->lbam = tf_inb(io_ports->lbam_addr);
	149	if (cmd->tf_flags & IDE_TFLAG_IN_LBAH)
	150	tf->lbah = tf_inb(io_ports->lbah_addr);
	151	if (cmd->tf_flags & IDE_TFLAG_IN_DEVICE)
	152	tf->device = tf_inb(io_ports->device_addr);
	153
	154	if (cmd->tf_flags & IDE_TFLAG_LBA48) {
	155	tf_outb(ATA_HOB \| ATA_DEVCTL_OBS, io_ports->ctl_addr);
	156
	157	if (cmd->tf_flags & IDE_TFLAG_IN_HOB_ERROR)
	158	tf->hob_error = tf_inb(io_ports->feature_addr);
	159	if (cmd->tf_flags & IDE_TFLAG_IN_HOB_NSECT)
	160	tf->hob_nsect = tf_inb(io_ports->nsect_addr);
	161	if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAL)
	162	tf->hob_lbal = tf_inb(io_ports->lbal_addr);
	163	if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAM)
	164	tf->hob_lbam = tf_inb(io_ports->lbam_addr);
	165	if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAH)
	166	tf->hob_lbah = tf_inb(io_ports->lbah_addr);
	167	}
	168	}
	169	EXPORT_SYMBOL_GPL(ide_tf_read);
	170
	171	/*
	172	* Some localbus EIDE interfaces require a special access sequence
	173	* when using 32-bit I/O instructions to transfer data. We call this
	174	* the "vlb_sync" sequence, which consists of three successive reads
	175	* of the sector count register location, with interrupts disabled
	176	* to ensure that the reads all happen together.
	177	*/
	178	static void ata_vlb_sync(unsigned long port)
	179	{
	180	(void)inb(port);
	181	(void)inb(port);
	182	(void)inb(port);
	183	}
	184
	185	/*
	186	* This is used for most PIO data transfers from the IDE interface
	187	*
	188	* These routines will round up any request for an odd number of bytes,
	189	* so if an odd len is specified, be sure that there's at least one
	190	* extra byte allocated for the buffer.
	191	*/
	192	void ide_input_data(ide_drive_t drive, struct ide_cmd cmd, void *buf,
	193	unsigned int len)
	194	{
	195	ide_hwif_t *hwif = drive->hwif;
	196	struct ide_io_ports *io_ports = &hwif->io_ports;
	197	unsigned long data_addr = io_ports->data_addr;
	198	unsigned int words = (len + 1) >> 1;
	199	u8 io_32bit = drive->io_32bit;
	200	u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
	201
	202	if (io_32bit) {
	203	unsigned long uninitialized_var(flags);
	204
	205	if ((io_32bit & 2) && !mmio) {
	206	local_irq_save(flags);
	207	ata_vlb_sync(io_ports->nsect_addr);
	208	}
	209
	210	words >>= 1;
	211	if (mmio)
	212	__ide_mm_insl((void __iomem *)data_addr, buf, words);
	213	else
	214	insl(data_addr, buf, words);
	215
	216	if ((io_32bit & 2) && !mmio)
	217	local_irq_restore(flags);
	218
	219	if (((len + 1) & 3) < 2)
	220	return;
	221
	222	buf += len & ~3;
	223	words = 1;
	224	}
	225
	226	if (mmio)
	227	__ide_mm_insw((void __iomem *)data_addr, buf, words);
	228	else
	229	insw(data_addr, buf, words);
	230	}
	231	EXPORT_SYMBOL_GPL(ide_input_data);
	232
	233	/*
	234	* This is used for most PIO data transfers to the IDE interface
	235	*/
	236	void ide_output_data(ide_drive_t drive, struct ide_cmd cmd, void *buf,
	237	unsigned int len)
	238	{
	239	ide_hwif_t *hwif = drive->hwif;
	240	struct ide_io_ports *io_ports = &hwif->io_ports;
	241	unsigned long data_addr = io_ports->data_addr;
	242	unsigned int words = (len + 1) >> 1;
	243	u8 io_32bit = drive->io_32bit;
	244	u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
	245
	246	if (io_32bit) {
	247	unsigned long uninitialized_var(flags);
	248
	249	if ((io_32bit & 2) && !mmio) {
	250	local_irq_save(flags);
	251	ata_vlb_sync(io_ports->nsect_addr);
	252	}
	253
	254	words >>= 1;
	255	if (mmio)
	256	__ide_mm_outsl((void __iomem *)data_addr, buf, words);
	257	else
	258	outsl(data_addr, buf, words);
	259
	260	if ((io_32bit & 2) && !mmio)
	261	local_irq_restore(flags);
	262
	263	if (((len + 1) & 3) < 2)
	264	return;
	265
	266	buf += len & ~3;
	267	words = 1;
	268	}
	269
	270	if (mmio)
	271	__ide_mm_outsw((void __iomem *)data_addr, buf, words);
	272	else
	273	outsw(data_addr, buf, words);
	274	}
	275	EXPORT_SYMBOL_GPL(ide_output_data);
	276
	277	const struct ide_tp_ops default_tp_ops = {
	278	.exec_command = ide_exec_command,
	279	.read_status = ide_read_status,
	280	.read_altstatus = ide_read_altstatus,
	281	.write_devctl = ide_write_devctl,
	282
	283	.tf_load = ide_tf_load,
	284	.tf_read = ide_tf_read,
	285
	286	.input_data = ide_input_data,
	287	.output_data = ide_output_data,
	288	};