libata: remove no longer needed pata_qdi driver

QDI65x0 controllers are fully supported by pata_legacy driver so remove no longer needed pata_qdi driver. Leave PATA_QDI config option for compatibility reasons and teach pata_legacy to preserve the old behavior of pata_qdi driver. Acked-by: Alan Cox <alan@linux.intel.com> Signed-off-by: Bartlomiej Zolnierkiewicz <bzolnier@gmail.com> Signed-off-by: Jeff Garzik <jgarzik@redhat.com>

libata: remove no longer needed pata_qdi driver
QDI65x0 controllers are fully supported by pata_legacy driver so remove no longer needed pata_qdi driver. Leave PATA_QDI config option for compatibility reasons and teach pata_legacy to preserve the old behavior of pata_qdi driver. Acked-by: Alan Cox <alan@linux.intel.com> Signed-off-by: Bartlomiej Zolnierkiewicz <bzolnier@gmail.com> Signed-off-by: Jeff Garzik <jgarzik@redhat.com>
Bartlomiej Zolnierkiewicz · Jeff Garzik
1 parent 4780c0b25e
Showing 4 changed files with 9 additions and 368 deletions Side-by-side Diff
drivers/ata/Kconfig
drivers/ata/Makefile
drivers/ata/pata_legacy.c
drivers/ata/pata_qdi.c
@@ -831,6 +831,7 @@
 config PATA_QDI
 	tristate "QDI VLB PATA support"
 	depends on ISA
+	select PATA_LEGACY
 	help
 	  Support for QDI 6500 and 6580 PATA controllers on VESA local bus.
  
@@ -88,7 +88,6 @@
 obj-$(CONFIG_PATA_PALMLD)	+= pata_palmld.o
 obj-$(CONFIG_PATA_PLATFORM)	+= pata_platform.o
 obj-$(CONFIG_PATA_OF_PLATFORM)	+= pata_of_platform.o
-obj-$(CONFIG_PATA_QDI)		+= pata_qdi.o
 obj-$(CONFIG_PATA_RB532)	+= pata_rb532_cf.o
 obj-$(CONFIG_PATA_RZ1000)	+= pata_rz1000.o
 obj-$(CONFIG_PATA_SAMSUNG_CF)	+= pata_samsung_cf.o
@@ -137,11 +137,17 @@
 static int ht6560b;		/* HT 6560A on primary 1, second 2, both 3 */
 static int opti82c611a;		/* Opti82c611A on primary 1, sec 2, both 3 */
 static int opti82c46x;		/* Opti 82c465MV present(pri/sec autodetect) */
-static int qdi;			/* Set to probe QDI controllers */
 static int autospeed;		/* Chip present which snoops speed changes */
 static int pio_mask = ATA_PIO4;	/* PIO range for autospeed devices */
 static int iordy_mask = 0xFFFFFFFF;	/* Use iordy if available */
  
+/* Set to probe QDI controllers */
+#ifdef CONFIG_PATA_QDI_MODULE
+static int qdi = 1;
+#else
+static int qdi;
+#endif
+
 #ifdef CONFIG_PATA_WINBOND_VLB_MODULE
 static int winbond = 1;		/* Set to probe Winbond controllers,
 					give I/O port if non standard */
@@ -1306,6 +1312,7 @@
 MODULE_DESCRIPTION("low-level driver for legacy ATA");
 MODULE_LICENSE("GPL");
 MODULE_VERSION(DRV_VERSION);
+MODULE_ALIAS("pata_qdi");
 MODULE_ALIAS("pata_winbond");
  
 module_param(probe_all, int, 0);
