]> Pileus Git - ~andy/linux/blob - drivers/ide/siimage.c
siimage: use ide_dma_test_irq() (take 2)
[~andy/linux] / drivers / ide / siimage.c
1 /*
2  * Copyright (C) 2001-2002      Andre Hedrick <andre@linux-ide.org>
3  * Copyright (C) 2003           Red Hat
4  * Copyright (C) 2007-2008      MontaVista Software, Inc.
5  * Copyright (C) 2007-2008      Bartlomiej Zolnierkiewicz
6  *
7  *  May be copied or modified under the terms of the GNU General Public License
8  *
9  *  Documentation for CMD680:
10  *  http://gkernel.sourceforge.net/specs/sii/sii-0680a-v1.31.pdf.bz2
11  *
12  *  Documentation for SiI 3112:
13  *  http://gkernel.sourceforge.net/specs/sii/3112A_SiI-DS-0095-B2.pdf.bz2
14  *
15  *  Errata and other documentation only available under NDA.
16  *
17  *
18  *  FAQ Items:
19  *      If you are using Marvell SATA-IDE adapters with Maxtor drives
20  *      ensure the system is set up for ATA100/UDMA5, not UDMA6.
21  *
22  *      If you are using WD drives with SATA bridges you must set the
23  *      drive to "Single". "Master" will hang.
24  *
25  *      If you have strange problems with nVidia chipset systems please
26  *      see the SI support documentation and update your system BIOS
27  *      if necessary
28  *
29  *  The Dell DRAC4 has some interesting features including effectively hot
30  *  unplugging/replugging the virtual CD interface when the DRAC is reset.
31  *  This often causes drivers/ide/siimage to panic but is ok with the rather
32  *  smarter code in libata.
33  *
34  * TODO:
35  * - VDMA support
36  */
37
38 #include <linux/types.h>
39 #include <linux/module.h>
40 #include <linux/pci.h>
41 #include <linux/ide.h>
42 #include <linux/init.h>
43 #include <linux/io.h>
44
45 #define DRV_NAME "siimage"
46
47 /**
48  *      pdev_is_sata            -       check if device is SATA
49  *      @pdev:  PCI device to check
50  *
51  *      Returns true if this is a SATA controller
52  */
53
54 static int pdev_is_sata(struct pci_dev *pdev)
55 {
56 #ifdef CONFIG_BLK_DEV_IDE_SATA
57         switch (pdev->device) {
58         case PCI_DEVICE_ID_SII_3112:
59         case PCI_DEVICE_ID_SII_1210SA:
60                 return 1;
61         case PCI_DEVICE_ID_SII_680:
62                 return 0;
63         }
64         BUG();
65 #endif
66         return 0;
67 }
68
69 /**
70  *      is_sata                 -       check if hwif is SATA
71  *      @hwif:  interface to check
72  *
73  *      Returns true if this is a SATA controller
74  */
75
76 static inline int is_sata(ide_hwif_t *hwif)
77 {
78         return pdev_is_sata(to_pci_dev(hwif->dev));
79 }
80
81 /**
82  *      siimage_selreg          -       return register base
83  *      @hwif: interface
84  *      @r: config offset
85  *
86  *      Turn a config register offset into the right address in either
87  *      PCI space or MMIO space to access the control register in question
88  *      Thankfully this is a configuration operation, so isn't performance
89  *      critical.
90  */
91
92 static unsigned long siimage_selreg(ide_hwif_t *hwif, int r)
93 {
94         unsigned long base = (unsigned long)hwif->hwif_data;
95
96         base += 0xA0 + r;
97         if (hwif->host_flags & IDE_HFLAG_MMIO)
98                 base += hwif->channel << 6;
99         else
100                 base += hwif->channel << 4;
101         return base;
102 }
103
104 /**
105  *      siimage_seldev          -       return register base
106  *      @hwif: interface
107  *      @r: config offset
108  *
109  *      Turn a config register offset into the right address in either
110  *      PCI space or MMIO space to access the control register in question
111  *      including accounting for the unit shift.
112  */
113
114 static inline unsigned long siimage_seldev(ide_drive_t *drive, int r)
115 {
116         ide_hwif_t *hwif        = drive->hwif;
117         unsigned long base      = (unsigned long)hwif->hwif_data;
118         u8 unit                 = drive->dn & 1;
119
120         base += 0xA0 + r;
121         if (hwif->host_flags & IDE_HFLAG_MMIO)
122                 base += hwif->channel << 6;
123         else
124                 base += hwif->channel << 4;
125         base |= unit << unit;
126         return base;
127 }
128
129 static u8 sil_ioread8(struct pci_dev *dev, unsigned long addr)
130 {
131         struct ide_host *host = pci_get_drvdata(dev);
132         u8 tmp = 0;
133
134         if (host->host_priv)
135                 tmp = readb((void __iomem *)addr);
136         else
137                 pci_read_config_byte(dev, addr, &tmp);
138
139         return tmp;
140 }
141
142 static u16 sil_ioread16(struct pci_dev *dev, unsigned long addr)
143 {
144         struct ide_host *host = pci_get_drvdata(dev);
145         u16 tmp = 0;
146
147         if (host->host_priv)
148                 tmp = readw((void __iomem *)addr);
149         else
150                 pci_read_config_word(dev, addr, &tmp);
151
152         return tmp;
153 }
154
155 static void sil_iowrite8(struct pci_dev *dev, u8 val, unsigned long addr)
156 {
157         struct ide_host *host = pci_get_drvdata(dev);
158
159         if (host->host_priv)
160                 writeb(val, (void __iomem *)addr);
161         else
162                 pci_write_config_byte(dev, addr, val);
163 }
164
165 static void sil_iowrite16(struct pci_dev *dev, u16 val, unsigned long addr)
166 {
167         struct ide_host *host = pci_get_drvdata(dev);
168
169         if (host->host_priv)
170                 writew(val, (void __iomem *)addr);
171         else
172                 pci_write_config_word(dev, addr, val);
173 }
174
175 static void sil_iowrite32(struct pci_dev *dev, u32 val, unsigned long addr)
176 {
177         struct ide_host *host = pci_get_drvdata(dev);
178
179         if (host->host_priv)
180                 writel(val, (void __iomem *)addr);
181         else
182                 pci_write_config_dword(dev, addr, val);
183 }
184
185 /**
186  *      sil_udma_filter         -       compute UDMA mask
187  *      @drive: IDE device
188  *
189  *      Compute the available UDMA speeds for the device on the interface.
190  *
191  *      For the CMD680 this depends on the clocking mode (scsc), for the
192  *      SI3112 SATA controller life is a bit simpler.
193  */
194
195 static u8 sil_pata_udma_filter(ide_drive_t *drive)
196 {
197         ide_hwif_t *hwif        = drive->hwif;
198         struct pci_dev *dev     = to_pci_dev(hwif->dev);
199         unsigned long base      = (unsigned long)hwif->hwif_data;
200         u8 scsc, mask           = 0;
201
202         base += (hwif->host_flags & IDE_HFLAG_MMIO) ? 0x4A : 0x8A;
203
204         scsc = sil_ioread8(dev, base);
205
206         switch (scsc & 0x30) {
207         case 0x10:      /* 133 */
208                 mask = ATA_UDMA6;
209                 break;
210         case 0x20:      /* 2xPCI */
211                 mask = ATA_UDMA6;
212                 break;
213         case 0x00:      /* 100 */
214                 mask = ATA_UDMA5;
215                 break;
216         default:        /* Disabled ? */
217                 BUG();
218         }
219
220         return mask;
221 }
222
223 static u8 sil_sata_udma_filter(ide_drive_t *drive)
224 {
225         char *m = (char *)&drive->id[ATA_ID_PROD];
226
227         return strstr(m, "Maxtor") ? ATA_UDMA5 : ATA_UDMA6;
228 }
229
230 /**
231  *      sil_set_pio_mode        -       set host controller for PIO mode
232  *      @drive: drive
233  *      @pio: PIO mode number
234  *
235  *      Load the timing settings for this device mode into the
236  *      controller.
237  */
238
239 static void sil_set_pio_mode(ide_drive_t *drive, u8 pio)
240 {
241         static const u16 tf_speed[]   = { 0x328a, 0x2283, 0x1281, 0x10c3, 0x10c1 };
242         static const u16 data_speed[] = { 0x328a, 0x2283, 0x1104, 0x10c3, 0x10c1 };
243
244         ide_hwif_t *hwif        = drive->hwif;
245         struct pci_dev *dev     = to_pci_dev(hwif->dev);
246         ide_drive_t *pair       = ide_get_pair_dev(drive);
247         u32 speedt              = 0;
248         u16 speedp              = 0;
249         unsigned long addr      = siimage_seldev(drive, 0x04);
250         unsigned long tfaddr    = siimage_selreg(hwif,  0x02);
251         unsigned long base      = (unsigned long)hwif->hwif_data;
252         u8 tf_pio               = pio;
253         u8 mmio                 = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
254         u8 addr_mask            = hwif->channel ? (mmio ? 0xF4 : 0x84)
255                                                 : (mmio ? 0xB4 : 0x80);
256         u8 mode                 = 0;
257         u8 unit                 = drive->dn & 1;
258
259         /* trim *taskfile* PIO to the slowest of the master/slave */
260         if (pair) {
261                 u8 pair_pio = ide_get_best_pio_mode(pair, 255, 4);
262
263                 if (pair_pio < tf_pio)
264                         tf_pio = pair_pio;
265         }
266
267         /* cheat for now and use the docs */
268         speedp = data_speed[pio];
269         speedt = tf_speed[tf_pio];
270
271         sil_iowrite16(dev, speedp, addr);
272         sil_iowrite16(dev, speedt, tfaddr);
273
274         /* now set up IORDY */
275         speedp = sil_ioread16(dev, tfaddr - 2);
276         speedp &= ~0x200;
277
278         mode = sil_ioread8(dev, base + addr_mask);
279         mode &= ~(unit ? 0x30 : 0x03);
280
281         if (ide_pio_need_iordy(drive, pio)) {
282                 speedp |= 0x200;
283                 mode |= unit ? 0x10 : 0x01;
284         }
285
286         sil_iowrite16(dev, speedp, tfaddr - 2);
287         sil_iowrite8(dev, mode, base + addr_mask);
288 }
289
290 /**
291  *      sil_set_dma_mode        -       set host controller for DMA mode
292  *      @drive: drive
293  *      @speed: DMA mode
294  *
295  *      Tune the SiI chipset for the desired DMA mode.
296  */
297
298 static void sil_set_dma_mode(ide_drive_t *drive, const u8 speed)
299 {
300         static const u8 ultra6[] = { 0x0F, 0x0B, 0x07, 0x05, 0x03, 0x02, 0x01 };
301         static const u8 ultra5[] = { 0x0C, 0x07, 0x05, 0x04, 0x02, 0x01 };
302         static const u16 dma[]   = { 0x2208, 0x10C2, 0x10C1 };
303
304         ide_hwif_t *hwif        = drive->hwif;
305         struct pci_dev *dev     = to_pci_dev(hwif->dev);
306         unsigned long base      = (unsigned long)hwif->hwif_data;
307         u16 ultra = 0, multi    = 0;
308         u8 mode = 0, unit       = drive->dn & 1;
309         u8 mmio                 = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
310         u8 scsc = 0, addr_mask  = hwif->channel ? (mmio ? 0xF4 : 0x84)
311                                                 : (mmio ? 0xB4 : 0x80);
312         unsigned long ma        = siimage_seldev(drive, 0x08);
313         unsigned long ua        = siimage_seldev(drive, 0x0C);
314
315         scsc  = sil_ioread8 (dev, base + (mmio ? 0x4A : 0x8A));
316         mode  = sil_ioread8 (dev, base + addr_mask);
317         multi = sil_ioread16(dev, ma);
318         ultra = sil_ioread16(dev, ua);
319
320         mode  &= ~(unit ? 0x30 : 0x03);
321         ultra &= ~0x3F;
322         scsc = ((scsc & 0x30) == 0x00) ? 0 : 1;
323
324         scsc = is_sata(hwif) ? 1 : scsc;
325
326         if (speed >= XFER_UDMA_0) {
327                 multi  = dma[2];
328                 ultra |= scsc ? ultra6[speed - XFER_UDMA_0] :
329                                 ultra5[speed - XFER_UDMA_0];
330                 mode  |= unit ? 0x30 : 0x03;
331         } else {
332                 multi = dma[speed - XFER_MW_DMA_0];
333                 mode |= unit ? 0x20 : 0x02;
334         }
335
336         sil_iowrite8 (dev, mode, base + addr_mask);
337         sil_iowrite16(dev, multi, ma);
338         sil_iowrite16(dev, ultra, ua);
339 }
340
341 /**
342  *      siimage_mmio_dma_test_irq       -       check we caused an IRQ
343  *      @drive: drive we are testing
344  *
345  *      Check if we caused an IDE DMA interrupt. We may also have caused
346  *      SATA status interrupts, if so we clean them up and continue.
347  */
348
349 static int siimage_mmio_dma_test_irq(ide_drive_t *drive)
350 {
351         ide_hwif_t *hwif        = drive->hwif;
352         void __iomem *sata_error_addr
353                 = (void __iomem *)hwif->sata_scr[SATA_ERROR_OFFSET];
354
355         if (sata_error_addr) {
356                 unsigned long base      = (unsigned long)hwif->hwif_data;
357                 u32 ext_stat            = readl((void __iomem *)(base + 0x10));
358                 u8 watchdog             = 0;
359
360                 if (ext_stat & ((hwif->channel) ? 0x40 : 0x10)) {
361                         u32 sata_error = readl(sata_error_addr);
362
363                         writel(sata_error, sata_error_addr);
364                         watchdog = (sata_error & 0x00680000) ? 1 : 0;
365                         printk(KERN_WARNING "%s: sata_error = 0x%08x, "
366                                 "watchdog = %d, %s\n",
367                                 drive->name, sata_error, watchdog, __func__);
368                 } else
369                         watchdog = (ext_stat & 0x8000) ? 1 : 0;
370
371                 ext_stat >>= 16;
372                 if (!(ext_stat & 0x0404) && !watchdog)
373                         return 0;
374         }
375
376         /* return 1 if INTR asserted */
377         if (readb((void __iomem *)(hwif->dma_base + ATA_DMA_STATUS)) & 4)
378                 return 1;
379
380         return 0;
381 }
382
383 static int siimage_dma_test_irq(ide_drive_t *drive)
384 {
385         if (drive->hwif->host_flags & IDE_HFLAG_MMIO)
386                 return siimage_mmio_dma_test_irq(drive);
387         else
388                 return ide_dma_test_irq(drive);
389 }
390
391 /**
392  *      sil_sata_reset_poll     -       wait for SATA reset
393  *      @drive: drive we are resetting
394  *
395  *      Poll the SATA phy and see whether it has come back from the dead
396  *      yet.
397  */
398
399 static int sil_sata_reset_poll(ide_drive_t *drive)
400 {
401         ide_hwif_t *hwif = drive->hwif;
402         void __iomem *sata_status_addr
403                 = (void __iomem *)hwif->sata_scr[SATA_STATUS_OFFSET];
404
405         if (sata_status_addr) {
406                 /* SATA Status is available only when in MMIO mode */
407                 u32 sata_stat = readl(sata_status_addr);
408
409                 if ((sata_stat & 0x03) != 0x03) {
410                         printk(KERN_WARNING "%s: reset phy dead, status=0x%08x\n",
411                                             hwif->name, sata_stat);
412                         return -ENXIO;
413                 }
414         }
415
416         return 0;
417 }
418
419 /**
420  *      sil_sata_pre_reset      -       reset hook
421  *      @drive: IDE device being reset
422  *
423  *      For the SATA devices we need to handle recalibration/geometry
424  *      differently
425  */
426
427 static void sil_sata_pre_reset(ide_drive_t *drive)
428 {
429         if (drive->media == ide_disk) {
430                 drive->special_flags &=
431                         ~(IDE_SFLAG_SET_GEOMETRY | IDE_SFLAG_RECALIBRATE);
432         }
433 }
434
435 /**
436  *      init_chipset_siimage    -       set up an SI device
437  *      @dev: PCI device
438  *
439  *      Perform the initial PCI set up for this device. Attempt to switch
440  *      to 133 MHz clocking if the system isn't already set up to do it.
441  */
442
443 static int init_chipset_siimage(struct pci_dev *dev)
444 {
445         struct ide_host *host = pci_get_drvdata(dev);
446         void __iomem *ioaddr = host->host_priv;
447         unsigned long base, scsc_addr;
448         u8 rev = dev->revision, tmp;
449
450         pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, rev ? 1 : 255);
451
452         if (ioaddr)
453                 pci_set_master(dev);
454
455         base = (unsigned long)ioaddr;
456
457         if (ioaddr && pdev_is_sata(dev)) {
458                 u32 tmp32, irq_mask;
459
460                 /* make sure IDE0/1 interrupts are not masked */
461                 irq_mask = (1 << 22) | (1 << 23);
462                 tmp32 = readl(ioaddr + 0x48);
463                 if (tmp32 & irq_mask) {
464                         tmp32 &= ~irq_mask;
465                         writel(tmp32, ioaddr + 0x48);
466                         readl(ioaddr + 0x48); /* flush */
467                 }
468                 writel(0, ioaddr + 0x148);
469                 writel(0, ioaddr + 0x1C8);
470         }
471
472         sil_iowrite8(dev, 0, base ? (base + 0xB4) : 0x80);
473         sil_iowrite8(dev, 0, base ? (base + 0xF4) : 0x84);
474
475         scsc_addr = base ? (base + 0x4A) : 0x8A;
476         tmp = sil_ioread8(dev, scsc_addr);
477
478         switch (tmp & 0x30) {
479         case 0x00:
480                 /* On 100 MHz clocking, try and switch to 133 MHz */
481                 sil_iowrite8(dev, tmp | 0x10, scsc_addr);
482                 break;
483         case 0x30:
484                 /* Clocking is disabled, attempt to force 133MHz clocking. */
485                 sil_iowrite8(dev, tmp & ~0x20, scsc_addr);
486         case 0x10:
487                 /* On 133Mhz clocking. */
488                 break;
489         case 0x20:
490                 /* On PCIx2 clocking. */
491                 break;
492         }
493
494         tmp = sil_ioread8(dev, scsc_addr);
495
496         sil_iowrite8 (dev,       0x72, base + 0xA1);
497         sil_iowrite16(dev,     0x328A, base + 0xA2);
498         sil_iowrite32(dev, 0x62DD62DD, base + 0xA4);
499         sil_iowrite32(dev, 0x43924392, base + 0xA8);
500         sil_iowrite32(dev, 0x40094009, base + 0xAC);
501         sil_iowrite8 (dev,       0x72, base ? (base + 0xE1) : 0xB1);
502         sil_iowrite16(dev,     0x328A, base ? (base + 0xE2) : 0xB2);
503         sil_iowrite32(dev, 0x62DD62DD, base ? (base + 0xE4) : 0xB4);
504         sil_iowrite32(dev, 0x43924392, base ? (base + 0xE8) : 0xB8);
505         sil_iowrite32(dev, 0x40094009, base ? (base + 0xEC) : 0xBC);
506
507         if (base && pdev_is_sata(dev)) {
508                 writel(0xFFFF0000, ioaddr + 0x108);
509                 writel(0xFFFF0000, ioaddr + 0x188);
510                 writel(0x00680000, ioaddr + 0x148);
511                 writel(0x00680000, ioaddr + 0x1C8);
512         }
513
514         /* report the clocking mode of the controller */
515         if (!pdev_is_sata(dev)) {
516                 static const char *clk_str[] =
517                         { "== 100", "== 133", "== 2X PCI", "DISABLED!" };
518
519                 tmp >>= 4;
520                 printk(KERN_INFO DRV_NAME " %s: BASE CLOCK %s\n",
521                         pci_name(dev), clk_str[tmp & 3]);
522         }
523
524         return 0;
525 }
526
527 /**
528  *      init_mmio_iops_siimage  -       set up the iops for MMIO
529  *      @hwif: interface to set up
530  *
531  *      The basic setup here is fairly simple, we can use standard MMIO
532  *      operations. However we do have to set the taskfile register offsets
533  *      by hand as there isn't a standard defined layout for them this time.
534  *
535  *      The hardware supports buffered taskfiles and also some rather nice
536  *      extended PRD tables. For better SI3112 support use the libata driver
537  */
538
539 static void __devinit init_mmio_iops_siimage(ide_hwif_t *hwif)
540 {
541         struct pci_dev *dev     = to_pci_dev(hwif->dev);
542         struct ide_host *host   = pci_get_drvdata(dev);
543         void *addr              = host->host_priv;
544         u8 ch                   = hwif->channel;
545         struct ide_io_ports *io_ports = &hwif->io_ports;
546         unsigned long base;
547
548         /*
549          *      Fill in the basic hwif bits
550          */
551         hwif->host_flags |= IDE_HFLAG_MMIO;
552
553         hwif->hwif_data = addr;
554
555         /*
556          *      Now set up the hw. We have to do this ourselves as the
557          *      MMIO layout isn't the same as the standard port based I/O.
558          */
559         memset(io_ports, 0, sizeof(*io_ports));
560
561         base = (unsigned long)addr;
562         if (ch)
563                 base += 0xC0;
564         else
565                 base += 0x80;
566
567         /*
568          *      The buffered task file doesn't have status/control, so we
569          *      can't currently use it sanely since we want to use LBA48 mode.
570          */
571         io_ports->data_addr     = base;
572         io_ports->error_addr    = base + 1;
573         io_ports->nsect_addr    = base + 2;
574         io_ports->lbal_addr     = base + 3;
575         io_ports->lbam_addr     = base + 4;
576         io_ports->lbah_addr     = base + 5;
577         io_ports->device_addr   = base + 6;
578         io_ports->status_addr   = base + 7;
579         io_ports->ctl_addr      = base + 10;
580
581         if (pdev_is_sata(dev)) {
582                 base = (unsigned long)addr;
583                 if (ch)
584                         base += 0x80;
585                 hwif->sata_scr[SATA_STATUS_OFFSET]      = base + 0x104;
586                 hwif->sata_scr[SATA_ERROR_OFFSET]       = base + 0x108;
587                 hwif->sata_scr[SATA_CONTROL_OFFSET]     = base + 0x100;
588         }
589
590         hwif->irq = dev->irq;
591
592         hwif->dma_base = (unsigned long)addr + (ch ? 0x08 : 0x00);
593 }
594
595 static int is_dev_seagate_sata(ide_drive_t *drive)
596 {
597         const char *s   = (const char *)&drive->id[ATA_ID_PROD];
598         unsigned len    = strnlen(s, ATA_ID_PROD_LEN);
599
600         if ((len > 4) && (!memcmp(s, "ST", 2)))
601                 if ((!memcmp(s + len - 2, "AS", 2)) ||
602                     (!memcmp(s + len - 3, "ASL", 3))) {
603                         printk(KERN_INFO "%s: applying pessimistic Seagate "
604                                          "errata fix\n", drive->name);
605                         return 1;
606                 }
607
608         return 0;
609 }
610
611 /**
612  *      sil_quirkproc           -       post probe fixups
613  *      @drive: drive
614  *
615  *      Called after drive probe we use this to decide whether the
616  *      Seagate fixup must be applied. This used to be in init_iops but
617  *      that can occur before we know what drives are present.
618  */
619
620 static void sil_quirkproc(ide_drive_t *drive)
621 {
622         ide_hwif_t *hwif = drive->hwif;
623
624         /* Try and rise the rqsize */
625         if (!is_sata(hwif) || !is_dev_seagate_sata(drive))
626                 hwif->rqsize = 128;
627 }
628
629 /**
630  *      init_iops_siimage       -       set up iops
631  *      @hwif: interface to set up
632  *
633  *      Do the basic setup for the SIIMAGE hardware interface
634  *      and then do the MMIO setup if we can. This is the first
635  *      look in we get for setting up the hwif so that we
636  *      can get the iops right before using them.
637  */
638
639 static void __devinit init_iops_siimage(ide_hwif_t *hwif)
640 {
641         struct pci_dev *dev = to_pci_dev(hwif->dev);
642         struct ide_host *host = pci_get_drvdata(dev);
643
644         hwif->hwif_data = NULL;
645
646         /* Pessimal until we finish probing */
647         hwif->rqsize = 15;
648
649         if (host->host_priv)
650                 init_mmio_iops_siimage(hwif);
651 }
652
653 /**
654  *      sil_cable_detect        -       cable detection
655  *      @hwif: interface to check
656  *
657  *      Check for the presence of an ATA66 capable cable on the interface.
658  */
659
660 static u8 sil_cable_detect(ide_hwif_t *hwif)
661 {
662         struct pci_dev *dev     = to_pci_dev(hwif->dev);
663         unsigned long addr      = siimage_selreg(hwif, 0);
664         u8 ata66                = sil_ioread8(dev, addr);
665
666         return (ata66 & 0x01) ? ATA_CBL_PATA80 : ATA_CBL_PATA40;
667 }
668
669 static const struct ide_port_ops sil_pata_port_ops = {
670         .set_pio_mode           = sil_set_pio_mode,
671         .set_dma_mode           = sil_set_dma_mode,
672         .quirkproc              = sil_quirkproc,
673         .udma_filter            = sil_pata_udma_filter,
674         .cable_detect           = sil_cable_detect,
675 };
676
677 static const struct ide_port_ops sil_sata_port_ops = {
678         .set_pio_mode           = sil_set_pio_mode,
679         .set_dma_mode           = sil_set_dma_mode,
680         .reset_poll             = sil_sata_reset_poll,
681         .pre_reset              = sil_sata_pre_reset,
682         .quirkproc              = sil_quirkproc,
683         .udma_filter            = sil_sata_udma_filter,
684         .cable_detect           = sil_cable_detect,
685 };
686
687 static const struct ide_dma_ops sil_dma_ops = {
688         .dma_host_set           = ide_dma_host_set,
689         .dma_setup              = ide_dma_setup,
690         .dma_start              = ide_dma_start,
691         .dma_end                = ide_dma_end,
692         .dma_test_irq           = siimage_dma_test_irq,
693         .dma_timer_expiry       = ide_dma_sff_timer_expiry,
694         .dma_lost_irq           = ide_dma_lost_irq,
695         .dma_sff_read_status    = ide_dma_sff_read_status,
696 };
697
698 #define DECLARE_SII_DEV(p_ops)                          \
699         {                                               \
700                 .name           = DRV_NAME,             \
701                 .init_chipset   = init_chipset_siimage, \
702                 .init_iops      = init_iops_siimage,    \
703                 .port_ops       = p_ops,                \
704                 .dma_ops        = &sil_dma_ops,         \
705                 .pio_mask       = ATA_PIO4,             \
706                 .mwdma_mask     = ATA_MWDMA2,           \
707                 .udma_mask      = ATA_UDMA6,            \
708         }
709
710 static const struct ide_port_info siimage_chipsets[] __devinitdata = {
711         /* 0: SiI680 */  DECLARE_SII_DEV(&sil_pata_port_ops),
712         /* 1: SiI3112 */ DECLARE_SII_DEV(&sil_sata_port_ops)
713 };
714
715 /**
716  *      siimage_init_one        -       PCI layer discovery entry
717  *      @dev: PCI device
718  *      @id: ident table entry
719  *
720  *      Called by the PCI code when it finds an SiI680 or SiI3112 controller.
721  *      We then use the IDE PCI generic helper to do most of the work.
722  */
723
724 static int __devinit siimage_init_one(struct pci_dev *dev,
725                                       const struct pci_device_id *id)
726 {
727         void __iomem *ioaddr = NULL;
728         resource_size_t bar5 = pci_resource_start(dev, 5);
729         unsigned long barsize = pci_resource_len(dev, 5);
730         int rc;
731         struct ide_port_info d;
732         u8 idx = id->driver_data;
733         u8 BA5_EN;
734
735         d = siimage_chipsets[idx];
736
737         if (idx) {
738                 static int first = 1;
739
740                 if (first) {
741                         printk(KERN_INFO DRV_NAME ": For full SATA support you "
742                                 "should use the libata sata_sil module.\n");
743                         first = 0;
744                 }
745
746                 d.host_flags |= IDE_HFLAG_NO_ATAPI_DMA;
747         }
748
749         rc = pci_enable_device(dev);
750         if (rc)
751                 return rc;
752
753         pci_read_config_byte(dev, 0x8A, &BA5_EN);
754         if ((BA5_EN & 0x01) || bar5) {
755                 /*
756                 * Drop back to PIO if we can't map the MMIO. Some systems
757                 * seem to get terminally confused in the PCI spaces.
758                 */
759                 if (!request_mem_region(bar5, barsize, d.name)) {
760                         printk(KERN_WARNING DRV_NAME " %s: MMIO ports not "
761                                 "available\n", pci_name(dev));
762                 } else {
763                         ioaddr = pci_ioremap_bar(dev, 5);
764                         if (ioaddr == NULL)
765                                 release_mem_region(bar5, barsize);
766                 }
767         }
768
769         rc = ide_pci_init_one(dev, &d, ioaddr);
770         if (rc) {
771                 if (ioaddr) {
772                         iounmap(ioaddr);
773                         release_mem_region(bar5, barsize);
774                 }
775                 pci_disable_device(dev);
776         }
777
778         return rc;
779 }
780
781 static void __devexit siimage_remove(struct pci_dev *dev)
782 {
783         struct ide_host *host = pci_get_drvdata(dev);
784         void __iomem *ioaddr = host->host_priv;
785
786         ide_pci_remove(dev);
787
788         if (ioaddr) {
789                 resource_size_t bar5 = pci_resource_start(dev, 5);
790                 unsigned long barsize = pci_resource_len(dev, 5);
791
792                 iounmap(ioaddr);
793                 release_mem_region(bar5, barsize);
794         }
795
796         pci_disable_device(dev);
797 }
798
799 static const struct pci_device_id siimage_pci_tbl[] = {
800         { PCI_VDEVICE(CMD, PCI_DEVICE_ID_SII_680),    0 },
801 #ifdef CONFIG_BLK_DEV_IDE_SATA
802         { PCI_VDEVICE(CMD, PCI_DEVICE_ID_SII_3112),   1 },
803         { PCI_VDEVICE(CMD, PCI_DEVICE_ID_SII_1210SA), 1 },
804 #endif
805         { 0, },
806 };
807 MODULE_DEVICE_TABLE(pci, siimage_pci_tbl);
808
809 static struct pci_driver siimage_pci_driver = {
810         .name           = "SiI_IDE",
811         .id_table       = siimage_pci_tbl,
812         .probe          = siimage_init_one,
813         .remove         = __devexit_p(siimage_remove),
814         .suspend        = ide_pci_suspend,
815         .resume         = ide_pci_resume,
816 };
817
818 static int __init siimage_ide_init(void)
819 {
820         return ide_pci_register_driver(&siimage_pci_driver);
821 }
822
823 static void __exit siimage_ide_exit(void)
824 {
825         pci_unregister_driver(&siimage_pci_driver);
826 }
827
828 module_init(siimage_ide_init);
829 module_exit(siimage_ide_exit);
830
831 MODULE_AUTHOR("Andre Hedrick, Alan Cox");
832 MODULE_DESCRIPTION("PCI driver module for SiI IDE");
833 MODULE_LICENSE("GPL");