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