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
legacy_probe_add(unsigned long port,unsigned int irq,enum controller type,unsigned long private)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
legacy_set_mode(struct ata_link * link,struct ata_device ** unused)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
pdc20230_set_piomode(struct ata_port * ap,struct ata_device * adev)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
pdc_data_xfer_vlb(struct ata_queued_cmd * qc,unsigned char * buf,unsigned int buflen,int rw)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
ht6560a_set_piomode(struct ata_port * ap,struct ata_device * adev)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
ht6560b_set_piomode(struct ata_port * ap,struct ata_device * adev)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
opti_syscfg(u8 reg)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
opti82c611a_set_piomode(struct ata_port * ap,struct ata_device * adev)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
opti82c46x_set_piomode(struct ata_port * ap,struct ata_device * adev)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
opti82c46x_qc_issue(struct ata_queued_cmd * qc)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
qdi65x0_set_piomode(struct ata_port * ap,struct ata_device * adev)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
qdi_qc_issue(struct ata_queued_cmd * qc)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
vlb32_data_xfer(struct ata_queued_cmd * qc,unsigned char * buf,unsigned int buflen,int rw)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
qdi_port(struct platform_device * dev,struct legacy_probe * lp,struct legacy_data * ld)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
winbond_writecfg(unsigned long port,u8 reg,u8 val)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
winbond_readcfg(unsigned long port,u8 reg)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
winbond_set_piomode(struct ata_port * ap,struct ata_device * adev)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
winbond_port(struct platform_device * dev,struct legacy_probe * lp,struct legacy_data * ld)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
probe_chip_type(struct legacy_probe * probe)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
legacy_init_one(struct legacy_probe * probe)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
legacy_check_special_cases(struct pci_dev * p,int * primary,int * secondary)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
probe_opti_vlb(void)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
qdi65_identify_port(u8 r,u8 res,unsigned long port)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
probe_qdi_vlb(void)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
legacy_init(void)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
legacy_exit(void)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