-/*
- *    pata_qdi.c - QDI VLB ATA controllers
- *	(C) 2006 Red Hat
- *
- * This driver mostly exists as a proof of concept for non PCI devices under
- * libata. While the QDI6580 was 'neat' in 1993 it is no longer terribly
- * useful.
- *
- * Tuning code written from the documentation at
- * http://www.ryston.cz/petr/vlb/qd6500.html
- * http://www.ryston.cz/petr/vlb/qd6580.html
- *
- * Probe code based on drivers/ide/legacy/qd65xx.c
- * Rewritten from the work of Colten Edwards <pje120@cs.usask.ca> by
- * Samuel Thibault <samuel.thibault@ens-lyon.org>
- */
-
-#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 <scsi/scsi_host.h>
-#include <linux/libata.h>
-#include <linux/platform_device.h>
-
-#define DRV_NAME "pata_qdi"
-#define DRV_VERSION "0.3.1"
-
-#define NR_HOST 4	/* Two 6580s */
-
-struct qdi_data {
-	unsigned long timing;
-	u8 clock[2];
-	u8 last;
-	int fast;
-	struct platform_device *platform_dev;
-
-};
-
-static struct ata_host *qdi_host[NR_HOST];
-static struct qdi_data qdi_data[NR_HOST];
-static int nr_qdi_host;
-
-#ifdef MODULE
-static int probe_qdi = 1;
-#else
-static int probe_qdi;
-#endif
-
-static void qdi6500_set_piomode(struct ata_port *ap, struct ata_device *adev)
-{
-	struct ata_timing t;
-	struct qdi_data *qdi = ap->host->private_data;
-	int active, recovery;
-	u8 timing;
-
-	/* Get the timing data in cycles */
-	ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
-
-	if (qdi->fast) {
-		active = 8 - clamp_val(t.active, 1, 8);
-		recovery = 18 - clamp_val(t.recover, 3, 18);
-	} else {
-		active = 9 - clamp_val(t.active, 2, 9);
-		recovery = 15 - clamp_val(t.recover, 0, 15);
-	}
-	timing = (recovery << 4) | active | 0x08;
-
-	qdi->clock[adev->devno] = timing;
-
-	outb(timing, qdi->timing);
-}
-
-static void qdi6580_set_piomode(struct ata_port *ap, struct ata_device *adev)
-{
-	struct ata_timing t;
-	struct qdi_data *qdi = ap->host->private_data;
-	int active, recovery;
-	u8 timing;
-
-	/* Get the timing data in cycles */
-	ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
-
-	if (qdi->fast) {
-		active = 8 - clamp_val(t.active, 1, 8);
-		recovery = 18 - clamp_val(t.recover, 3, 18);
-	} else {
-		active = 9 - clamp_val(t.active, 2, 9);
-		recovery = 15 - clamp_val(t.recover, 0, 15);
-	}
-	timing = (recovery << 4) | active | 0x08;
-
-	qdi->clock[adev->devno] = timing;
-
-	outb(timing, qdi->timing);
-
-	/* Clear the FIFO */
-	if (adev->class != ATA_DEV_ATA)
-		outb(0x5F, (qdi->timing & 0xFFF0) + 3);
-}
-
-/**
- *	qdi_qc_issue		-	command issue
- *	@qc: command pending
- *
- *	Called when the libata layer is about to issue a command. We wrap
- *	this interface so that we can load the correct ATA timings.
- */
-
-static unsigned int qdi_qc_issue(struct ata_queued_cmd *qc)
-{
-	struct ata_port *ap = qc->ap;
-	struct ata_device *adev = qc->dev;
-	struct qdi_data *qdi = ap->host->private_data;
-
-	if (qdi->clock[adev->devno] != qdi->last) {
-		if (adev->pio_mode) {
-			qdi->last = qdi->clock[adev->devno];
-			outb(qdi->clock[adev->devno], qdi->timing);
-		}
-	}
-	return ata_sff_qc_issue(qc);
-}
-
-static unsigned int qdi_data_xfer(struct ata_device *dev, unsigned char *buf,
-				  unsigned int buflen, int rw)
-{
-	if (ata_id_has_dword_io(dev->id)) {
-		struct ata_port *ap = dev->link->ap;
-		int slop = buflen & 3;
-
-		if (rw == READ)
-			ioread32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
-		else
-			iowrite32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
-
-		if (unlikely(slop)) {
-			__le32 pad;
-			if (rw == READ) {
-				pad = cpu_to_le32(ioread32(ap->ioaddr.data_addr));
-				memcpy(buf + buflen - slop, &pad, slop);
-			} else {
-				memcpy(&pad, buf + buflen - slop, slop);
-				iowrite32(le32_to_cpu(pad), ap->ioaddr.data_addr);
-			}
-			buflen += 4 - slop;
-		}
-	} else
-		buflen = ata_sff_data_xfer(dev, buf, buflen, rw);
-
-	return buflen;
-}
-
-static struct scsi_host_template qdi_sht = {
-	ATA_PIO_SHT(DRV_NAME),
-};
-
-static struct ata_port_operations qdi6500_port_ops = {
-	.inherits	= &ata_sff_port_ops,
-	.qc_issue	= qdi_qc_issue,
-	.sff_data_xfer	= qdi_data_xfer,
-	.cable_detect	= ata_cable_40wire,
-	.set_piomode	= qdi6500_set_piomode,
-};
-
-static struct ata_port_operations qdi6580_port_ops = {
-	.inherits	= &qdi6500_port_ops,
-	.set_piomode	= qdi6580_set_piomode,
-};
-
-/**
- *	qdi_init_one		-	attach a qdi interface
- *	@type: Type to display
- *	@io: I/O port start
- *	@irq: interrupt line
- *	@fast: True if on a > 33Mhz VLB
- *
- *	Register an ISA bus IDE interface. Such interfaces are PIO and we
- *	assume do not support IRQ sharing.
- */
-
-static __init int qdi_init_one(unsigned long port, int type, unsigned long io, int irq, int fast)
-{
-	unsigned long ctl = io + 0x206;
-	struct platform_device *pdev;
-	struct ata_host *host;
-	struct ata_port *ap;
-	void __iomem *io_addr, *ctl_addr;
-	int ret;
-
-	/*
-	 *	Fill in a probe structure first of all
-	 */
-
-	pdev = platform_device_register_simple(DRV_NAME, nr_qdi_host, NULL, 0);
-	if (IS_ERR(pdev))
-		return PTR_ERR(pdev);
-
-	ret = -ENOMEM;
-	io_addr = devm_ioport_map(&pdev->dev, io, 8);
-	ctl_addr = devm_ioport_map(&pdev->dev, ctl, 1);
-	if (!io_addr || !ctl_addr)
-		goto fail;
-
-	ret = -ENOMEM;
-	host = ata_host_alloc(&pdev->dev, 1);
-	if (!host)
-		goto fail;
-	ap = host->ports[0];
-
-	if (type == 6580) {
-		ap->ops = &qdi6580_port_ops;
-		ap->pio_mask = ATA_PIO4;
-		ap->flags |= ATA_FLAG_SLAVE_POSS;
-	} else {
-		ap->ops = &qdi6500_port_ops;
-		ap->pio_mask = ATA_PIO2; /* Actually PIO3 !IORDY is possible */
-		ap->flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_NO_IORDY;
-	}
-
-	ap->ioaddr.cmd_addr = io_addr;
-	ap->ioaddr.altstatus_addr = ctl_addr;
-	ap->ioaddr.ctl_addr = ctl_addr;
-	ata_sff_std_ports(&ap->ioaddr);
-
-	ata_port_desc(ap, "cmd %lx ctl %lx", io, ctl);
-
-	/*
-	 *	Hook in a private data structure per channel
-	 */
-	ap->private_data = &qdi_data[nr_qdi_host];
-
-	qdi_data[nr_qdi_host].timing = port;
-	qdi_data[nr_qdi_host].fast = fast;
-	qdi_data[nr_qdi_host].platform_dev = pdev;
-
-	printk(KERN_INFO DRV_NAME": qd%d at 0x%lx.\n", type, io);
-
-	/* activate */
-	ret = ata_host_activate(host, irq, ata_sff_interrupt, 0, &qdi_sht);
-	if (ret)
-		goto fail;
-
-	qdi_host[nr_qdi_host++] = dev_get_drvdata(&pdev->dev);
-	return 0;
-
- fail:
-	platform_device_unregister(pdev);
-	return ret;
-}
-
-/**
- *	qdi_init		-	attach qdi interfaces
- *
- *	Attach qdi IDE interfaces by scanning the ports it may occupy.
- */
-
-static __init int qdi_init(void)
-{
-	unsigned long flags;
-	static const unsigned long qd_port[2] = { 0x30, 0xB0 };
-	static const unsigned long ide_port[2] = { 0x170, 0x1F0 };
-	static const int ide_irq[2] = { 14, 15 };
-
-	int ct = 0;
-	int i;
-
-	if (probe_qdi == 0)
-		return -ENODEV;
-
-	/*
- 	 *	Check each possible QD65xx base address
-	 */
-
-	for (i = 0; i < 2; i++) {
-		unsigned long port = qd_port[i];
-		u8 r, res;
-
-
-		if (request_region(port, 2, "pata_qdi")) {
-			/* Check for a card */
-			local_irq_save(flags);
-			r = inb_p(port);
-			outb_p(0x19, port);
-			res = inb_p(port);
-			outb_p(r, port);
-			local_irq_restore(flags);
-
-			/* Fail */
-			if (res == 0x19)
-			{
-				release_region(port, 2);
-				continue;
-			}
-
-			/* Passes the presence test */
-			r = inb_p(port + 1);	/* Check port agrees with port set */
-			if ((r & 2) >> 1 != i) {
-				release_region(port, 2);
-				continue;
-			}
-
-			/* Check card type */
-			if ((r & 0xF0) == 0xC0) {
-				/* QD6500: single channel */
-				if (r & 8) {
-					/* Disabled ? */
-					release_region(port, 2);
-					continue;
-				}
-				if (qdi_init_one(port, 6500, ide_port[r & 0x01], ide_irq[r & 0x01], r & 0x04) == 0)
-					ct++;
-			}
-			if (((r & 0xF0) == 0xA0) || (r & 0xF0) == 0x50) {
-				/* QD6580: dual channel */
-				if (!request_region(port + 2 , 2, "pata_qdi"))
-				{
-					release_region(port, 2);
-					continue;
-				}
-				res = inb(port + 3);
-				if (res & 1) {
-					/* Single channel mode */
-					if (qdi_init_one(port, 6580, ide_port[r & 0x01], ide_irq[r & 0x01], r & 0x04) == 0)
-						ct++;
-				} else {
-					/* Dual channel mode */
-					if (qdi_init_one(port, 6580, 0x1F0, 14, r & 0x04) == 0)
-						ct++;
-					if (qdi_init_one(port + 2, 6580, 0x170, 15, r & 0x04) == 0)
-						ct++;
-				}
-			}
-		}
-	}
-	if (ct != 0)
-		return 0;
-	return -ENODEV;
-}
-
-static __exit void qdi_exit(void)
-{
-	int i;
-
-	for (i = 0; i < nr_qdi_host; i++) {
-		ata_host_detach(qdi_host[i]);
-		/* Free the control resource. The 6580 dual channel has the resources
-		 * claimed as a pair of 2 byte resources so we need no special cases...
-		 */
-		release_region(qdi_data[i].timing, 2);
-		platform_device_unregister(qdi_data[i].platform_dev);
-	}
-}
-
-MODULE_AUTHOR("Alan Cox");
-MODULE_DESCRIPTION("low-level driver for qdi ATA");
-MODULE_LICENSE("GPL");
-MODULE_VERSION(DRV_VERSION);
-
-module_init(qdi_init);
-module_exit(qdi_exit);
-
-module_param(probe_qdi, int, 0);
...	...	@@ -831,6 +831,7 @@
831	831	config PATA_QDI
832	832	tristate "QDI VLB PATA support"
833	833	depends on ISA
	834	+ select PATA_LEGACY
