[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / ata / pata_ns87415.c

/*
 *    pata_ns87415.c - NS87415 (non PARISC) PATA
 *
 *	(C) 2005 Red Hat <alan@lxorguk.ukuu.org.uk>
 *
 *    This is a fairly generic MWDMA controller. It has some limitations
 *    as it requires timing reloads on PIO/DMA transitions but it is otherwise
 *    fairly well designed.
 *
 *    This driver assumes the firmware has left the chip in a valid ST506
 *    compliant state, either legacy IRQ 14/15 or native INTA shared. You
 *    may need to add platform code if your system fails to do this.
 *
 *    The same cell appears in the 87560 controller used by some PARISC
 *    systems. This has its own special mountain of errata.
 *
 *    TODO:
 *	Test PARISC SuperIO
 *	Get someone to test on SPARC
 *	Implement lazy pio/dma switching for better performance
 *	8bit shared timing.
 *	See if we need to kill the FIFO for ATAPI
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/init.h>
#include <linux/blkdev.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <scsi/scsi_host.h>
#include <linux/libata.h>
#include <linux/ata.h>

#define DRV_NAME	"pata_ns87415"
#define DRV_VERSION	"0.0.1"

/**
 *	ns87415_set_mode - Initialize host controller mode timings
 *	@ap: Port whose timings we are configuring
 *	@adev: Device whose timings we are configuring
 *	@mode: Mode to set
 *
 *	Program the mode registers for this controller, channel and
 *	device. Because the chip is quite an old design we have to do this
 *	for PIO/DMA switches.
 *
 *	LOCKING:
 *	None (inherited from caller).
 */

static void ns87415_set_mode(struct ata_port *ap, struct ata_device *adev, u8 mode)
{
	struct pci_dev *dev	= to_pci_dev(ap->host->dev);
	int unit		= 2 * ap->port_no + adev->devno;
	int timing		= 0x44 + 2 * unit;
	unsigned long T		= 1000000000 / 33333;	/* PCI clocks */
	struct ata_timing t;
	u16 clocking;
	u8 iordy;
	u8 status;

	/* Timing register format is 17 - low nybble read timing with
	   the high nybble being 16 - x for recovery time in PCI clocks */

	ata_timing_compute(adev, adev->pio_mode, &t, T, 0);

	clocking = 17 - clamp_val(t.active, 2, 17);
	clocking |= (16 - clamp_val(t.recover, 1, 16)) << 4;
 	/* Use the same timing for read and write bytes */
	clocking |= (clocking << 8);
	pci_write_config_word(dev, timing, clocking);

	/* Set the IORDY enable versus DMA enable on or off properly */
	pci_read_config_byte(dev, 0x42, &iordy);
	iordy &= ~(1 << (4 + unit));
	if (mode >= XFER_MW_DMA_0 || !ata_pio_need_iordy(adev))
		iordy |= (1 << (4 + unit));

	/* Paranoia: We shouldn't ever get here with busy write buffers
	   but if so wait */

	pci_read_config_byte(dev, 0x43, &status);
	while (status & 0x03) {
		udelay(1);
		pci_read_config_byte(dev, 0x43, &status);
	}
	/* Flip the IORDY/DMA bits now we are sure the write buffers are
	   clear */
	pci_write_config_byte(dev, 0x42, iordy);

	/* TODO: Set byte 54 command timing to the best 8bit
	   mode shared by all four devices */
}

/**
 *	ns87415_set_piomode - Initialize host controller PATA PIO timings
 *	@ap: Port whose timings we are configuring
 *	@adev: Device to program
 *
 *	Set PIO mode for device, in host controller PCI config space.
 *
 *	LOCKING:
 *	None (inherited from caller).
 */

static void ns87415_set_piomode(struct ata_port *ap, struct ata_device *adev)
{
	ns87415_set_mode(ap, adev, adev->pio_mode);
}

/**
 *	ns87415_bmdma_setup		-	Set up DMA
 *	@qc: Command block
 *
 *	Set up for bus masterng DMA. We have to do this ourselves
 *	rather than use the helper due to a chip erratum
 */

static void ns87415_bmdma_setup(struct ata_queued_cmd *qc)
{
	struct ata_port *ap = qc->ap;
	unsigned int rw = (qc->tf.flags & ATA_TFLAG_WRITE);
	u8 dmactl;

	/* load PRD table addr. */
	mb();	/* make sure PRD table writes are visible to controller */
	iowrite32(ap->bmdma_prd_dma, ap->ioaddr.bmdma_addr + ATA_DMA_TABLE_OFS);

	/* specify data direction, triple-check start bit is clear */
	dmactl = ioread8(ap->ioaddr.bmdma_addr + ATA_DMA_CMD);
	dmactl &= ~(ATA_DMA_WR | ATA_DMA_START);
	/* Due to an erratum we need to write these bits to the wrong
	   place - which does save us an I/O bizarrely */
	dmactl |= ATA_DMA_INTR | ATA_DMA_ERR;
	if (!rw)
		dmactl |= ATA_DMA_WR;
	iowrite8(dmactl, ap->ioaddr.bmdma_addr + ATA_DMA_CMD);
	/* issue r/w command */
	ap->ops->sff_exec_command(ap, &qc->tf);
}

/**
 *	ns87415_bmdma_start		-	Begin DMA transfer
 *	@qc: Command block
 *
 *	Switch the timings for the chip and set up for a DMA transfer
 *	before the DMA burst begins.
 *
 *	FIXME: We should do lazy switching on bmdma_start versus
 *	ata_pio_data_xfer for better performance.
 */

static void ns87415_bmdma_start(struct ata_queued_cmd *qc)
{
	ns87415_set_mode(qc->ap, qc->dev, qc->dev->dma_mode);
	ata_bmdma_start(qc);
}

/**
 *	ns87415_bmdma_stop		-	End DMA transfer
 *	@qc: Command block
 *
 *	End DMA mode and switch the controller back into PIO mode
 */

static void ns87415_bmdma_stop(struct ata_queued_cmd *qc)
{
	ata_bmdma_stop(qc);
	ns87415_set_mode(qc->ap, qc->dev, qc->dev->pio_mode);
}

/**
 *	ns87415_irq_clear		-	Clear interrupt
 *	@ap: Channel to clear
 *
 *	Erratum: Due to a chip bug regisers 02 and 0A bit 1 and 2 (the
 *	error bits) are reset by writing to register 00 or 08.
 */

static void ns87415_irq_clear(struct ata_port *ap)
{
	void __iomem *mmio = ap->ioaddr.bmdma_addr;

	if (!mmio)
		return;
	iowrite8((ioread8(mmio + ATA_DMA_CMD) | ATA_DMA_INTR | ATA_DMA_ERR),
			mmio + ATA_DMA_CMD);
}

/**
 *	ns87415_check_atapi_dma		-	ATAPI DMA filter
 *	@qc: Command block
 *
 *	Disable ATAPI DMA (for now). We may be able to do DMA if we
 *	kill the prefetching. This isn't clear.
 */

static int ns87415_check_atapi_dma(struct ata_queued_cmd *qc)
{
	return -EOPNOTSUPP;
}

#if defined(CONFIG_SUPERIO)

/* SUPERIO 87560 is a PoS chip that NatSem denies exists.
 * Unfortunately, it's built-in on all Astro-based PA-RISC workstations
 * which use the integrated NS87514 cell for CD-ROM support.
 * i.e we have to support for CD-ROM installs.
 * See drivers/parisc/superio.c for more gory details.
 *
 * Workarounds taken from drivers/ide/pci/ns87415.c
 */

#include <asm/superio.h>

#define SUPERIO_IDE_MAX_RETRIES 25

/**
 *	ns87560_read_buggy	-	workaround buggy Super I/O chip
 *	@port: Port to read
 *
 *	Work around chipset problems in the 87560 SuperIO chip
 */

static u8 ns87560_read_buggy(void __iomem *port)
{
	u8 tmp;
	int retries = SUPERIO_IDE_MAX_RETRIES;
	do {
		tmp = ioread8(port);
		if (tmp != 0)
			return tmp;
		udelay(50);
	} while(retries-- > 0);
	return tmp;
}

/**
 *	ns87560_check_status
 *	@ap: channel to check
 *
 *	Return the status of the channel working around the
 *	87560 flaws.
 */

static u8 ns87560_check_status(struct ata_port *ap)
{
	return ns87560_read_buggy(ap->ioaddr.status_addr);
}

/**
 *	ns87560_tf_read - input device's ATA taskfile shadow registers
 *	@ap: Port from which input is read
 *	@tf: ATA taskfile register set for storing input
 *
 *	Reads ATA taskfile registers for currently-selected device
 *	into @tf. Work around the 87560 bugs.
 *
 *	LOCKING:
 *	Inherited from caller.
 */
void ns87560_tf_read(struct ata_port *ap, struct ata_taskfile *tf)
{
	struct ata_ioports *ioaddr = &ap->ioaddr;

	tf->command = ns87560_check_status(ap);
	tf->feature = ioread8(ioaddr->error_addr);
	tf->nsect = ioread8(ioaddr->nsect_addr);
	tf->lbal = ioread8(ioaddr->lbal_addr);
	tf->lbam = ioread8(ioaddr->lbam_addr);
	tf->lbah = ioread8(ioaddr->lbah_addr);
	tf->device = ns87560_read_buggy(ioaddr->device_addr);

	if (tf->flags & ATA_TFLAG_LBA48) {
		iowrite8(tf->ctl | ATA_HOB, ioaddr->ctl_addr);
		tf->hob_feature = ioread8(ioaddr->error_addr);
		tf->hob_nsect = ioread8(ioaddr->nsect_addr);
		tf->hob_lbal = ioread8(ioaddr->lbal_addr);
		tf->hob_lbam = ioread8(ioaddr->lbam_addr);
		tf->hob_lbah = ioread8(ioaddr->lbah_addr);
		iowrite8(tf->ctl, ioaddr->ctl_addr);
		ap->last_ctl = tf->ctl;
	}
}

/**
 *	ns87560_bmdma_status
 *	@ap: channel to check
 *
 *	Return the DMA status of the channel working around the
 *	87560 flaws.
 */

static u8 ns87560_bmdma_status(struct ata_port *ap)
{
	return ns87560_read_buggy(ap->ioaddr.bmdma_addr + ATA_DMA_STATUS);
}
#endif		/* 87560 SuperIO Support */

static struct ata_port_operations ns87415_pata_ops = {
	.inherits		= &ata_bmdma_port_ops,

	.check_atapi_dma	= ns87415_check_atapi_dma,
	.bmdma_setup		= ns87415_bmdma_setup,
	.bmdma_start		= ns87415_bmdma_start,
	.bmdma_stop		= ns87415_bmdma_stop,
	.sff_irq_clear		= ns87415_irq_clear,

	.cable_detect		= ata_cable_40wire,
	.set_piomode		= ns87415_set_piomode,
};

#if defined(CONFIG_SUPERIO)
static struct ata_port_operations ns87560_pata_ops = {
	.inherits		= &ns87415_pata_ops,
	.sff_tf_read		= ns87560_tf_read,
	.sff_check_status	= ns87560_check_status,
	.bmdma_status		= ns87560_bmdma_status,
};
#endif

static struct scsi_host_template ns87415_sht = {
	ATA_BMDMA_SHT(DRV_NAME),
};

static void ns87415_fixup(struct pci_dev *pdev)
{
	/* Select 512 byte sectors */
	pci_write_config_byte(pdev, 0x55, 0xEE);
	/* Select PIO0 8bit clocking */
	pci_write_config_byte(pdev, 0x54, 0xB7);
}

/**
 *	ns87415_init_one - Register 87415 ATA PCI device with kernel services
 *	@pdev: PCI device to register
 *	@ent: Entry in ns87415_pci_tbl matching with @pdev
 *
 *	Called from kernel PCI layer.  We probe for combined mode (sigh),
 *	and then hand over control to libata, for it to do the rest.
 *
 *	LOCKING:
 *	Inherited from PCI layer (may sleep).
 *
 *	RETURNS:
 *	Zero on success, or -ERRNO value.
 */

static int ns87415_init_one (struct pci_dev *pdev, const struct pci_device_id *ent)
{
	static const struct ata_port_info info = {
		.flags		= ATA_FLAG_SLAVE_POSS,
		.pio_mask	= ATA_PIO4,
		.mwdma_mask	= ATA_MWDMA2,
		.port_ops	= &ns87415_pata_ops,
	};
	const struct ata_port_info *ppi[] = { &info, NULL };
	int rc;
#if defined(CONFIG_SUPERIO)
	static const struct ata_port_info info87560 = {
		.flags		= ATA_FLAG_SLAVE_POSS,
		.pio_mask	= ATA_PIO4,
		.mwdma_mask	= ATA_MWDMA2,
		.port_ops	= &ns87560_pata_ops,
	};

	if (PCI_SLOT(pdev->devfn) == 0x0E)
		ppi[0] = &info87560;
#endif
	ata_print_version_once(&pdev->dev, DRV_VERSION);

	rc = pcim_enable_device(pdev);
	if (rc)
		return rc;

	ns87415_fixup(pdev);

	return ata_pci_bmdma_init_one(pdev, ppi, &ns87415_sht, NULL, 0);
}

static const struct pci_device_id ns87415_pci_tbl[] = {
	{ PCI_VDEVICE(NS, PCI_DEVICE_ID_NS_87415), },

	{ }	/* terminate list */
};

#ifdef CONFIG_PM
static int ns87415_reinit_one(struct pci_dev *pdev)
{
	struct ata_host *host = dev_get_drvdata(&pdev->dev);
	int rc;

	rc = ata_pci_device_do_resume(pdev);
	if (rc)
		return rc;

	ns87415_fixup(pdev);

	ata_host_resume(host);
	return 0;
}
#endif

static struct pci_driver ns87415_pci_driver = {
	.name			= DRV_NAME,
	.id_table		= ns87415_pci_tbl,
	.probe			= ns87415_init_one,
	.remove			= ata_pci_remove_one,
#ifdef CONFIG_PM
	.suspend		= ata_pci_device_suspend,
	.resume			= ns87415_reinit_one,
#endif
};

module_pci_driver(ns87415_pci_driver);

MODULE_AUTHOR("Alan Cox");
MODULE_DESCRIPTION("ATA low-level driver for NS87415 controllers");
MODULE_LICENSE("GPL");
MODULE_DEVICE_TABLE(pci, ns87415_pci_tbl);
MODULE_VERSION(DRV_VERSION);
Commit	Line	Data
c4b5b7b6 AC	1	/*
	2	* pata_ns87415.c - NS87415 (non PARISC) PATA
	3	*
ab771630	4	* (C) 2005 Red Hat <alan@lxorguk.ukuu.org.uk>
c4b5b7b6 AC	5	*
	6	* This is a fairly generic MWDMA controller. It has some limitations
	7	* as it requires timing reloads on PIO/DMA transitions but it is otherwise
	8	* fairly well designed.
	9	*
	10	* This driver assumes the firmware has left the chip in a valid ST506
	11	* compliant state, either legacy IRQ 14/15 or native INTA shared. You
	12	* may need to add platform code if your system fails to do this.
	13	*
	14	* The same cell appears in the 87560 controller used by some PARISC
	15	* systems. This has its own special mountain of errata.
	16	*
	17	* TODO:
	18	* Test PARISC SuperIO
	19	* Get someone to test on SPARC
2dcb407e	20	* Implement lazy pio/dma switching for better performance
c4b5b7b6 AC	21	* 8bit shared timing.
	22	* See if we need to kill the FIFO for ATAPI
	23	*/
	24
	25	#include <linux/kernel.h>
	26	#include <linux/module.h>
	27	#include <linux/pci.h>
	28	#include <linux/init.h>
	29	#include <linux/blkdev.h>
	30	#include <linux/delay.h>
	31	#include <linux/device.h>
	32	#include <scsi/scsi_host.h>
	33	#include <linux/libata.h>
	34	#include <linux/ata.h>
	35
	36	#define DRV_NAME "pata_ns87415"
	37	#define DRV_VERSION "0.0.1"
	38
	39	/**
	40	* ns87415_set_mode - Initialize host controller mode timings
	41	* @ap: Port whose timings we are configuring
	42	* @adev: Device whose timings we are configuring
	43	* @mode: Mode to set
	44	*
	45	* Program the mode registers for this controller, channel and
	46	* device. Because the chip is quite an old design we have to do this
	47	* for PIO/DMA switches.
	48	*
	49	* LOCKING:
	50	* None (inherited from caller).
	51	*/
	52
	53	static void ns87415_set_mode(struct ata_port ap, struct ata_device adev, u8 mode)
	54	{
	55	struct pci_dev *dev = to_pci_dev(ap->host->dev);
	56	int unit = 2 * ap->port_no + adev->devno;
	57	int timing = 0x44 + 2 * unit;
	58	unsigned long T = 1000000000 / 33333; /* PCI clocks */
	59	struct ata_timing t;
	60	u16 clocking;
	61	u8 iordy;
	62	u8 status;
2dcb407e	63
c4b5b7b6 AC	64	/* Timing register format is 17 - low nybble read timing with
c4b5b7b6 AC	65	the high nybble being 16 - x for recovery time in PCI clocks */
2dcb407e	66
c4b5b7b6 AC	67	ata_timing_compute(adev, adev->pio_mode, &t, T, 0);
c4b5b7b6 AC	68
07633b5d HH	69	clocking = 17 - clamp_val(t.active, 2, 17);
07633b5d HH	70	clocking \|= (16 - clamp_val(t.recover, 1, 16)) << 4;
c4b5b7b6 AC	71	/* Use the same timing for read and write bytes */
	72	clocking \|= (clocking << 8);
	73	pci_write_config_word(dev, timing, clocking);
2dcb407e	74
c4b5b7b6 AC	75	/* Set the IORDY enable versus DMA enable on or off properly */
	76	pci_read_config_byte(dev, 0x42, &iordy);
	77	iordy &= ~(1 << (4 + unit));
	78	if (mode >= XFER_MW_DMA_0 \|\| !ata_pio_need_iordy(adev))
	79	iordy \|= (1 << (4 + unit));
	80
	81	/* Paranoia: We shouldn't ever get here with busy write buffers
	82	but if so wait */
	83
	84	pci_read_config_byte(dev, 0x43, &status);
	85	while (status & 0x03) {
	86	udelay(1);
	87	pci_read_config_byte(dev, 0x43, &status);
	88	}
	89	/* Flip the IORDY/DMA bits now we are sure the write buffers are
	90	clear */
	91	pci_write_config_byte(dev, 0x42, iordy);
	92
	93	/* TODO: Set byte 54 command timing to the best 8bit
	94	mode shared by all four devices */
	95	}
	96
	97	/**
	98	* ns87415_set_piomode - Initialize host controller PATA PIO timings
	99	* @ap: Port whose timings we are configuring
	100	* @adev: Device to program
	101	*
	102	* Set PIO mode for device, in host controller PCI config space.
	103	*
	104	* LOCKING:
	105	* None (inherited from caller).
	106	*/
	107
	108	static void ns87415_set_piomode(struct ata_port ap, struct ata_device adev)
	109	{
	110	ns87415_set_mode(ap, adev, adev->pio_mode);
	111	}
	112
	113	/**
	114	* ns87415_bmdma_setup - Set up DMA
	115	* @qc: Command block
	116	*
	117	* Set up for bus masterng DMA. We have to do this ourselves
	118	* rather than use the helper due to a chip erratum
	119	*/
	120
	121	static void ns87415_bmdma_setup(struct ata_queued_cmd *qc)
	122	{
	123	struct ata_port *ap = qc->ap;
	124	unsigned int rw = (qc->tf.flags & ATA_TFLAG_WRITE);
	125	u8 dmactl;
	126
	127	/* load PRD table addr. */
	128	mb(); /* make sure PRD table writes are visible to controller */
f60d7011	129	iowrite32(ap->bmdma_prd_dma, ap->ioaddr.bmdma_addr + ATA_DMA_TABLE_OFS);
c4b5b7b6 AC	130
	131	/* specify data direction, triple-check start bit is clear */
	132	dmactl = ioread8(ap->ioaddr.bmdma_addr + ATA_DMA_CMD);
	133	dmactl &= ~(ATA_DMA_WR \| ATA_DMA_START);
	134	/* Due to an erratum we need to write these bits to the wrong
	135	place - which does save us an I/O bizarrely */
	136	dmactl \|= ATA_DMA_INTR \| ATA_DMA_ERR;
	137	if (!rw)
	138	dmactl \|= ATA_DMA_WR;
	139	iowrite8(dmactl, ap->ioaddr.bmdma_addr + ATA_DMA_CMD);
	140	/* issue r/w command */
5682ed33	141	ap->ops->sff_exec_command(ap, &qc->tf);
c4b5b7b6 AC	142	}
	143
	144	/**
	145	* ns87415_bmdma_start - Begin DMA transfer
	146	* @qc: Command block
	147	*
	148	* Switch the timings for the chip and set up for a DMA transfer
	149	* before the DMA burst begins.
	150	*
	151	* FIXME: We should do lazy switching on bmdma_start versus
	152	* ata_pio_data_xfer for better performance.
	153	*/
	154
	155	static void ns87415_bmdma_start(struct ata_queued_cmd *qc)
	156	{
	157	ns87415_set_mode(qc->ap, qc->dev, qc->dev->dma_mode);
	158	ata_bmdma_start(qc);
	159	}
	160
	161	/**
	162	* ns87415_bmdma_stop - End DMA transfer
	163	* @qc: Command block
	164	*
	165	* End DMA mode and switch the controller back into PIO mode
	166	*/
	167
	168	static void ns87415_bmdma_stop(struct ata_queued_cmd *qc)
	169	{
	170	ata_bmdma_stop(qc);
	171	ns87415_set_mode(qc->ap, qc->dev, qc->dev->pio_mode);
	172	}
	173
	174	/**
9363c382	175	* ns87415_irq_clear - Clear interrupt
c4b5b7b6 AC	176	* @ap: Channel to clear
	177	*
	178	* Erratum: Due to a chip bug regisers 02 and 0A bit 1 and 2 (the
	179	* error bits) are reset by writing to register 00 or 08.
	180	*/
	181
9363c382	182	static void ns87415_irq_clear(struct ata_port *ap)
c4b5b7b6 AC	183	{
	184	void __iomem *mmio = ap->ioaddr.bmdma_addr;
	185
	186	if (!mmio)
	187	return;
2dcb407e	188	iowrite8((ioread8(mmio + ATA_DMA_CMD) \| ATA_DMA_INTR \| ATA_DMA_ERR),
c4b5b7b6 AC	189	mmio + ATA_DMA_CMD);
	190	}
	191
	192	/**
	193	* ns87415_check_atapi_dma - ATAPI DMA filter
	194	* @qc: Command block
	195	*
	196	* Disable ATAPI DMA (for now). We may be able to do DMA if we
	197	* kill the prefetching. This isn't clear.
	198	*/
	199
	200	static int ns87415_check_atapi_dma(struct ata_queued_cmd *qc)
	201	{
	202	return -EOPNOTSUPP;
	203	}
	204
	205	#if defined(CONFIG_SUPERIO)
	206
	207	/* SUPERIO 87560 is a PoS chip that NatSem denies exists.
	208	* Unfortunately, it's built-in on all Astro-based PA-RISC workstations
	209	* which use the integrated NS87514 cell for CD-ROM support.
	210	* i.e we have to support for CD-ROM installs.
	211	* See drivers/parisc/superio.c for more gory details.
	212	*
	213	* Workarounds taken from drivers/ide/pci/ns87415.c
	214	*/
	215
	216	#include <asm/superio.h>
	217
a9efacba FL	218	#define SUPERIO_IDE_MAX_RETRIES 25
a9efacba FL	219
c4b5b7b6 AC	220	/**
	221	* ns87560_read_buggy - workaround buggy Super I/O chip
	222	* @port: Port to read
	223	*
	224	* Work around chipset problems in the 87560 SuperIO chip
	225	*/
	226
	227	static u8 ns87560_read_buggy(void __iomem *port)
	228	{
	229	u8 tmp;
	230	int retries = SUPERIO_IDE_MAX_RETRIES;
	231	do {
	232	tmp = ioread8(port);
	233	if (tmp != 0)
	234	return tmp;
	235	udelay(50);
	236	} while(retries-- > 0);
	237	return tmp;
	238	}
	239
	240	/**
	241	* ns87560_check_status
	242	* @ap: channel to check
	243	*
	244	* Return the status of the channel working around the
	245	* 87560 flaws.
	246	*/
	247
	248	static u8 ns87560_check_status(struct ata_port *ap)
	249	{
	250	return ns87560_read_buggy(ap->ioaddr.status_addr);
	251	}
	252
	253	/**
	254	* ns87560_tf_read - input device's ATA taskfile shadow registers
	255	* @ap: Port from which input is read
	256	* @tf: ATA taskfile register set for storing input
	257	*
	258	* Reads ATA taskfile registers for currently-selected device
	259	* into @tf. Work around the 87560 bugs.
	260	*
	261	* LOCKING:
	262	* Inherited from caller.
	263	*/
	264	void ns87560_tf_read(struct ata_port ap, struct ata_taskfile tf)
	265	{
	266	struct ata_ioports *ioaddr = &ap->ioaddr;
	267
	268	tf->command = ns87560_check_status(ap);
	269	tf->feature = ioread8(ioaddr->error_addr);
	270	tf->nsect = ioread8(ioaddr->nsect_addr);
	271	tf->lbal = ioread8(ioaddr->lbal_addr);
	272	tf->lbam = ioread8(ioaddr->lbam_addr);
	273	tf->lbah = ioread8(ioaddr->lbah_addr);
	274	tf->device = ns87560_read_buggy(ioaddr->device_addr);
	275
	276	if (tf->flags & ATA_TFLAG_LBA48) {
	277	iowrite8(tf->ctl \| ATA_HOB, ioaddr->ctl_addr);
	278	tf->hob_feature = ioread8(ioaddr->error_addr);
	279	tf->hob_nsect = ioread8(ioaddr->nsect_addr);
	280	tf->hob_lbal = ioread8(ioaddr->lbal_addr);
	281	tf->hob_lbam = ioread8(ioaddr->lbam_addr);
	282	tf->hob_lbah = ioread8(ioaddr->lbah_addr);
	283	iowrite8(tf->ctl, ioaddr->ctl_addr);
284	ap->last_ctl = tf->ctl;
285	}
286	}
287
288	/**
289	* ns87560_bmdma_status
290	* @ap: channel to check
291	*
292	* Return the DMA status of the channel working around the
293	* 87560 flaws.
294	*/
295
296	static u8 ns87560_bmdma_status(struct ata_port *ap)
297	{
298	return ns87560_read_buggy(ap->ioaddr.bmdma_addr + ATA_DMA_STATUS);
299	}
029cfd6b	300	#endif /* 87560 SuperIO Support */
c4b5b7b6	301
029cfd6b TH	302	static struct ata_port_operations ns87415_pata_ops = {
029cfd6b TH	303	.inherits = &ata_bmdma_port_ops,
c4b5b7b6	304
c4b5b7b6	305	.check_atapi_dma = ns87415_check_atapi_dma,
c4b5b7b6 AC	306	.bmdma_setup = ns87415_bmdma_setup,
	307	.bmdma_start = ns87415_bmdma_start,
	308	.bmdma_stop = ns87415_bmdma_stop,
5682ed33	309	.sff_irq_clear = ns87415_irq_clear,
c4b5b7b6	310
c4b5b7b6	311	.cable_detect = ata_cable_40wire,
029cfd6b TH	312	.set_piomode = ns87415_set_piomode,
029cfd6b TH	313	};
c4b5b7b6	314
029cfd6b TH	315	#if defined(CONFIG_SUPERIO)
	316	static struct ata_port_operations ns87560_pata_ops = {
	317	.inherits = &ns87415_pata_ops,
5682ed33 TH	318	.sff_tf_read = ns87560_tf_read,
5682ed33 TH	319	.sff_check_status = ns87560_check_status,
029cfd6b	320	.bmdma_status = ns87560_bmdma_status,
c4b5b7b6	321	};
029cfd6b	322	#endif
c4b5b7b6 AC	323
c4b5b7b6 AC	324	static struct scsi_host_template ns87415_sht = {
68d1d07b	325	ATA_BMDMA_SHT(DRV_NAME),
c4b5b7b6 AC	326	};
c4b5b7b6 AC	327
a809c687 BZ	328	static void ns87415_fixup(struct pci_dev *pdev)
	329	{
	330	/* Select 512 byte sectors */
	331	pci_write_config_byte(pdev, 0x55, 0xEE);
	332	/* Select PIO0 8bit clocking */
	333	pci_write_config_byte(pdev, 0x54, 0xB7);
	334	}
c4b5b7b6 AC	335
	336	/**
	337	* ns87415_init_one - Register 87415 ATA PCI device with kernel services
	338	* @pdev: PCI device to register
	339	* @ent: Entry in ns87415_pci_tbl matching with @pdev
	340	*
	341	* Called from kernel PCI layer. We probe for combined mode (sigh),
	342	* and then hand over control to libata, for it to do the rest.
	343	*
	344	* LOCKING:
	345	* Inherited from PCI layer (may sleep).
	346	*
	347	* RETURNS:
	348	* Zero on success, or -ERRNO value.
	349	*/
	350
	351	static int ns87415_init_one (struct pci_dev pdev, const struct pci_device_id ent)
	352	{
c4b5b7b6	353	static const struct ata_port_info info = {
c4b5b7b6	354	.flags = ATA_FLAG_SLAVE_POSS,
14bdef98 EIB	355	.pio_mask = ATA_PIO4,
14bdef98 EIB	356	.mwdma_mask = ATA_MWDMA2,
c4b5b7b6 AC	357	.port_ops = &ns87415_pata_ops,
	358	};
	359	const struct ata_port_info *ppi[] = { &info, NULL };
f08048e9	360	int rc;
c4b5b7b6 AC	361	#if defined(CONFIG_SUPERIO)
c4b5b7b6 AC	362	static const struct ata_port_info info87560 = {
c4b5b7b6	363	.flags = ATA_FLAG_SLAVE_POSS,
14bdef98 EIB	364	.pio_mask = ATA_PIO4,
14bdef98 EIB	365	.mwdma_mask = ATA_MWDMA2,
c4b5b7b6 AC	366	.port_ops = &ns87560_pata_ops,
	367	};
	368
	369	if (PCI_SLOT(pdev->devfn) == 0x0E)
	370	ppi[0] = &info87560;
	371	#endif
06296a1e	372	ata_print_version_once(&pdev->dev, DRV_VERSION);
f08048e9 TH	373
	374	rc = pcim_enable_device(pdev);
	375	if (rc)
	376	return rc;
	377
a809c687 BZ	378	ns87415_fixup(pdev);
a809c687 BZ	379
1c5afdf7	380	return ata_pci_bmdma_init_one(pdev, ppi, &ns87415_sht, NULL, 0);
c4b5b7b6 AC	381	}
	382
	383	static const struct pci_device_id ns87415_pci_tbl[] = {
	384	{ PCI_VDEVICE(NS, PCI_DEVICE_ID_NS_87415), },
	385
	386	{ } /* terminate list */
	387	};
	388
a809c687 BZ	389	#ifdef CONFIG_PM
	390	static int ns87415_reinit_one(struct pci_dev *pdev)
	391	{
	392	struct ata_host *host = dev_get_drvdata(&pdev->dev);
	393	int rc;
	394
	395	rc = ata_pci_device_do_resume(pdev);
	396	if (rc)
	397	return rc;
	398
	399	ns87415_fixup(pdev);
	400
	401	ata_host_resume(host);
	402	return 0;
	403	}
	404	#endif
	405
c4b5b7b6 AC	406	static struct pci_driver ns87415_pci_driver = {
	407	.name = DRV_NAME,
	408	.id_table = ns87415_pci_tbl,
	409	.probe = ns87415_init_one,
	410	.remove = ata_pci_remove_one,
	411	#ifdef CONFIG_PM
	412	.suspend = ata_pci_device_suspend,
a809c687	413	.resume = ns87415_reinit_one,
c4b5b7b6 AC	414	#endif
	415	};
	416
2fc75da0	417	module_pci_driver(ns87415_pci_driver);
c4b5b7b6 AC	418
	419	MODULE_AUTHOR("Alan Cox");
	420	MODULE_DESCRIPTION("ATA low-level driver for NS87415 controllers");
	421	MODULE_LICENSE("GPL");
	422	MODULE_DEVICE_TABLE(pci, ns87415_pci_tbl);
	423	MODULE_VERSION(DRV_VERSION);