xref: /openbmc/linux/drivers/ata/pata_legacy.c (revision 423997ff)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  *   pata-legacy.c - Legacy port PATA/SATA controller driver.
4  *   Copyright 2005/2006 Red Hat, all rights reserved.
5  *
6  *   An ATA driver for the legacy ATA ports.
7  *
8  *   Data Sources:
9  *	Opti 82C465/82C611 support: Data sheets at opti-inc.com
10  *	HT6560 series:
11  *	Promise 20230/20620:
12  *		http://www.ryston.cz/petr/vlb/pdc20230b.html
13  *		http://www.ryston.cz/petr/vlb/pdc20230c.html
14  *		http://www.ryston.cz/petr/vlb/pdc20630.html
15  *	QDI65x0:
16  *		http://www.ryston.cz/petr/vlb/qd6500.html
17  *		http://www.ryston.cz/petr/vlb/qd6580.html
18  *
19  *	QDI65x0 probe code based on drivers/ide/legacy/qd65xx.c
20  *	Rewritten from the work of Colten Edwards <pje120@cs.usask.ca> by
21  *	Samuel Thibault <samuel.thibault@ens-lyon.org>
22  *
23  *  Unsupported but docs exist:
24  *	Appian/Adaptec AIC25VL01/Cirrus Logic PD7220
25  *
26  *  This driver handles legacy (that is "ISA/VLB side") IDE ports found
27  *  on PC class systems. There are three hybrid devices that are exceptions
28  *  The Cyrix 5510/5520 where a pre SFF ATA device is on the bridge and
29  *  the MPIIX where the tuning is PCI side but the IDE is "ISA side".
30  *
31  *  Specific support is included for the ht6560a/ht6560b/opti82c611a/
32  *  opti82c465mv/promise 20230c/20630/qdi65x0/winbond83759A
33  *
34  *  Support for the Winbond 83759A when operating in advanced mode.
35  *  Multichip mode is not currently supported.
36  *
37  *  Use the autospeed and pio_mask options with:
38  *	Appian ADI/2 aka CLPD7220 or AIC25VL01.
39  *  Use the jumpers, autospeed and set pio_mask to the mode on the jumpers with
40  *	Goldstar GM82C711, PIC-1288A-125, UMC 82C871F, Winbond W83759,
41  *	Winbond W83759A, Promise PDC20230-B
42  *
43  *  For now use autospeed and pio_mask as above with the W83759A. This may
44  *  change.
45  */
46 
47 #include <linux/async.h>
48 #include <linux/kernel.h>
49 #include <linux/module.h>
50 #include <linux/pci.h>
51 #include <linux/init.h>
52 #include <linux/blkdev.h>
53 #include <linux/delay.h>
54 #include <scsi/scsi_host.h>
55 #include <linux/ata.h>
56 #include <linux/libata.h>
57 #include <linux/platform_device.h>
58 
59 #define DRV_NAME "pata_legacy"
60 #define DRV_VERSION "0.6.5"
61 
62 #define NR_HOST 6
63 
64 static int all;
65 module_param(all, int, 0444);
66 MODULE_PARM_DESC(all, "Grab all legacy port devices, even if PCI(0=off, 1=on)");
67 
68 enum controller {
69 	BIOS = 0,
70 	SNOOP = 1,
71 	PDC20230 = 2,
72 	HT6560A = 3,
73 	HT6560B = 4,
74 	OPTI611A = 5,
75 	OPTI46X = 6,
76 	QDI6500 = 7,
77 	QDI6580 = 8,
78 	QDI6580DP = 9,		/* Dual channel mode is different */
79 	W83759A = 10,
80 
81 	UNKNOWN = -1
82 };
83 
84 struct legacy_data {
85 	unsigned long timing;
86 	u8 clock[2];
87 	u8 last;
88 	int fast;
89 	enum controller type;
90 	struct platform_device *platform_dev;
91 };
92 
93 struct legacy_probe {
94 	unsigned char *name;
95 	unsigned long port;
96 	unsigned int irq;
97 	unsigned int slot;
98 	enum controller type;
99 	unsigned long private;
100 };
101 
102 struct legacy_controller {
103 	const char *name;
104 	struct ata_port_operations *ops;
105 	unsigned int pio_mask;
106 	unsigned int flags;
107 	unsigned int pflags;
108 	int (*setup)(struct platform_device *, struct legacy_probe *probe,
109 		struct legacy_data *data);
110 };
111 
112 static int legacy_port[NR_HOST] = { 0x1f0, 0x170, 0x1e8, 0x168, 0x1e0, 0x160 };
113 
114 static struct legacy_probe probe_list[NR_HOST];
115 static struct legacy_data legacy_data[NR_HOST];
116 static struct ata_host *legacy_host[NR_HOST];
117 static int nr_legacy_host;
118 
119 
120 static int probe_all;		/* Set to check all ISA port ranges */
121 static int ht6560a;		/* HT 6560A on primary 1, second 2, both 3 */
122 static int ht6560b;		/* HT 6560A on primary 1, second 2, both 3 */
123 static int opti82c611a;		/* Opti82c611A on primary 1, sec 2, both 3 */
124 static int opti82c46x;		/* Opti 82c465MV present(pri/sec autodetect) */
125 static int autospeed;		/* Chip present which snoops speed changes */
126 static int pio_mask = ATA_PIO4;	/* PIO range for autospeed devices */
127 static int iordy_mask = 0xFFFFFFFF;	/* Use iordy if available */
128 
129 /* Set to probe QDI controllers */
130 #ifdef CONFIG_PATA_QDI_MODULE
131 static int qdi = 1;
132 #else
133 static int qdi;
134 #endif
135 
136 #ifdef CONFIG_PATA_WINBOND_VLB_MODULE
137 static int winbond = 1;		/* Set to probe Winbond controllers,
138 					give I/O port if non standard */
139 #else
140 static int winbond;		/* Set to probe Winbond controllers,
141 					give I/O port if non standard */
142 #endif
143 
144 /**
145  *	legacy_probe_add	-	Add interface to probe list
146  *	@port: Controller port
147  *	@irq: IRQ number
148  *	@type: Controller type
149  *	@private: Controller specific info
150  *
151  *	Add an entry into the probe list for ATA controllers. This is used
152  *	to add the default ISA slots and then to build up the table
153  *	further according to other ISA/VLB/Weird device scans
154  *
155  *	An I/O port list is used to keep ordering stable and sane, as we
156  *	don't have any good way to talk about ordering otherwise
157  */
158 
159 static int legacy_probe_add(unsigned long port, unsigned int irq,
160 				enum controller type, unsigned long private)
161 {
162 	struct legacy_probe *lp = &probe_list[0];
163 	int i;
164 	struct legacy_probe *free = NULL;
165 
166 	for (i = 0; i < NR_HOST; i++) {
167 		if (lp->port == 0 && free == NULL)
168 			free = lp;
169 		/* Matching port, or the correct slot for ordering */
170 		if (lp->port == port || legacy_port[i] == port) {
171 			free = lp;
172 			break;
173 		}
174 		lp++;
175 	}
176 	if (free == NULL) {
177 		printk(KERN_ERR "pata_legacy: Too many interfaces.\n");
178 		return -1;
179 	}
180 	/* Fill in the entry for later probing */
181 	free->port = port;
182 	free->irq = irq;
183 	free->type = type;
184 	free->private = private;
185 	return 0;
186 }
187 
188 
189 /**
190  *	legacy_set_mode		-	mode setting
191  *	@link: IDE link
192  *	@unused: Device that failed when error is returned
193  *
194  *	Use a non standard set_mode function. We don't want to be tuned.
195  *
196  *	The BIOS configured everything. Our job is not to fiddle. Just use
197  *	whatever PIO the hardware is using and leave it at that. When we
198  *	get some kind of nice user driven API for control then we can
199  *	expand on this as per hdparm in the base kernel.
200  */
201 
202 static int legacy_set_mode(struct ata_link *link, struct ata_device **unused)
203 {
204 	struct ata_device *dev;
205 
206 	ata_for_each_dev(dev, link, ENABLED) {
207 		ata_dev_info(dev, "configured for PIO\n");
208 		dev->pio_mode = XFER_PIO_0;
209 		dev->xfer_mode = XFER_PIO_0;
210 		dev->xfer_shift = ATA_SHIFT_PIO;
211 		dev->flags |= ATA_DFLAG_PIO;
212 	}
213 	return 0;
214 }
215 
216 static struct scsi_host_template legacy_sht = {
217 	ATA_PIO_SHT(DRV_NAME),
218 };
219 
220 static const struct ata_port_operations legacy_base_port_ops = {
221 	.inherits	= &ata_sff_port_ops,
222 	.cable_detect	= ata_cable_40wire,
223 };
224 
225 /*
226  *	These ops are used if the user indicates the hardware
227  *	snoops the commands to decide on the mode and handles the
228  *	mode selection "magically" itself. Several legacy controllers
229  *	do this. The mode range can be set if it is not 0x1F by setting
230  *	pio_mask as well.
231  */
232 
233 static struct ata_port_operations simple_port_ops = {
234 	.inherits	= &legacy_base_port_ops,
235 	.sff_data_xfer	= ata_sff_data_xfer32,
236 };
237 
238 static struct ata_port_operations legacy_port_ops = {
239 	.inherits	= &legacy_base_port_ops,
240 	.sff_data_xfer	= ata_sff_data_xfer32,
241 	.set_mode	= legacy_set_mode,
242 };
243 
244 /*
245  *	Promise 20230C and 20620 support
246  *
247  *	This controller supports PIO0 to PIO2. We set PIO timings
248  *	conservatively to allow for 50MHz Vesa Local Bus. The 20620 DMA
249  *	support is weird being DMA to controller and PIO'd to the host
250  *	and not supported.
251  */
252 
253 static void pdc20230_set_piomode(struct ata_port *ap, struct ata_device *adev)
254 {
255 	int tries = 5;
256 	int pio = adev->pio_mode - XFER_PIO_0;
257 	u8 rt;
258 	unsigned long flags;
259 
260 	/* Safe as UP only. Force I/Os to occur together */
261 
262 	local_irq_save(flags);
263 
264 	/* Unlock the control interface */
265 	do {
266 		inb(0x1F5);
267 		outb(inb(0x1F2) | 0x80, 0x1F2);
268 		inb(0x1F2);
269 		inb(0x3F6);
270 		inb(0x3F6);
271 		inb(0x1F2);
272 		inb(0x1F2);
273 	}
274 	while ((inb(0x1F2) & 0x80) && --tries);
275 
276 	local_irq_restore(flags);
277 
278 	outb(inb(0x1F4) & 0x07, 0x1F4);
279 
280 	rt = inb(0x1F3);
281 	rt &= 0x07 << (3 * adev->devno);
282 	if (pio)
283 		rt |= (1 + 3 * pio) << (3 * adev->devno);
284 
285 	udelay(100);
286 	outb(inb(0x1F2) | 0x01, 0x1F2);
287 	udelay(100);
288 	inb(0x1F5);
289 
290 }
291 
292 static unsigned int pdc_data_xfer_vlb(struct ata_queued_cmd *qc,
293 			unsigned char *buf, unsigned int buflen, int rw)
294 {
295 	struct ata_device *dev = qc->dev;
296 	struct ata_port *ap = dev->link->ap;
297 	int slop = buflen & 3;
298 
299 	/* 32bit I/O capable *and* we need to write a whole number of dwords */
300 	if (ata_id_has_dword_io(dev->id) && (slop == 0 || slop == 3)
301 					&& (ap->pflags & ATA_PFLAG_PIO32)) {
302 		unsigned long flags;
303 
304 		local_irq_save(flags);
305 
306 		/* Perform the 32bit I/O synchronization sequence */
307 		ioread8(ap->ioaddr.nsect_addr);
308 		ioread8(ap->ioaddr.nsect_addr);
309 		ioread8(ap->ioaddr.nsect_addr);
310 
311 		/* Now the data */
312 		if (rw == READ)
313 			ioread32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
314 		else
315 			iowrite32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
316 
317 		if (unlikely(slop)) {
318 			__le32 pad;
319 			if (rw == READ) {
320 				pad = cpu_to_le32(ioread32(ap->ioaddr.data_addr));
321 				memcpy(buf + buflen - slop, &pad, slop);
322 			} else {
323 				memcpy(&pad, buf + buflen - slop, slop);
324 				iowrite32(le32_to_cpu(pad), ap->ioaddr.data_addr);
325 			}
326 			buflen += 4 - slop;
327 		}
328 		local_irq_restore(flags);
329 	} else
330 		buflen = ata_sff_data_xfer32(qc, buf, buflen, rw);
331 
332 	return buflen;
333 }
334 
335 static struct ata_port_operations pdc20230_port_ops = {
336 	.inherits	= &legacy_base_port_ops,
337 	.set_piomode	= pdc20230_set_piomode,
338 	.sff_data_xfer	= pdc_data_xfer_vlb,
339 };
340 
341 /*
342  *	Holtek 6560A support
343  *
344  *	This controller supports PIO0 to PIO2 (no IORDY even though higher
345  *	timings can be loaded).
346  */
347 
348 static void ht6560a_set_piomode(struct ata_port *ap, struct ata_device *adev)
349 {
350 	u8 active, recover;
351 	struct ata_timing t;
352 
353 	/* Get the timing data in cycles. For now play safe at 50Mhz */
354 	ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
355 
356 	active = clamp_val(t.active, 2, 15);
357 	recover = clamp_val(t.recover, 4, 15);
358 
359 	inb(0x3E6);
360 	inb(0x3E6);
361 	inb(0x3E6);
362 	inb(0x3E6);
363 
364 	iowrite8(recover << 4 | active, ap->ioaddr.device_addr);
365 	ioread8(ap->ioaddr.status_addr);
366 }
367 
368 static struct ata_port_operations ht6560a_port_ops = {
369 	.inherits	= &legacy_base_port_ops,
370 	.set_piomode	= ht6560a_set_piomode,
371 };
372 
373 /*
374  *	Holtek 6560B support
375  *
376  *	This controller supports PIO0 to PIO4. We honour the BIOS/jumper FIFO
377  *	setting unless we see an ATAPI device in which case we force it off.
378  *
379  *	FIXME: need to implement 2nd channel support.
380  */
381 
382 static void ht6560b_set_piomode(struct ata_port *ap, struct ata_device *adev)
383 {
384 	u8 active, recover;
385 	struct ata_timing t;
386 
387 	/* Get the timing data in cycles. For now play safe at 50Mhz */
388 	ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
389 
390 	active = clamp_val(t.active, 2, 15);
391 	recover = clamp_val(t.recover, 2, 16) & 0x0F;
392 
393 	inb(0x3E6);
394 	inb(0x3E6);
395 	inb(0x3E6);
396 	inb(0x3E6);
397 
398 	iowrite8(recover << 4 | active, ap->ioaddr.device_addr);
399 
400 	if (adev->class != ATA_DEV_ATA) {
401 		u8 rconf = inb(0x3E6);
402 		if (rconf & 0x24) {
403 			rconf &= ~0x24;
404 			outb(rconf, 0x3E6);
405 		}
406 	}
407 	ioread8(ap->ioaddr.status_addr);
408 }
409 
410 static struct ata_port_operations ht6560b_port_ops = {
411 	.inherits	= &legacy_base_port_ops,
412 	.set_piomode	= ht6560b_set_piomode,
413 };
414 
415 /*
416  *	Opti core chipset helpers
417  */
418 
419 /**
420  *	opti_syscfg	-	read OPTI chipset configuration
421  *	@reg: Configuration register to read
422  *
423  *	Returns the value of an OPTI system board configuration register.
424  */
425 
426 static u8 opti_syscfg(u8 reg)
427 {
428 	unsigned long flags;
429 	u8 r;
430 
431 	/* Uniprocessor chipset and must force cycles adjancent */
432 	local_irq_save(flags);
433 	outb(reg, 0x22);
434 	r = inb(0x24);
435 	local_irq_restore(flags);
436 	return r;
437 }
438 
439 /*
440  *	Opti 82C611A
441  *
442  *	This controller supports PIO0 to PIO3.
443  */
444 
445 static void opti82c611a_set_piomode(struct ata_port *ap,
446 						struct ata_device *adev)
447 {
448 	u8 active, recover, setup;
449 	struct ata_timing t;
450 	struct ata_device *pair = ata_dev_pair(adev);
451 	int clock;
452 	int khz[4] = { 50000, 40000, 33000, 25000 };
453 	u8 rc;
454 
455 	/* Enter configuration mode */
456 	ioread16(ap->ioaddr.error_addr);
457 	ioread16(ap->ioaddr.error_addr);
458 	iowrite8(3, ap->ioaddr.nsect_addr);
459 
460 	/* Read VLB clock strapping */
461 	clock = 1000000000 / khz[ioread8(ap->ioaddr.lbah_addr) & 0x03];
462 
463 	/* Get the timing data in cycles */
464 	ata_timing_compute(adev, adev->pio_mode, &t, clock, 1000);
465 
466 	/* Setup timing is shared */
467 	if (pair) {
468 		struct ata_timing tp;
469 		ata_timing_compute(pair, pair->pio_mode, &tp, clock, 1000);
470 
471 		ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP);
472 	}
473 
474 	active = clamp_val(t.active, 2, 17) - 2;
475 	recover = clamp_val(t.recover, 1, 16) - 1;
476 	setup = clamp_val(t.setup, 1, 4) - 1;
477 
478 	/* Select the right timing bank for write timing */
479 	rc = ioread8(ap->ioaddr.lbal_addr);
480 	rc &= 0x7F;
481 	rc |= (adev->devno << 7);
482 	iowrite8(rc, ap->ioaddr.lbal_addr);
483 
484 	/* Write the timings */
485 	iowrite8(active << 4 | recover, ap->ioaddr.error_addr);
486 
487 	/* Select the right bank for read timings, also
488 	   load the shared timings for address */
489 	rc = ioread8(ap->ioaddr.device_addr);
490 	rc &= 0xC0;
491 	rc |= adev->devno;	/* Index select */
492 	rc |= (setup << 4) | 0x04;
493 	iowrite8(rc, ap->ioaddr.device_addr);
494 
495 	/* Load the read timings */
496 	iowrite8(active << 4 | recover, ap->ioaddr.data_addr);
497 
498 	/* Ensure the timing register mode is right */
499 	rc = ioread8(ap->ioaddr.lbal_addr);
500 	rc &= 0x73;
501 	rc |= 0x84;
502 	iowrite8(rc, ap->ioaddr.lbal_addr);
503 
504 	/* Exit command mode */
505 	iowrite8(0x83,  ap->ioaddr.nsect_addr);
506 }
507 
508 
509 static struct ata_port_operations opti82c611a_port_ops = {
510 	.inherits	= &legacy_base_port_ops,
511 	.set_piomode	= opti82c611a_set_piomode,
512 };
513 
514 /*
515  *	Opti 82C465MV
516  *
517  *	This controller supports PIO0 to PIO3. Unlike the 611A the MVB
518  *	version is dual channel but doesn't have a lot of unique registers.
519  */
520 
521 static void opti82c46x_set_piomode(struct ata_port *ap, struct ata_device *adev)
522 {
523 	u8 active, recover, setup;
524 	struct ata_timing t;
525 	struct ata_device *pair = ata_dev_pair(adev);
526 	int clock;
527 	int khz[4] = { 50000, 40000, 33000, 25000 };
528 	u8 rc;
529 	u8 sysclk;
530 
531 	/* Get the clock */
532 	sysclk = (opti_syscfg(0xAC) & 0xC0) >> 6;	/* BIOS set */
533 
534 	/* Enter configuration mode */
535 	ioread16(ap->ioaddr.error_addr);
536 	ioread16(ap->ioaddr.error_addr);
537 	iowrite8(3, ap->ioaddr.nsect_addr);
538 
539 	/* Read VLB clock strapping */
540 	clock = 1000000000 / khz[sysclk];
541 
542 	/* Get the timing data in cycles */
543 	ata_timing_compute(adev, adev->pio_mode, &t, clock, 1000);
544 
545 	/* Setup timing is shared */
546 	if (pair) {
547 		struct ata_timing tp;
548 		ata_timing_compute(pair, pair->pio_mode, &tp, clock, 1000);
549 
550 		ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP);
551 	}
552 
553 	active = clamp_val(t.active, 2, 17) - 2;
554 	recover = clamp_val(t.recover, 1, 16) - 1;
555 	setup = clamp_val(t.setup, 1, 4) - 1;
556 
557 	/* Select the right timing bank for write timing */
558 	rc = ioread8(ap->ioaddr.lbal_addr);
559 	rc &= 0x7F;
560 	rc |= (adev->devno << 7);
561 	iowrite8(rc, ap->ioaddr.lbal_addr);
562 
563 	/* Write the timings */
564 	iowrite8(active << 4 | recover, ap->ioaddr.error_addr);
565 
566 	/* Select the right bank for read timings, also
567 	   load the shared timings for address */
568 	rc = ioread8(ap->ioaddr.device_addr);
569 	rc &= 0xC0;
570 	rc |= adev->devno;	/* Index select */
571 	rc |= (setup << 4) | 0x04;
572 	iowrite8(rc, ap->ioaddr.device_addr);
573 
574 	/* Load the read timings */
575 	iowrite8(active << 4 | recover, ap->ioaddr.data_addr);
576 
577 	/* Ensure the timing register mode is right */
578 	rc = ioread8(ap->ioaddr.lbal_addr);
579 	rc &= 0x73;
580 	rc |= 0x84;
581 	iowrite8(rc, ap->ioaddr.lbal_addr);
582 
583 	/* Exit command mode */
584 	iowrite8(0x83,  ap->ioaddr.nsect_addr);
585 
586 	/* We need to know this for quad device on the MVB */
587 	ap->host->private_data = ap;
588 }
589 
590 /**
591  *	opt82c465mv_qc_issue		-	command issue
592  *	@qc: command pending
593  *
594  *	Called when the libata layer is about to issue a command. We wrap
595  *	this interface so that we can load the correct ATA timings. The
596  *	MVB has a single set of timing registers and these are shared
597  *	across channels. As there are two registers we really ought to
598  *	track the last two used values as a sort of register window. For
599  *	now we just reload on a channel switch. On the single channel
600  *	setup this condition never fires so we do nothing extra.
601  *
602  *	FIXME: dual channel needs ->serialize support
603  */
604 
605 static unsigned int opti82c46x_qc_issue(struct ata_queued_cmd *qc)
606 {
607 	struct ata_port *ap = qc->ap;
608 	struct ata_device *adev = qc->dev;
609 
610 	/* If timings are set and for the wrong channel (2nd test is
611 	   due to a libata shortcoming and will eventually go I hope) */
612 	if (ap->host->private_data != ap->host
613 	    && ap->host->private_data != NULL)
614 		opti82c46x_set_piomode(ap, adev);
615 
616 	return ata_sff_qc_issue(qc);
617 }
618 
619 static struct ata_port_operations opti82c46x_port_ops = {
620 	.inherits	= &legacy_base_port_ops,
621 	.set_piomode	= opti82c46x_set_piomode,
622 	.qc_issue	= opti82c46x_qc_issue,
623 };
624 
625 /**
626  *	qdi65x0_set_piomode		-	PIO setup for QDI65x0
627  *	@ap: Port
628  *	@adev: Device
629  *
630  *	In single channel mode the 6580 has one clock per device and we can
631  *	avoid the requirement to clock switch. We also have to load the timing
632  *	into the right clock according to whether we are master or slave.
633  *
634  *	In dual channel mode the 6580 has one clock per channel and we have
635  *	to software clockswitch in qc_issue.
636  */
637 
638 static void qdi65x0_set_piomode(struct ata_port *ap, struct ata_device *adev)
639 {
640 	struct ata_timing t;
641 	struct legacy_data *ld_qdi = ap->host->private_data;
642 	int active, recovery;
643 	u8 timing;
644 
645 	/* Get the timing data in cycles */
646 	ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
647 
648 	if (ld_qdi->fast) {
649 		active = 8 - clamp_val(t.active, 1, 8);
650 		recovery = 18 - clamp_val(t.recover, 3, 18);
651 	} else {
652 		active = 9 - clamp_val(t.active, 2, 9);
653 		recovery = 15 - clamp_val(t.recover, 0, 15);
654 	}
655 	timing = (recovery << 4) | active | 0x08;
656 	ld_qdi->clock[adev->devno] = timing;
657 
658 	if (ld_qdi->type == QDI6580)
659 		outb(timing, ld_qdi->timing + 2 * adev->devno);
660 	else
661 		outb(timing, ld_qdi->timing + 2 * ap->port_no);
662 
663 	/* Clear the FIFO */
664 	if (ld_qdi->type != QDI6500 && adev->class != ATA_DEV_ATA)
665 		outb(0x5F, (ld_qdi->timing & 0xFFF0) + 3);
666 }
667 
668 /**
669  *	qdi_qc_issue		-	command issue
670  *	@qc: command pending
671  *
672  *	Called when the libata layer is about to issue a command. We wrap
673  *	this interface so that we can load the correct ATA timings.
674  */
675 
676 static unsigned int qdi_qc_issue(struct ata_queued_cmd *qc)
677 {
678 	struct ata_port *ap = qc->ap;
679 	struct ata_device *adev = qc->dev;
680 	struct legacy_data *ld_qdi = ap->host->private_data;
681 
682 	if (ld_qdi->clock[adev->devno] != ld_qdi->last) {
683 		if (adev->pio_mode) {
684 			ld_qdi->last = ld_qdi->clock[adev->devno];
685 			outb(ld_qdi->clock[adev->devno], ld_qdi->timing +
686 							2 * ap->port_no);
687 		}
688 	}
689 	return ata_sff_qc_issue(qc);
690 }
691 
692 static unsigned int vlb32_data_xfer(struct ata_queued_cmd *qc,
693 				    unsigned char *buf,
694 				    unsigned int buflen, int rw)
695 {
696 	struct ata_device *adev = qc->dev;
697 	struct ata_port *ap = adev->link->ap;
698 	int slop = buflen & 3;
699 
700 	if (ata_id_has_dword_io(adev->id) && (slop == 0 || slop == 3)
701 					&& (ap->pflags & ATA_PFLAG_PIO32)) {
702 		if (rw == WRITE)
703 			iowrite32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
704 		else
705 			ioread32_rep(ap->ioaddr.data_addr, buf, buflen >> 2);
706 
707 		if (unlikely(slop)) {
708 			__le32 pad;
709 			if (rw == WRITE) {
710 				memcpy(&pad, buf + buflen - slop, slop);
711 				iowrite32(le32_to_cpu(pad), ap->ioaddr.data_addr);
712 			} else {
713 				pad = cpu_to_le32(ioread32(ap->ioaddr.data_addr));
714 				memcpy(buf + buflen - slop, &pad, slop);
715 			}
716 		}
717 		return (buflen + 3) & ~3;
718 	} else
719 		return ata_sff_data_xfer(qc, buf, buflen, rw);
720 }
721 
722 static int qdi_port(struct platform_device *dev,
723 			struct legacy_probe *lp, struct legacy_data *ld)
724 {
725 	if (devm_request_region(&dev->dev, lp->private, 4, "qdi") == NULL)
726 		return -EBUSY;
727 	ld->timing = lp->private;
728 	return 0;
729 }
730 
731 static struct ata_port_operations qdi6500_port_ops = {
732 	.inherits	= &legacy_base_port_ops,
733 	.set_piomode	= qdi65x0_set_piomode,
734 	.qc_issue	= qdi_qc_issue,
735 	.sff_data_xfer	= vlb32_data_xfer,
736 };
737 
738 static struct ata_port_operations qdi6580_port_ops = {
739 	.inherits	= &legacy_base_port_ops,
740 	.set_piomode	= qdi65x0_set_piomode,
741 	.sff_data_xfer	= vlb32_data_xfer,
742 };
743 
744 static struct ata_port_operations qdi6580dp_port_ops = {
745 	.inherits	= &legacy_base_port_ops,
746 	.set_piomode	= qdi65x0_set_piomode,
747 	.qc_issue	= qdi_qc_issue,
748 	.sff_data_xfer	= vlb32_data_xfer,
749 };
750 
751 static DEFINE_SPINLOCK(winbond_lock);
752 
753 static void winbond_writecfg(unsigned long port, u8 reg, u8 val)
754 {
755 	unsigned long flags;
756 	spin_lock_irqsave(&winbond_lock, flags);
757 	outb(reg, port + 0x01);
758 	outb(val, port + 0x02);
759 	spin_unlock_irqrestore(&winbond_lock, flags);
760 }
761 
762 static u8 winbond_readcfg(unsigned long port, u8 reg)
763 {
764 	u8 val;
765 
766 	unsigned long flags;
767 	spin_lock_irqsave(&winbond_lock, flags);
768 	outb(reg, port + 0x01);
769 	val = inb(port + 0x02);
770 	spin_unlock_irqrestore(&winbond_lock, flags);
771 
772 	return val;
773 }
774 
775 static void winbond_set_piomode(struct ata_port *ap, struct ata_device *adev)
776 {
777 	struct ata_timing t;
778 	struct legacy_data *ld_winbond = ap->host->private_data;
779 	int active, recovery;
780 	u8 reg;
781 	int timing = 0x88 + (ap->port_no * 4) + (adev->devno * 2);
782 
783 	reg = winbond_readcfg(ld_winbond->timing, 0x81);
784 
785 	/* Get the timing data in cycles */
786 	if (reg & 0x40)		/* Fast VLB bus, assume 50MHz */
787 		ata_timing_compute(adev, adev->pio_mode, &t, 20000, 1000);
788 	else
789 		ata_timing_compute(adev, adev->pio_mode, &t, 30303, 1000);
790 
791 	active = (clamp_val(t.active, 3, 17) - 1) & 0x0F;
792 	recovery = (clamp_val(t.recover, 1, 15) + 1) & 0x0F;
793 	timing = (active << 4) | recovery;
794 	winbond_writecfg(ld_winbond->timing, timing, reg);
795 
796 	/* Load the setup timing */
797 
798 	reg = 0x35;
799 	if (adev->class != ATA_DEV_ATA)
800 		reg |= 0x08;	/* FIFO off */
801 	if (!ata_pio_need_iordy(adev))
802 		reg |= 0x02;	/* IORDY off */
803 	reg |= (clamp_val(t.setup, 0, 3) << 6);
804 	winbond_writecfg(ld_winbond->timing, timing + 1, reg);
805 }
806 
807 static int winbond_port(struct platform_device *dev,
808 			struct legacy_probe *lp, struct legacy_data *ld)
809 {
810 	if (devm_request_region(&dev->dev, lp->private, 4, "winbond") == NULL)
811 		return -EBUSY;
812 	ld->timing = lp->private;
813 	return 0;
814 }
815 
816 static struct ata_port_operations winbond_port_ops = {
817 	.inherits	= &legacy_base_port_ops,
818 	.set_piomode	= winbond_set_piomode,
819 	.sff_data_xfer	= vlb32_data_xfer,
820 };
821 
822 static struct legacy_controller controllers[] = {
823 	{"BIOS",	&legacy_port_ops, 	ATA_PIO4,
824 			ATA_FLAG_NO_IORDY,	0,			NULL },
825 	{"Snooping", 	&simple_port_ops, 	ATA_PIO4,
826 			0,			0,			NULL },
827 	{"PDC20230",	&pdc20230_port_ops,	ATA_PIO2,
828 			ATA_FLAG_NO_IORDY,
829 			ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE,	NULL },
830 	{"HT6560A",	&ht6560a_port_ops,	ATA_PIO2,
831 			ATA_FLAG_NO_IORDY,	0,			NULL },
832 	{"HT6560B",	&ht6560b_port_ops,	ATA_PIO4,
833 			ATA_FLAG_NO_IORDY,	0,			NULL },
834 	{"OPTI82C611A",	&opti82c611a_port_ops,	ATA_PIO3,
835 			0,			0,			NULL },
836 	{"OPTI82C46X",	&opti82c46x_port_ops,	ATA_PIO3,
837 			0,			0,			NULL },
838 	{"QDI6500",	&qdi6500_port_ops,	ATA_PIO2,
839 			ATA_FLAG_NO_IORDY,
840 			ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE,    qdi_port },
841 	{"QDI6580",	&qdi6580_port_ops,	ATA_PIO4,
842 			0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE, qdi_port },
843 	{"QDI6580DP",	&qdi6580dp_port_ops,	ATA_PIO4,
844 			0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE, qdi_port },
845 	{"W83759A",	&winbond_port_ops,	ATA_PIO4,
846 			0, ATA_PFLAG_PIO32 | ATA_PFLAG_PIO32CHANGE,
847 								winbond_port }
848 };
849 
850 /**
851  *	probe_chip_type		-	Discover controller
852  *	@probe: Probe entry to check
853  *
854  *	Probe an ATA port and identify the type of controller. We don't
855  *	check if the controller appears to be driveless at this point.
856  */
857 
858 static __init int probe_chip_type(struct legacy_probe *probe)
859 {
860 	int mask = 1 << probe->slot;
861 
862 	if (winbond && (probe->port == 0x1F0 || probe->port == 0x170)) {
863 		u8 reg = winbond_readcfg(winbond, 0x81);
864 		reg |= 0x80;	/* jumpered mode off */
865 		winbond_writecfg(winbond, 0x81, reg);
866 		reg = winbond_readcfg(winbond, 0x83);
867 		reg |= 0xF0;	/* local control */
868 		winbond_writecfg(winbond, 0x83, reg);
869 		reg = winbond_readcfg(winbond, 0x85);
870 		reg |= 0xF0;	/* programmable timing */
871 		winbond_writecfg(winbond, 0x85, reg);
872 
873 		reg = winbond_readcfg(winbond, 0x81);
874 
875 		if (reg & mask)
876 			return W83759A;
877 	}
878 	if (probe->port == 0x1F0) {
879 		unsigned long flags;
880 		local_irq_save(flags);
881 		/* Probes */
882 		outb(inb(0x1F2) | 0x80, 0x1F2);
883 		inb(0x1F5);
884 		inb(0x1F2);
885 		inb(0x3F6);
886 		inb(0x3F6);
887 		inb(0x1F2);
888 		inb(0x1F2);
889 
890 		if ((inb(0x1F2) & 0x80) == 0) {
891 			/* PDC20230c or 20630 ? */
892 			printk(KERN_INFO  "PDC20230-C/20630 VLB ATA controller"
893 							" detected.\n");
894 			udelay(100);
895 			inb(0x1F5);
896 			local_irq_restore(flags);
897 			return PDC20230;
898 		} else {
899 			outb(0x55, 0x1F2);
900 			inb(0x1F2);
901 			inb(0x1F2);
902 			if (inb(0x1F2) == 0x00)
903 				printk(KERN_INFO "PDC20230-B VLB ATA "
904 						     "controller detected.\n");
905 			local_irq_restore(flags);
906 			return BIOS;
907 		}
908 	}
909 
910 	if (ht6560a & mask)
911 		return HT6560A;
912 	if (ht6560b & mask)
913 		return HT6560B;
914 	if (opti82c611a & mask)
915 		return OPTI611A;
916 	if (opti82c46x & mask)
917 		return OPTI46X;
918 	if (autospeed & mask)
919 		return SNOOP;
920 	return BIOS;
921 }
922 
923 
924 /**
925  *	legacy_init_one		-	attach a legacy interface
926  *	@pl: probe record
927  *
928  *	Register an ISA bus IDE interface. Such interfaces are PIO and we
929  *	assume do not support IRQ sharing.
930  */
931 
932 static __init int legacy_init_one(struct legacy_probe *probe)
933 {
934 	struct legacy_controller *controller = &controllers[probe->type];
935 	int pio_modes = controller->pio_mask;
936 	unsigned long io = probe->port;
937 	u32 mask = (1 << probe->slot);
938 	struct ata_port_operations *ops = controller->ops;
939 	struct legacy_data *ld = &legacy_data[probe->slot];
940 	struct ata_host *host = NULL;
941 	struct ata_port *ap;
942 	struct platform_device *pdev;
943 	struct ata_device *dev;
944 	void __iomem *io_addr, *ctrl_addr;
945 	u32 iordy = (iordy_mask & mask) ? 0: ATA_FLAG_NO_IORDY;
946 	int ret;
947 
948 	iordy |= controller->flags;
949 
950 	pdev = platform_device_register_simple(DRV_NAME, probe->slot, NULL, 0);
951 	if (IS_ERR(pdev))
952 		return PTR_ERR(pdev);
953 
954 	ret = -EBUSY;
955 	if (devm_request_region(&pdev->dev, io, 8, "pata_legacy") == NULL ||
956 	    devm_request_region(&pdev->dev, io + 0x0206, 1,
957 							"pata_legacy") == NULL)
958 		goto fail;
959 
960 	ret = -ENOMEM;
961 	io_addr = devm_ioport_map(&pdev->dev, io, 8);
962 	ctrl_addr = devm_ioport_map(&pdev->dev, io + 0x0206, 1);
963 	if (!io_addr || !ctrl_addr)
964 		goto fail;
965 	ld->type = probe->type;
966 	if (controller->setup)
967 		if (controller->setup(pdev, probe, ld) < 0)
968 			goto fail;
969 	host = ata_host_alloc(&pdev->dev, 1);
970 	if (!host)
971 		goto fail;
972 	ap = host->ports[0];
973 
974 	ap->ops = ops;
975 	ap->pio_mask = pio_modes;
976 	ap->flags |= ATA_FLAG_SLAVE_POSS | iordy;
977 	ap->pflags |= controller->pflags;
978 	ap->ioaddr.cmd_addr = io_addr;
979 	ap->ioaddr.altstatus_addr = ctrl_addr;
980 	ap->ioaddr.ctl_addr = ctrl_addr;
981 	ata_sff_std_ports(&ap->ioaddr);
982 	ap->host->private_data = ld;
983 
984 	ata_port_desc(ap, "cmd 0x%lx ctl 0x%lx", io, io + 0x0206);
985 
986 	ret = ata_host_activate(host, probe->irq, ata_sff_interrupt, 0,
987 				&legacy_sht);
988 	if (ret)
989 		goto fail;
990 	async_synchronize_full();
991 	ld->platform_dev = pdev;
992 
993 	/* Nothing found means we drop the port as its probably not there */
994 
995 	ret = -ENODEV;
996 	ata_for_each_dev(dev, &ap->link, ALL) {
997 		if (!ata_dev_absent(dev)) {
998 			legacy_host[probe->slot] = host;
999 			ld->platform_dev = pdev;
1000 			return 0;
1001 		}
1002 	}
1003 	ata_host_detach(host);
1004 fail:
1005 	platform_device_unregister(pdev);
1006 	return ret;
1007 }
1008 
1009 /**
1010  *	legacy_check_special_cases	-	ATA special cases
1011  *	@p: PCI device to check
1012  *	@master: set this if we find an ATA master
1013  *	@master: set this if we find an ATA secondary
1014  *
1015  *	A small number of vendors implemented early PCI ATA interfaces
1016  *	on bridge logic without the ATA interface being PCI visible.
1017  *	Where we have a matching PCI driver we must skip the relevant
1018  *	device here. If we don't know about it then the legacy driver
1019  *	is the right driver anyway.
1020  */
1021 
1022 static void __init legacy_check_special_cases(struct pci_dev *p, int *primary,
1023 								int *secondary)
1024 {
1025 	/* Cyrix CS5510 pre SFF MWDMA ATA on the bridge */
1026 	if (p->vendor == 0x1078 && p->device == 0x0000) {
1027 		*primary = *secondary = 1;
1028 		return;
1029 	}
1030 	/* Cyrix CS5520 pre SFF MWDMA ATA on the bridge */
1031 	if (p->vendor == 0x1078 && p->device == 0x0002) {
1032 		*primary = *secondary = 1;
1033 		return;
1034 	}
1035 	/* Intel MPIIX - PIO ATA on non PCI side of bridge */
1036 	if (p->vendor == 0x8086 && p->device == 0x1234) {
1037 		u16 r;
1038 		pci_read_config_word(p, 0x6C, &r);
1039 		if (r & 0x8000) {
1040 			/* ATA port enabled */
1041 			if (r & 0x4000)
1042 				*secondary = 1;
1043 			else
1044 				*primary = 1;
1045 		}
1046 		return;
1047 	}
1048 }
1049 
1050 static __init void probe_opti_vlb(void)
1051 {
1052 	/* If an OPTI 82C46X is present find out where the channels are */
1053 	static const char *optis[4] = {
1054 		"3/463MV", "5MV",
1055 		"5MVA", "5MVB"
1056 	};
1057 	u8 chans = 1;
1058 	u8 ctrl = (opti_syscfg(0x30) & 0xC0) >> 6;
1059 
1060 	opti82c46x = 3;	/* Assume master and slave first */
1061 	printk(KERN_INFO DRV_NAME ": Opti 82C46%s chipset support.\n",
1062 								optis[ctrl]);
1063 	if (ctrl == 3)
1064 		chans = (opti_syscfg(0x3F) & 0x20) ? 2 : 1;
1065 	ctrl = opti_syscfg(0xAC);
1066 	/* Check enabled and this port is the 465MV port. On the
1067 	   MVB we may have two channels */
1068 	if (ctrl & 8) {
1069 		if (chans == 2) {
1070 			legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1071 			legacy_probe_add(0x170, 15, OPTI46X, 0);
1072 		}
1073 		if (ctrl & 4)
1074 			legacy_probe_add(0x170, 15, OPTI46X, 0);
1075 		else
1076 			legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1077 	} else
1078 		legacy_probe_add(0x1F0, 14, OPTI46X, 0);
1079 }
1080 
1081 static __init void qdi65_identify_port(u8 r, u8 res, unsigned long port)
1082 {
1083 	static const unsigned long ide_port[2] = { 0x170, 0x1F0 };
1084 	/* Check card type */
1085 	if ((r & 0xF0) == 0xC0) {
1086 		/* QD6500: single channel */
1087 		if (r & 8)
1088 			/* Disabled ? */
1089 			return;
1090 		legacy_probe_add(ide_port[r & 0x01], 14 + (r & 0x01),
1091 								QDI6500, port);
1092 	}
1093 	if (((r & 0xF0) == 0xA0) || (r & 0xF0) == 0x50) {
1094 		/* QD6580: dual channel */
1095 		if (!request_region(port + 2 , 2, "pata_qdi")) {
1096 			release_region(port, 2);
1097 			return;
1098 		}
1099 		res = inb(port + 3);
1100 		/* Single channel mode ? */
1101 		if (res & 1)
1102 			legacy_probe_add(ide_port[r & 0x01], 14 + (r & 0x01),
1103 								QDI6580, port);
1104 		else { /* Dual channel mode */
1105 			legacy_probe_add(0x1F0, 14, QDI6580DP, port);
1106 			/* port + 0x02, r & 0x04 */
1107 			legacy_probe_add(0x170, 15, QDI6580DP, port + 2);
1108 		}
1109 		release_region(port + 2, 2);
1110 	}
1111 }
1112 
1113 static __init void probe_qdi_vlb(void)
1114 {
1115 	unsigned long flags;
1116 	static const unsigned long qd_port[2] = { 0x30, 0xB0 };
1117 	int i;
1118 
1119 	/*
1120 	 *	Check each possible QD65xx base address
1121 	 */
1122 
1123 	for (i = 0; i < 2; i++) {
1124 		unsigned long port = qd_port[i];
1125 		u8 r, res;
1126 
1127 
1128 		if (request_region(port, 2, "pata_qdi")) {
1129 			/* Check for a card */
1130 			local_irq_save(flags);
1131 			/* I have no h/w that needs this delay but it
1132 			   is present in the historic code */
1133 			r = inb(port);
1134 			udelay(1);
1135 			outb(0x19, port);
1136 			udelay(1);
1137 			res = inb(port);
1138 			udelay(1);
1139 			outb(r, port);
1140 			udelay(1);
1141 			local_irq_restore(flags);
1142 
1143 			/* Fail */
1144 			if (res == 0x19) {
1145 				release_region(port, 2);
1146 				continue;
1147 			}
1148 			/* Passes the presence test */
1149 			r = inb(port + 1);
1150 			udelay(1);
1151 			/* Check port agrees with port set */
1152 			if ((r & 2) >> 1 == i)
1153 				qdi65_identify_port(r, res, port);
1154 			release_region(port, 2);
1155 		}
1156 	}
1157 }
1158 
1159 /**
1160  *	legacy_init		-	attach legacy interfaces
1161  *
1162  *	Attach legacy IDE interfaces by scanning the usual IRQ/port suspects.
1163  *	Right now we do not scan the ide0 and ide1 address but should do so
1164  *	for non PCI systems or systems with no PCI IDE legacy mode devices.
1165  *	If you fix that note there are special cases to consider like VLB
1166  *	drivers and CS5510/20.
1167  */
1168 
1169 static __init int legacy_init(void)
1170 {
1171 	int i;
1172 	int ct = 0;
1173 	int primary = 0;
1174 	int secondary = 0;
1175 	int pci_present = 0;
1176 	struct legacy_probe *pl = &probe_list[0];
1177 	int slot = 0;
1178 
1179 	struct pci_dev *p = NULL;
1180 
1181 	for_each_pci_dev(p) {
1182 		int r;
1183 		/* Check for any overlap of the system ATA mappings. Native
1184 		   mode controllers stuck on these addresses or some devices
1185 		   in 'raid' mode won't be found by the storage class test */
1186 		for (r = 0; r < 6; r++) {
1187 			if (pci_resource_start(p, r) == 0x1f0)
1188 				primary = 1;
1189 			if (pci_resource_start(p, r) == 0x170)
1190 				secondary = 1;
1191 		}
1192 		/* Check for special cases */
1193 		legacy_check_special_cases(p, &primary, &secondary);
1194 
1195 		/* If PCI bus is present then don't probe for tertiary
1196 		   legacy ports */
1197 		pci_present = 1;
1198 	}
1199 
1200 	if (winbond == 1)
1201 		winbond = 0x130;	/* Default port, alt is 1B0 */
1202 
1203 	if (primary == 0 || all)
1204 		legacy_probe_add(0x1F0, 14, UNKNOWN, 0);
1205 	if (secondary == 0 || all)
1206 		legacy_probe_add(0x170, 15, UNKNOWN, 0);
1207 
1208 	if (probe_all || !pci_present) {
1209 		/* ISA/VLB extra ports */
1210 		legacy_probe_add(0x1E8, 11, UNKNOWN, 0);
1211 		legacy_probe_add(0x168, 10, UNKNOWN, 0);
1212 		legacy_probe_add(0x1E0, 8, UNKNOWN, 0);
1213 		legacy_probe_add(0x160, 12, UNKNOWN, 0);
1214 	}
1215 
1216 	if (opti82c46x)
1217 		probe_opti_vlb();
1218 	if (qdi)
1219 		probe_qdi_vlb();
1220 
1221 	for (i = 0; i < NR_HOST; i++, pl++) {
1222 		if (pl->port == 0)
1223 			continue;
1224 		if (pl->type == UNKNOWN)
1225 			pl->type = probe_chip_type(pl);
1226 		pl->slot = slot++;
1227 		if (legacy_init_one(pl) == 0)
1228 			ct++;
1229 	}
1230 	if (ct != 0)
1231 		return 0;
1232 	return -ENODEV;
1233 }
1234 
1235 static __exit void legacy_exit(void)
1236 {
1237 	int i;
1238 
1239 	for (i = 0; i < nr_legacy_host; i++) {
1240 		struct legacy_data *ld = &legacy_data[i];
1241 		ata_host_detach(legacy_host[i]);
1242 		platform_device_unregister(ld->platform_dev);
1243 	}
1244 }
1245 
1246 MODULE_AUTHOR("Alan Cox");
1247 MODULE_DESCRIPTION("low-level driver for legacy ATA");
1248 MODULE_LICENSE("GPL");
1249 MODULE_VERSION(DRV_VERSION);
1250 MODULE_ALIAS("pata_qdi");
1251 MODULE_ALIAS("pata_winbond");
1252 
1253 module_param(probe_all, int, 0);
1254 module_param(autospeed, int, 0);
1255 module_param(ht6560a, int, 0);
1256 module_param(ht6560b, int, 0);
1257 module_param(opti82c611a, int, 0);
1258 module_param(opti82c46x, int, 0);
1259 module_param(qdi, int, 0);
1260 module_param(winbond, int, 0);
1261 module_param(pio_mask, int, 0);
1262 module_param(iordy_mask, int, 0);
1263 
1264 module_init(legacy_init);
1265 module_exit(legacy_exit);
1266