834	835	help
835	836	Support for QDI 6500 and 6580 PATA controllers on VESA local bus.
836	837
...	...	@@ -88,7 +88,6 @@
88	88	obj-$(CONFIG_PATA_PALMLD) += pata_palmld.o
89	89	obj-$(CONFIG_PATA_PLATFORM) += pata_platform.o
90	90	obj-$(CONFIG_PATA_OF_PLATFORM) += pata_of_platform.o
91		-obj-$(CONFIG_PATA_QDI) += pata_qdi.o
92	91	obj-$(CONFIG_PATA_RB532) += pata_rb532_cf.o
93	92	obj-$(CONFIG_PATA_RZ1000) += pata_rz1000.o
94	93	obj-$(CONFIG_PATA_SAMSUNG_CF) += pata_samsung_cf.o
...	...	@@ -137,11 +137,17 @@
137	137	static int ht6560b; /* HT 6560A on primary 1, second 2, both 3 */
138	138	static int opti82c611a; /* Opti82c611A on primary 1, sec 2, both 3 */
139	139	static int opti82c46x; /* Opti 82c465MV present(pri/sec autodetect) */
140		-static int qdi; /* Set to probe QDI controllers */
141	140	static int autospeed; /* Chip present which snoops speed changes */
142	141	static int pio_mask = ATA_PIO4; /* PIO range for autospeed devices */
143	142	static int iordy_mask = 0xFFFFFFFF; /* Use iordy if available */
144	143
	144	+/* Set to probe QDI controllers */
	145	+#ifdef CONFIG_PATA_QDI_MODULE
	146	+static int qdi = 1;
	147	+#else
	148	+static int qdi;
	149	+#endif
	150	+
