Merge branch 'linus' into release
[linux-2.6/mini2440.git] / drivers / ata / sata_sil.c
blob564c142b03b043ec9faf0c930b5ded6af1dc8b1d
1 /*
2 * sata_sil.c - Silicon Image SATA
4 * Maintained by: Jeff Garzik <jgarzik@pobox.com>
5 * Please ALWAYS copy linux-ide@vger.kernel.org
6 * on emails.
8 * Copyright 2003-2005 Red Hat, Inc.
9 * Copyright 2003 Benjamin Herrenschmidt
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2, or (at your option)
15 * any later version.
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
22 * You should have received a copy of the GNU General Public License
23 * along with this program; see the file COPYING. If not, write to
24 * the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
27 * libata documentation is available via 'make {ps|pdf}docs',
28 * as Documentation/DocBook/libata.*
30 * Documentation for SiI 3112:
31 * http://gkernel.sourceforge.net/specs/sii/3112A_SiI-DS-0095-B2.pdf.bz2
33 * Other errata and documentation available under NDA.
37 #include <linux/kernel.h>
38 #include <linux/module.h>
39 #include <linux/pci.h>
40 #include <linux/init.h>
41 #include <linux/blkdev.h>
42 #include <linux/delay.h>
43 #include <linux/interrupt.h>
44 #include <linux/device.h>
45 #include <scsi/scsi_host.h>
46 #include <linux/libata.h>
48 #define DRV_NAME "sata_sil"
49 #define DRV_VERSION "2.4"
51 #define SIL_DMA_BOUNDARY 0x7fffffffUL
53 enum {
54 SIL_MMIO_BAR = 5,
57 * host flags
59 SIL_FLAG_NO_SATA_IRQ = (1 << 28),
60 SIL_FLAG_RERR_ON_DMA_ACT = (1 << 29),
61 SIL_FLAG_MOD15WRITE = (1 << 30),
63 SIL_DFL_PORT_FLAGS = ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY |
64 ATA_FLAG_MMIO,
67 * Controller IDs
69 sil_3112 = 0,
70 sil_3112_no_sata_irq = 1,
71 sil_3512 = 2,
72 sil_3114 = 3,
75 * Register offsets
77 SIL_SYSCFG = 0x48,
80 * Register bits
82 /* SYSCFG */
83 SIL_MASK_IDE0_INT = (1 << 22),
84 SIL_MASK_IDE1_INT = (1 << 23),
85 SIL_MASK_IDE2_INT = (1 << 24),
86 SIL_MASK_IDE3_INT = (1 << 25),
87 SIL_MASK_2PORT = SIL_MASK_IDE0_INT | SIL_MASK_IDE1_INT,
88 SIL_MASK_4PORT = SIL_MASK_2PORT |
89 SIL_MASK_IDE2_INT | SIL_MASK_IDE3_INT,
91 /* BMDMA/BMDMA2 */
92 SIL_INTR_STEERING = (1 << 1),
94 SIL_DMA_ENABLE = (1 << 0), /* DMA run switch */
95 SIL_DMA_RDWR = (1 << 3), /* DMA Rd-Wr */
96 SIL_DMA_SATA_IRQ = (1 << 4), /* OR of all SATA IRQs */
97 SIL_DMA_ACTIVE = (1 << 16), /* DMA running */
98 SIL_DMA_ERROR = (1 << 17), /* PCI bus error */
99 SIL_DMA_COMPLETE = (1 << 18), /* cmd complete / IRQ pending */
100 SIL_DMA_N_SATA_IRQ = (1 << 6), /* SATA_IRQ for the next channel */
101 SIL_DMA_N_ACTIVE = (1 << 24), /* ACTIVE for the next channel */
102 SIL_DMA_N_ERROR = (1 << 25), /* ERROR for the next channel */
103 SIL_DMA_N_COMPLETE = (1 << 26), /* COMPLETE for the next channel */
105 /* SIEN */
106 SIL_SIEN_N = (1 << 16), /* triggered by SError.N */
109 * Others
111 SIL_QUIRK_MOD15WRITE = (1 << 0),
112 SIL_QUIRK_UDMA5MAX = (1 << 1),
115 static int sil_init_one(struct pci_dev *pdev, const struct pci_device_id *ent);
116 #ifdef CONFIG_PM
117 static int sil_pci_device_resume(struct pci_dev *pdev);
118 #endif
119 static void sil_dev_config(struct ata_device *dev);
120 static int sil_scr_read(struct ata_link *link, unsigned int sc_reg, u32 *val);
121 static int sil_scr_write(struct ata_link *link, unsigned int sc_reg, u32 val);
122 static int sil_set_mode(struct ata_link *link, struct ata_device **r_failed);
123 static void sil_qc_prep(struct ata_queued_cmd *qc);
124 static void sil_bmdma_setup(struct ata_queued_cmd *qc);
125 static void sil_bmdma_start(struct ata_queued_cmd *qc);
126 static void sil_bmdma_stop(struct ata_queued_cmd *qc);
127 static void sil_freeze(struct ata_port *ap);
128 static void sil_thaw(struct ata_port *ap);
131 static const struct pci_device_id sil_pci_tbl[] = {
132 { PCI_VDEVICE(CMD, 0x3112), sil_3112 },
133 { PCI_VDEVICE(CMD, 0x0240), sil_3112 },
134 { PCI_VDEVICE(CMD, 0x3512), sil_3512 },
135 { PCI_VDEVICE(CMD, 0x3114), sil_3114 },
136 { PCI_VDEVICE(ATI, 0x436e), sil_3112 },
137 { PCI_VDEVICE(ATI, 0x4379), sil_3112_no_sata_irq },
138 { PCI_VDEVICE(ATI, 0x437a), sil_3112_no_sata_irq },
140 { } /* terminate list */
144 /* TODO firmware versions should be added - eric */
145 static const struct sil_drivelist {
146 const char *product;
147 unsigned int quirk;
148 } sil_blacklist [] = {
149 { "ST320012AS", SIL_QUIRK_MOD15WRITE },
150 { "ST330013AS", SIL_QUIRK_MOD15WRITE },
151 { "ST340017AS", SIL_QUIRK_MOD15WRITE },
152 { "ST360015AS", SIL_QUIRK_MOD15WRITE },
153 { "ST380023AS", SIL_QUIRK_MOD15WRITE },
154 { "ST3120023AS", SIL_QUIRK_MOD15WRITE },
155 { "ST340014ASL", SIL_QUIRK_MOD15WRITE },
156 { "ST360014ASL", SIL_QUIRK_MOD15WRITE },
157 { "ST380011ASL", SIL_QUIRK_MOD15WRITE },
158 { "ST3120022ASL", SIL_QUIRK_MOD15WRITE },
159 { "ST3160021ASL", SIL_QUIRK_MOD15WRITE },
160 { "Maxtor 4D060H3", SIL_QUIRK_UDMA5MAX },
164 static struct pci_driver sil_pci_driver = {
165 .name = DRV_NAME,
166 .id_table = sil_pci_tbl,
167 .probe = sil_init_one,
168 .remove = ata_pci_remove_one,
169 #ifdef CONFIG_PM
170 .suspend = ata_pci_device_suspend,
171 .resume = sil_pci_device_resume,
172 #endif
175 static struct scsi_host_template sil_sht = {
176 ATA_BASE_SHT(DRV_NAME),
177 /** These controllers support Large Block Transfer which allows
178 transfer chunks up to 2GB and which cross 64KB boundaries,
179 therefore the DMA limits are more relaxed than standard ATA SFF. */
180 .dma_boundary = SIL_DMA_BOUNDARY,
181 .sg_tablesize = ATA_MAX_PRD
184 static struct ata_port_operations sil_ops = {
185 .inherits = &ata_bmdma_port_ops,
186 .dev_config = sil_dev_config,
187 .set_mode = sil_set_mode,
188 .bmdma_setup = sil_bmdma_setup,
189 .bmdma_start = sil_bmdma_start,
190 .bmdma_stop = sil_bmdma_stop,
191 .qc_prep = sil_qc_prep,
192 .freeze = sil_freeze,
193 .thaw = sil_thaw,
194 .scr_read = sil_scr_read,
195 .scr_write = sil_scr_write,
198 static const struct ata_port_info sil_port_info[] = {
199 /* sil_3112 */
201 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_MOD15WRITE,
202 .pio_mask = 0x1f, /* pio0-4 */
203 .mwdma_mask = 0x07, /* mwdma0-2 */
204 .udma_mask = ATA_UDMA5,
205 .port_ops = &sil_ops,
207 /* sil_3112_no_sata_irq */
209 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_MOD15WRITE |
210 SIL_FLAG_NO_SATA_IRQ,
211 .pio_mask = 0x1f, /* pio0-4 */
212 .mwdma_mask = 0x07, /* mwdma0-2 */
213 .udma_mask = ATA_UDMA5,
214 .port_ops = &sil_ops,
216 /* sil_3512 */
218 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_RERR_ON_DMA_ACT,
219 .pio_mask = 0x1f, /* pio0-4 */
220 .mwdma_mask = 0x07, /* mwdma0-2 */
221 .udma_mask = ATA_UDMA5,
222 .port_ops = &sil_ops,
224 /* sil_3114 */
226 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_RERR_ON_DMA_ACT,
227 .pio_mask = 0x1f, /* pio0-4 */
228 .mwdma_mask = 0x07, /* mwdma0-2 */
229 .udma_mask = ATA_UDMA5,
230 .port_ops = &sil_ops,
234 /* per-port register offsets */
235 /* TODO: we can probably calculate rather than use a table */
236 static const struct {
237 unsigned long tf; /* ATA taskfile register block */
238 unsigned long ctl; /* ATA control/altstatus register block */
239 unsigned long bmdma; /* DMA register block */
240 unsigned long bmdma2; /* DMA register block #2 */
241 unsigned long fifo_cfg; /* FIFO Valid Byte Count and Control */
242 unsigned long scr; /* SATA control register block */
243 unsigned long sien; /* SATA Interrupt Enable register */
244 unsigned long xfer_mode;/* data transfer mode register */
245 unsigned long sfis_cfg; /* SATA FIS reception config register */
246 } sil_port[] = {
247 /* port 0 ... */
248 /* tf ctl bmdma bmdma2 fifo scr sien mode sfis */
249 { 0x80, 0x8A, 0x0, 0x10, 0x40, 0x100, 0x148, 0xb4, 0x14c },
250 { 0xC0, 0xCA, 0x8, 0x18, 0x44, 0x180, 0x1c8, 0xf4, 0x1cc },
251 { 0x280, 0x28A, 0x200, 0x210, 0x240, 0x300, 0x348, 0x2b4, 0x34c },
252 { 0x2C0, 0x2CA, 0x208, 0x218, 0x244, 0x380, 0x3c8, 0x2f4, 0x3cc },
253 /* ... port 3 */
256 MODULE_AUTHOR("Jeff Garzik");
257 MODULE_DESCRIPTION("low-level driver for Silicon Image SATA controller");
258 MODULE_LICENSE("GPL");
259 MODULE_DEVICE_TABLE(pci, sil_pci_tbl);
260 MODULE_VERSION(DRV_VERSION);
262 static int slow_down;
263 module_param(slow_down, int, 0444);
264 MODULE_PARM_DESC(slow_down, "Sledgehammer used to work around random problems, by limiting commands to 15 sectors (0=off, 1=on)");
267 static void sil_bmdma_stop(struct ata_queued_cmd *qc)
269 struct ata_port *ap = qc->ap;
270 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
271 void __iomem *bmdma2 = mmio_base + sil_port[ap->port_no].bmdma2;
273 /* clear start/stop bit - can safely always write 0 */
274 iowrite8(0, bmdma2);
276 /* one-PIO-cycle guaranteed wait, per spec, for HDMA1:0 transition */
277 ata_sff_dma_pause(ap);
280 static void sil_bmdma_setup(struct ata_queued_cmd *qc)
282 struct ata_port *ap = qc->ap;
283 void __iomem *bmdma = ap->ioaddr.bmdma_addr;
285 /* load PRD table addr. */
286 iowrite32(ap->prd_dma, bmdma + ATA_DMA_TABLE_OFS);
288 /* issue r/w command */
289 ap->ops->sff_exec_command(ap, &qc->tf);
292 static void sil_bmdma_start(struct ata_queued_cmd *qc)
294 unsigned int rw = (qc->tf.flags & ATA_TFLAG_WRITE);
295 struct ata_port *ap = qc->ap;
296 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
297 void __iomem *bmdma2 = mmio_base + sil_port[ap->port_no].bmdma2;
298 u8 dmactl = ATA_DMA_START;
300 /* set transfer direction, start host DMA transaction
301 Note: For Large Block Transfer to work, the DMA must be started
302 using the bmdma2 register. */
303 if (!rw)
304 dmactl |= ATA_DMA_WR;
305 iowrite8(dmactl, bmdma2);
308 /* The way God intended PCI IDE scatter/gather lists to look and behave... */
309 static void sil_fill_sg(struct ata_queued_cmd *qc)
311 struct scatterlist *sg;
312 struct ata_port *ap = qc->ap;
313 struct ata_prd *prd, *last_prd = NULL;
314 unsigned int si;
316 prd = &ap->prd[0];
317 for_each_sg(qc->sg, sg, qc->n_elem, si) {
318 /* Note h/w doesn't support 64-bit, so we unconditionally
319 * truncate dma_addr_t to u32.
321 u32 addr = (u32) sg_dma_address(sg);
322 u32 sg_len = sg_dma_len(sg);
324 prd->addr = cpu_to_le32(addr);
325 prd->flags_len = cpu_to_le32(sg_len);
326 VPRINTK("PRD[%u] = (0x%X, 0x%X)\n", pi, addr, sg_len);
328 last_prd = prd;
329 prd++;
332 if (likely(last_prd))
333 last_prd->flags_len |= cpu_to_le32(ATA_PRD_EOT);
336 static void sil_qc_prep(struct ata_queued_cmd *qc)
338 if (!(qc->flags & ATA_QCFLAG_DMAMAP))
339 return;
341 sil_fill_sg(qc);
344 static unsigned char sil_get_device_cache_line(struct pci_dev *pdev)
346 u8 cache_line = 0;
347 pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE, &cache_line);
348 return cache_line;
352 * sil_set_mode - wrap set_mode functions
353 * @link: link to set up
354 * @r_failed: returned device when we fail
356 * Wrap the libata method for device setup as after the setup we need
357 * to inspect the results and do some configuration work
360 static int sil_set_mode(struct ata_link *link, struct ata_device **r_failed)
362 struct ata_port *ap = link->ap;
363 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
364 void __iomem *addr = mmio_base + sil_port[ap->port_no].xfer_mode;
365 struct ata_device *dev;
366 u32 tmp, dev_mode[2] = { };
367 int rc;
369 rc = ata_do_set_mode(link, r_failed);
370 if (rc)
371 return rc;
373 ata_for_each_dev(dev, link, ALL) {
374 if (!ata_dev_enabled(dev))
375 dev_mode[dev->devno] = 0; /* PIO0/1/2 */
376 else if (dev->flags & ATA_DFLAG_PIO)
377 dev_mode[dev->devno] = 1; /* PIO3/4 */
378 else
379 dev_mode[dev->devno] = 3; /* UDMA */
380 /* value 2 indicates MDMA */
383 tmp = readl(addr);
384 tmp &= ~((1<<5) | (1<<4) | (1<<1) | (1<<0));
385 tmp |= dev_mode[0];
386 tmp |= (dev_mode[1] << 4);
387 writel(tmp, addr);
388 readl(addr); /* flush */
389 return 0;
392 static inline void __iomem *sil_scr_addr(struct ata_port *ap,
393 unsigned int sc_reg)
395 void __iomem *offset = ap->ioaddr.scr_addr;
397 switch (sc_reg) {
398 case SCR_STATUS:
399 return offset + 4;
400 case SCR_ERROR:
401 return offset + 8;
402 case SCR_CONTROL:
403 return offset;
404 default:
405 /* do nothing */
406 break;
409 return NULL;
412 static int sil_scr_read(struct ata_link *link, unsigned int sc_reg, u32 *val)
414 void __iomem *mmio = sil_scr_addr(link->ap, sc_reg);
416 if (mmio) {
417 *val = readl(mmio);
418 return 0;
420 return -EINVAL;
423 static int sil_scr_write(struct ata_link *link, unsigned int sc_reg, u32 val)
425 void __iomem *mmio = sil_scr_addr(link->ap, sc_reg);
427 if (mmio) {
428 writel(val, mmio);
429 return 0;
431 return -EINVAL;
434 static void sil_host_intr(struct ata_port *ap, u32 bmdma2)
436 struct ata_eh_info *ehi = &ap->link.eh_info;
437 struct ata_queued_cmd *qc = ata_qc_from_tag(ap, ap->link.active_tag);
438 u8 status;
440 if (unlikely(bmdma2 & SIL_DMA_SATA_IRQ)) {
441 u32 serror;
443 /* SIEN doesn't mask SATA IRQs on some 3112s. Those
444 * controllers continue to assert IRQ as long as
445 * SError bits are pending. Clear SError immediately.
447 sil_scr_read(&ap->link, SCR_ERROR, &serror);
448 sil_scr_write(&ap->link, SCR_ERROR, serror);
450 /* Sometimes spurious interrupts occur, double check
451 * it's PHYRDY CHG.
453 if (serror & SERR_PHYRDY_CHG) {
454 ap->link.eh_info.serror |= serror;
455 goto freeze;
458 if (!(bmdma2 & SIL_DMA_COMPLETE))
459 return;
462 if (unlikely(!qc || (qc->tf.flags & ATA_TFLAG_POLLING))) {
463 /* this sometimes happens, just clear IRQ */
464 ap->ops->sff_check_status(ap);
465 return;
468 /* Check whether we are expecting interrupt in this state */
469 switch (ap->hsm_task_state) {
470 case HSM_ST_FIRST:
471 /* Some pre-ATAPI-4 devices assert INTRQ
472 * at this state when ready to receive CDB.
475 /* Check the ATA_DFLAG_CDB_INTR flag is enough here.
476 * The flag was turned on only for atapi devices. No
477 * need to check ata_is_atapi(qc->tf.protocol) again.
479 if (!(qc->dev->flags & ATA_DFLAG_CDB_INTR))
480 goto err_hsm;
481 break;
482 case HSM_ST_LAST:
483 if (ata_is_dma(qc->tf.protocol)) {
484 /* clear DMA-Start bit */
485 ap->ops->bmdma_stop(qc);
487 if (bmdma2 & SIL_DMA_ERROR) {
488 qc->err_mask |= AC_ERR_HOST_BUS;
489 ap->hsm_task_state = HSM_ST_ERR;
492 break;
493 case HSM_ST:
494 break;
495 default:
496 goto err_hsm;
499 /* check main status, clearing INTRQ */
500 status = ap->ops->sff_check_status(ap);
501 if (unlikely(status & ATA_BUSY))
502 goto err_hsm;
504 /* ack bmdma irq events */
505 ata_sff_irq_clear(ap);
507 /* kick HSM in the ass */
508 ata_sff_hsm_move(ap, qc, status, 0);
510 if (unlikely(qc->err_mask) && ata_is_dma(qc->tf.protocol))
511 ata_ehi_push_desc(ehi, "BMDMA2 stat 0x%x", bmdma2);
513 return;
515 err_hsm:
516 qc->err_mask |= AC_ERR_HSM;
517 freeze:
518 ata_port_freeze(ap);
521 static irqreturn_t sil_interrupt(int irq, void *dev_instance)
523 struct ata_host *host = dev_instance;
524 void __iomem *mmio_base = host->iomap[SIL_MMIO_BAR];
525 int handled = 0;
526 int i;
528 spin_lock(&host->lock);
530 for (i = 0; i < host->n_ports; i++) {
531 struct ata_port *ap = host->ports[i];
532 u32 bmdma2 = readl(mmio_base + sil_port[ap->port_no].bmdma2);
534 if (unlikely(!ap || ap->flags & ATA_FLAG_DISABLED))
535 continue;
537 /* turn off SATA_IRQ if not supported */
538 if (ap->flags & SIL_FLAG_NO_SATA_IRQ)
539 bmdma2 &= ~SIL_DMA_SATA_IRQ;
541 if (bmdma2 == 0xffffffff ||
542 !(bmdma2 & (SIL_DMA_COMPLETE | SIL_DMA_SATA_IRQ)))
543 continue;
545 sil_host_intr(ap, bmdma2);
546 handled = 1;
549 spin_unlock(&host->lock);
551 return IRQ_RETVAL(handled);
554 static void sil_freeze(struct ata_port *ap)
556 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
557 u32 tmp;
559 /* global IRQ mask doesn't block SATA IRQ, turn off explicitly */
560 writel(0, mmio_base + sil_port[ap->port_no].sien);
562 /* plug IRQ */
563 tmp = readl(mmio_base + SIL_SYSCFG);
564 tmp |= SIL_MASK_IDE0_INT << ap->port_no;
565 writel(tmp, mmio_base + SIL_SYSCFG);
566 readl(mmio_base + SIL_SYSCFG); /* flush */
569 static void sil_thaw(struct ata_port *ap)
571 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
572 u32 tmp;
574 /* clear IRQ */
575 ap->ops->sff_check_status(ap);
576 ata_sff_irq_clear(ap);
578 /* turn on SATA IRQ if supported */
579 if (!(ap->flags & SIL_FLAG_NO_SATA_IRQ))
580 writel(SIL_SIEN_N, mmio_base + sil_port[ap->port_no].sien);
582 /* turn on IRQ */
583 tmp = readl(mmio_base + SIL_SYSCFG);
584 tmp &= ~(SIL_MASK_IDE0_INT << ap->port_no);
585 writel(tmp, mmio_base + SIL_SYSCFG);
589 * sil_dev_config - Apply device/host-specific errata fixups
590 * @dev: Device to be examined
592 * After the IDENTIFY [PACKET] DEVICE step is complete, and a
593 * device is known to be present, this function is called.
594 * We apply two errata fixups which are specific to Silicon Image,
595 * a Seagate and a Maxtor fixup.
597 * For certain Seagate devices, we must limit the maximum sectors
598 * to under 8K.
600 * For certain Maxtor devices, we must not program the drive
601 * beyond udma5.
603 * Both fixups are unfairly pessimistic. As soon as I get more
604 * information on these errata, I will create a more exhaustive
605 * list, and apply the fixups to only the specific
606 * devices/hosts/firmwares that need it.
608 * 20040111 - Seagate drives affected by the Mod15Write bug are blacklisted
609 * The Maxtor quirk is in the blacklist, but I'm keeping the original
610 * pessimistic fix for the following reasons...
611 * - There seems to be less info on it, only one device gleaned off the
612 * Windows driver, maybe only one is affected. More info would be greatly
613 * appreciated.
614 * - But then again UDMA5 is hardly anything to complain about
616 static void sil_dev_config(struct ata_device *dev)
618 struct ata_port *ap = dev->link->ap;
619 int print_info = ap->link.eh_context.i.flags & ATA_EHI_PRINTINFO;
620 unsigned int n, quirks = 0;
621 unsigned char model_num[ATA_ID_PROD_LEN + 1];
623 ata_id_c_string(dev->id, model_num, ATA_ID_PROD, sizeof(model_num));
625 for (n = 0; sil_blacklist[n].product; n++)
626 if (!strcmp(sil_blacklist[n].product, model_num)) {
627 quirks = sil_blacklist[n].quirk;
628 break;
631 /* limit requests to 15 sectors */
632 if (slow_down ||
633 ((ap->flags & SIL_FLAG_MOD15WRITE) &&
634 (quirks & SIL_QUIRK_MOD15WRITE))) {
635 if (print_info)
636 ata_dev_printk(dev, KERN_INFO, "applying Seagate "
637 "errata fix (mod15write workaround)\n");
638 dev->max_sectors = 15;
639 return;
642 /* limit to udma5 */
643 if (quirks & SIL_QUIRK_UDMA5MAX) {
644 if (print_info)
645 ata_dev_printk(dev, KERN_INFO, "applying Maxtor "
646 "errata fix %s\n", model_num);
647 dev->udma_mask &= ATA_UDMA5;
648 return;
652 static void sil_init_controller(struct ata_host *host)
654 struct pci_dev *pdev = to_pci_dev(host->dev);
655 void __iomem *mmio_base = host->iomap[SIL_MMIO_BAR];
656 u8 cls;
657 u32 tmp;
658 int i;
660 /* Initialize FIFO PCI bus arbitration */
661 cls = sil_get_device_cache_line(pdev);
662 if (cls) {
663 cls >>= 3;
664 cls++; /* cls = (line_size/8)+1 */
665 for (i = 0; i < host->n_ports; i++)
666 writew(cls << 8 | cls,
667 mmio_base + sil_port[i].fifo_cfg);
668 } else
669 dev_printk(KERN_WARNING, &pdev->dev,
670 "cache line size not set. Driver may not function\n");
672 /* Apply R_ERR on DMA activate FIS errata workaround */
673 if (host->ports[0]->flags & SIL_FLAG_RERR_ON_DMA_ACT) {
674 int cnt;
676 for (i = 0, cnt = 0; i < host->n_ports; i++) {
677 tmp = readl(mmio_base + sil_port[i].sfis_cfg);
678 if ((tmp & 0x3) != 0x01)
679 continue;
680 if (!cnt)
681 dev_printk(KERN_INFO, &pdev->dev,
682 "Applying R_ERR on DMA activate "
683 "FIS errata fix\n");
684 writel(tmp & ~0x3, mmio_base + sil_port[i].sfis_cfg);
685 cnt++;
689 if (host->n_ports == 4) {
690 /* flip the magic "make 4 ports work" bit */
691 tmp = readl(mmio_base + sil_port[2].bmdma);
692 if ((tmp & SIL_INTR_STEERING) == 0)
693 writel(tmp | SIL_INTR_STEERING,
694 mmio_base + sil_port[2].bmdma);
698 static int sil_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
700 static int printed_version;
701 int board_id = ent->driver_data;
702 const struct ata_port_info *ppi[] = { &sil_port_info[board_id], NULL };
703 struct ata_host *host;
704 void __iomem *mmio_base;
705 int n_ports, rc;
706 unsigned int i;
708 if (!printed_version++)
709 dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
711 /* allocate host */
712 n_ports = 2;
713 if (board_id == sil_3114)
714 n_ports = 4;
716 host = ata_host_alloc_pinfo(&pdev->dev, ppi, n_ports);
717 if (!host)
718 return -ENOMEM;
720 /* acquire resources and fill host */
721 rc = pcim_enable_device(pdev);
722 if (rc)
723 return rc;
725 rc = pcim_iomap_regions(pdev, 1 << SIL_MMIO_BAR, DRV_NAME);
726 if (rc == -EBUSY)
727 pcim_pin_device(pdev);
728 if (rc)
729 return rc;
730 host->iomap = pcim_iomap_table(pdev);
732 rc = pci_set_dma_mask(pdev, ATA_DMA_MASK);
733 if (rc)
734 return rc;
735 rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK);
736 if (rc)
737 return rc;
739 mmio_base = host->iomap[SIL_MMIO_BAR];
741 for (i = 0; i < host->n_ports; i++) {
742 struct ata_port *ap = host->ports[i];
743 struct ata_ioports *ioaddr = &ap->ioaddr;
745 ioaddr->cmd_addr = mmio_base + sil_port[i].tf;
746 ioaddr->altstatus_addr =
747 ioaddr->ctl_addr = mmio_base + sil_port[i].ctl;
748 ioaddr->bmdma_addr = mmio_base + sil_port[i].bmdma;
749 ioaddr->scr_addr = mmio_base + sil_port[i].scr;
750 ata_sff_std_ports(ioaddr);
752 ata_port_pbar_desc(ap, SIL_MMIO_BAR, -1, "mmio");
753 ata_port_pbar_desc(ap, SIL_MMIO_BAR, sil_port[i].tf, "tf");
756 /* initialize and activate */
757 sil_init_controller(host);
759 pci_set_master(pdev);
760 return ata_host_activate(host, pdev->irq, sil_interrupt, IRQF_SHARED,
761 &sil_sht);
764 #ifdef CONFIG_PM
765 static int sil_pci_device_resume(struct pci_dev *pdev)
767 struct ata_host *host = dev_get_drvdata(&pdev->dev);
768 int rc;
770 rc = ata_pci_device_do_resume(pdev);
771 if (rc)
772 return rc;
774 sil_init_controller(host);
775 ata_host_resume(host);
777 return 0;
779 #endif
781 static int __init sil_init(void)
783 return pci_register_driver(&sil_pci_driver);
786 static void __exit sil_exit(void)
788 pci_unregister_driver(&sil_pci_driver);
792 module_init(sil_init);
793 module_exit(sil_exit);