145	151	#ifdef CONFIG_PATA_WINBOND_VLB_MODULE
146	152	static int winbond = 1; /* Set to probe Winbond controllers,
147	153	give I/O port if non standard */
...	...	@@ -1306,6 +1312,7 @@
1306	1312	MODULE_DESCRIPTION("low-level driver for legacy ATA");
1307	1313	MODULE_LICENSE("GPL");
1308	1314	MODULE_VERSION(DRV_VERSION);
	1315	+MODULE_ALIAS("pata_qdi");
1309	1316	MODULE_ALIAS("pata_winbond");
1310	1317
1311	1318	module_param(probe_all, int, 0);
1		-/*
2		- * pata_qdi.c - QDI VLB ATA controllers
3		- * (C) 2006 Red Hat
4		- *
5		- * This driver mostly exists as a proof of concept for non PCI devices under
6		- * libata. While the QDI6580 was 'neat' in 1993 it is no longer terribly
7		- * useful.
8		- *
9		- * Tuning code written from the documentation at
10		- * http://www.ryston.cz/petr/vlb/qd6500.html
11		- * http://www.ryston.cz/petr/vlb/qd6580.html
12		- *
13		- * Probe code based on drivers/ide/legacy/qd65xx.c
14		- * Rewritten from the work of Colten Edwards <pje120@cs.usask.ca> by
15		- * Samuel Thibault <samuel.thibault@ens-lyon.org>
16		- */
17		-
18		-#include <linux/kernel.h>
19		-#include <linux/module.h>
20		-#include <linux/pci.h>
21		-#include <linux/init.h>
22		-#include <linux/blkdev.h>
23		-#include <linux/delay.h>
24		-#include <scsi/scsi_host.h>
25		-#include <linux/libata.h>
26		-#include <linux/platform_device.h>
27		-
28		-#define DRV_NAME "pata_qdi"
29		-#define DRV_VERSION "0.3.1"
30		-
31		-#define NR_HOST 4 /* Two 6580s */
32		-
33		-struct qdi_data {
34		- unsigned long timing;
35		- u8 clock[2];
36		- u8 last;
37		- int fast;
38		- struct platform_device *platform_dev;
39		-
40		-};
41		-
42		-static struct ata_host *qdi_host[NR_HOST];
43		-static struct qdi_data qdi_data[NR_HOST];
44		-static int nr_qdi_host;
45		-
46		-#ifdef MODULE
47		-static int probe_qdi = 1;
48		-#else
49		-static int probe_qdi;
50		-#endif
51		-
52		-static void qdi6500_set_piomode(struct ata_port ap, struct ata_device adev)
53		-{
54		- struct ata_timing t;
55		- struct qdi_data *qdi = ap->host->private_data;
56		- int active, recovery;
57		- u8 timing;
58		-
59		- /* Get the timing data in cycles */
60		- ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
61		-
62		- if (qdi->fast) {
63		- active = 8 - clamp_val(t.active, 1, 8);
64		- recovery = 18 - clamp_val(t.recover, 3, 18);
65		- } else {
66		- active = 9 - clamp_val(t.active, 2, 9);
67		- recovery = 15 - clamp_val(t.recover, 0, 15);
68		- }
69		- timing = (recovery << 4) \| active \| 0x08;
70		-
71		- qdi->clock[adev->devno] = timing;
72		-
73		- outb(timing, qdi->timing);
74		-}
75		-
76		-static void qdi6580_set_piomode(struct ata_port ap, struct ata_device adev)
77		-{
78		- struct ata_timing t;
79		- struct qdi_data *qdi = ap->host->private_data;
80		- int active, recovery;
81		- u8 timing;
82		-
83		- /* Get the timing data in cycles */
84		- ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
85		-
86		- if (qdi->fast) {
87		- active = 8 - clamp_val(t.active, 1, 8);
88		- recovery = 18 - clamp_val(t.recover, 3, 18);
89		- } else {
90		- active = 9 - clamp_val(t.active, 2, 9);
91		- recovery = 15 - clamp_val(t.recover, 0, 15);
92		- }
93		- timing = (recovery << 4) \| active \| 0x08;
94		-
95		- qdi->clock[adev->devno] = timing;
96		-
97		- outb(timing, qdi->timing);
98		-
99		- /* Clear the FIFO */
100		- if (adev->class != ATA_DEV_ATA)
101		- outb(0x5F, (qdi->timing & 0xFFF0) + 3);
102		-}
103		-
104		-/**
105		- * qdi_qc_issue - command issue
106		- * @qc: command pending
107		- *
108		- * Called when the libata layer is about to issue a command. We wrap
109		- * this interface so that we can load the correct ATA timings.
110		- */
111		-
112		-static unsigned int qdi_qc_issue(struct ata_queued_cmd *qc)
113		-{
114		- struct ata_port *ap = qc->ap;
115		- struct ata_device *adev = qc->dev;
116		- struct qdi_data *qdi = ap->host->private_data;
117		-
118		- if (qdi->clock[adev->devno] != qdi->last) {
119		- if (adev->pio_mode) {
120		- qdi->last = qdi->clock[adev->devno];
121		- outb(qdi->clock[adev->devno], qdi->timing);
122		- }
123		- }
124		- return ata_sff_qc_issue(qc);
125		-}
126		-
127		-static unsigned int qdi_data_xfer(struct ata_device dev, unsigned char buf,
128		- unsigned int buflen, int rw)
129		-{
130		- if (ata_id_has_dword_io(dev->id)) {
131		- struct ata_port *ap = dev->link->ap;
132		- int slop = buflen & 3;
133		-
134		- if (rw == READ)
135		- ioread32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
136		- else
137		- iowrite32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
138		-
139		- if (unlikely(slop)) {
140		- __le32 pad;
141		- if (rw == READ) {
142		- pad = cpu_to_le32(ioread32(ap->ioaddr.data_addr));
143		- memcpy(buf + buflen - slop, &pad, slop);
144		- } else {
145		- memcpy(&pad, buf + buflen - slop, slop);
146		- iowrite32(le32_to_cpu(pad), ap->ioaddr.data_addr);
147		- }
148		- buflen += 4 - slop;
149		- }
150		- } else
151		- buflen = ata_sff_data_xfer(dev, buf, buflen, rw);
152		-
153		- return buflen;
154		-}
155		-
156		-static struct scsi_host_template qdi_sht = {
157		- ATA_PIO_SHT(DRV_NAME),
158		-};
159		-
160		-static struct ata_port_operations qdi6500_port_ops = {
161		- .inherits = &ata_sff_port_ops,
162		- .qc_issue = qdi_qc_issue,
163		- .sff_data_xfer = qdi_data_xfer,
164		- .cable_detect = ata_cable_40wire,
165		- .set_piomode = qdi6500_set_piomode,
166		-};
167		-
168		-static struct ata_port_operations qdi6580_port_ops = {
169		- .inherits = &qdi6500_port_ops,
170		- .set_piomode = qdi6580_set_piomode,
171		-};
172		-
173		-/**
174		- * qdi_init_one - attach a qdi interface
175		- * @type: Type to display
176		- * @io: I/O port start
177		- * @irq: interrupt line
178		- * @fast: True if on a > 33Mhz VLB
179		- *
180		- * Register an ISA bus IDE interface. Such interfaces are PIO and we
181		- * assume do not support IRQ sharing.
182		- */
183		-
184		-static __init int qdi_init_one(unsigned long port, int type, unsigned long io, int irq, int fast)
185		-{
186		- unsigned long ctl = io + 0x206;
187		- struct platform_device *pdev;
188		- struct ata_host *host;
189		- struct ata_port *ap;
190		- void __iomem io_addr, ctl_addr;
191		- int ret;
192		-
193		- /*
194		- * Fill in a probe structure first of all
195		- */
196		-
197		- pdev = platform_device_register_simple(DRV_NAME, nr_qdi_host, NULL, 0);
198		- if (IS_ERR(pdev))
199		- return PTR_ERR(pdev);
200		-
201		- ret = -ENOMEM;
202		- io_addr = devm_ioport_map(&pdev->dev, io, 8);
203		- ctl_addr = devm_ioport_map(&pdev->dev, ctl, 1);
204		- if (!io_addr \|\| !ctl_addr)
205		- goto fail;
206		-
207		- ret = -ENOMEM;
208		- host = ata_host_alloc(&pdev->dev, 1);
209		- if (!host)
210		- goto fail;
211		- ap = host->ports[0];
212		-
213		- if (type == 6580) {
214		- ap->ops = &qdi6580_port_ops;
215		- ap->pio_mask = ATA_PIO4;
216		- ap->flags \|= ATA_FLAG_SLAVE_POSS;
217		- } else {
218		- ap->ops = &qdi6500_port_ops;
219		- ap->pio_mask = ATA_PIO2; /* Actually PIO3 !IORDY is possible */
220		- ap->flags = ATA_FLAG_SLAVE_POSS \| ATA_FLAG_NO_IORDY;
221		- }
222		-
223		- ap->ioaddr.cmd_addr = io_addr;
224		- ap->ioaddr.altstatus_addr = ctl_addr;
225		- ap->ioaddr.ctl_addr = ctl_addr;
226		- ata_sff_std_ports(&ap->ioaddr);
227		-
228		- ata_port_desc(ap, "cmd %lx ctl %lx", io, ctl);
229		-
230		- /*
231		- * Hook in a private data structure per channel
232		- */
233		- ap->private_data = &qdi_data[nr_qdi_host];
234		-
235		- qdi_data[nr_qdi_host].timing = port;
236		- qdi_data[nr_qdi_host].fast = fast;
237		- qdi_data[nr_qdi_host].platform_dev = pdev;
238		-
239		- printk(KERN_INFO DRV_NAME": qd%d at 0x%lx.\n", type, io);
240		-
241		- /* activate */
242		- ret = ata_host_activate(host, irq, ata_sff_interrupt, 0, &qdi_sht);
243		- if (ret)
244		- goto fail;
245		-
246		- qdi_host[nr_qdi_host++] = dev_get_drvdata(&pdev->dev);
247		- return 0;
248		-
249		- fail:
250		- platform_device_unregister(pdev);
251		- return ret;
252		-}
253		-
254		-/**
255		- * qdi_init - attach qdi interfaces
256		- *
257		- * Attach qdi IDE interfaces by scanning the ports it may occupy.
258		- */
259		-
260		-static __init int qdi_init(void)
261		-{
262		- unsigned long flags;
263		- static const unsigned long qd_port[2] = { 0x30, 0xB0 };
264		- static const unsigned long ide_port[2] = { 0x170, 0x1F0 };
265		- static const int ide_irq[2] = { 14, 15 };
266		-
267		- int ct = 0;
268		- int i;
269		-
270		- if (probe_qdi == 0)
271		- return -ENODEV;
272		-
273		- /*
274		- * Check each possible QD65xx base address
275		- */
276		-
277		- for (i = 0; i < 2; i++) {
278		- unsigned long port = qd_port[i];
279		- u8 r, res;
280		-
281		-
282		- if (request_region(port, 2, "pata_qdi")) {
283		- /* Check for a card */
284		- local_irq_save(flags);
285		- r = inb_p(port);
286		- outb_p(0x19, port);
287		- res = inb_p(port);
288		- outb_p(r, port);
289		- local_irq_restore(flags);
290		-
291		- /* Fail */
292		- if (res == 0x19)
293		- {
294		- release_region(port, 2);
295		- continue;
296		- }
297		-
298		- /* Passes the presence test */
299		- r = inb_p(port + 1); /* Check port agrees with port set */
300		- if ((r & 2) >> 1 != i) {
301		- release_region(port, 2);
302		- continue;
303		- }
304		-
305		- /* Check card type */
306		- if ((r & 0xF0) == 0xC0) {
307		- /* QD6500: single channel */
308		- if (r & 8) {
309		- /* Disabled ? */
310		- release_region(port, 2);
311		- continue;
312		- }
313		- if (qdi_init_one(port, 6500, ide_port[r & 0x01], ide_irq[r & 0x01], r & 0x04) == 0)
314		- ct++;
315		- }
316		- if (((r & 0xF0) == 0xA0) \|\| (r & 0xF0) == 0x50) {
317		- /* QD6580: dual channel */
318		- if (!request_region(port + 2 , 2, "pata_qdi"))
319		- {
320		- release_region(port, 2);
321		- continue;
322		- }
323		- res = inb(port + 3);
324		- if (res & 1) {
325		- /* Single channel mode */
326		- if (qdi_init_one(port, 6580, ide_port[r & 0x01], ide_irq[r & 0x01], r & 0x04) == 0)
327		- ct++;
328		- } else {
329		- /* Dual channel mode */
330		- if (qdi_init_one(port, 6580, 0x1F0, 14, r & 0x04) == 0)
331		- ct++;
332		- if (qdi_init_one(port + 2, 6580, 0x170, 15, r & 0x04) == 0)
333		- ct++;
334		- }
335		- }
336		- }
337		- }
338		- if (ct != 0)
339		- return 0;
340		- return -ENODEV;
341		-}
342		-
343		-static __exit void qdi_exit(void)
344		-{
345		- int i;
346		-
347		- for (i = 0; i < nr_qdi_host; i++) {
348		- ata_host_detach(qdi_host[i]);
349		- /* Free the control resource. The 6580 dual channel has the resources
350		- * claimed as a pair of 2 byte resources so we need no special cases...
351		- */
352		- release_region(qdi_data[i].timing, 2);
353		- platform_device_unregister(qdi_data[i].platform_dev);
354		- }
355		-}
356		-
357		-MODULE_AUTHOR("Alan Cox");
358		-MODULE_DESCRIPTION("low-level driver for qdi ATA");
359		-MODULE_LICENSE("GPL");
360		-MODULE_VERSION(DRV_VERSION);
361		-
362		-module_init(qdi_init);
363		-module_exit(qdi_exit);
364		-
365		-module_param(probe_qdi, int, 0);