1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
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>
47#include <linux/dmi.h>
48
49#define DRV_NAME "sata_sil"
50#define DRV_VERSION "2.4"
51
52#define SIL_DMA_BOUNDARY 0x7fffffffUL
53
54enum {
55 SIL_MMIO_BAR = 5,
56
57
58
59
60 SIL_FLAG_NO_SATA_IRQ = (1 << 28),
61 SIL_FLAG_RERR_ON_DMA_ACT = (1 << 29),
62 SIL_FLAG_MOD15WRITE = (1 << 30),
63
64 SIL_DFL_PORT_FLAGS = ATA_FLAG_SATA,
65
66
67
68
69 sil_3112 = 0,
70 sil_3112_no_sata_irq = 1,
71 sil_3512 = 2,
72 sil_3114 = 3,
73
74
75
76
77 SIL_SYSCFG = 0x48,
78
79
80
81
82
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,
90
91
92 SIL_INTR_STEERING = (1 << 1),
93
94 SIL_DMA_ENABLE = (1 << 0),
95 SIL_DMA_RDWR = (1 << 3),
96 SIL_DMA_SATA_IRQ = (1 << 4),
97 SIL_DMA_ACTIVE = (1 << 16),
98 SIL_DMA_ERROR = (1 << 17),
99 SIL_DMA_COMPLETE = (1 << 18),
100 SIL_DMA_N_SATA_IRQ = (1 << 6),
101 SIL_DMA_N_ACTIVE = (1 << 24),
102 SIL_DMA_N_ERROR = (1 << 25),
103 SIL_DMA_N_COMPLETE = (1 << 26),
104
105
106 SIL_SIEN_N = (1 << 16),
107
108
109
110
111 SIL_QUIRK_MOD15WRITE = (1 << 0),
112 SIL_QUIRK_UDMA5MAX = (1 << 1),
113};
114
115static int sil_init_one(struct pci_dev *pdev, const struct pci_device_id *ent);
116#ifdef CONFIG_PM
117static int sil_pci_device_resume(struct pci_dev *pdev);
118#endif
119static void sil_dev_config(struct ata_device *dev);
120static int sil_scr_read(struct ata_link *link, unsigned int sc_reg, u32 *val);
121static int sil_scr_write(struct ata_link *link, unsigned int sc_reg, u32 val);
122static int sil_set_mode(struct ata_link *link, struct ata_device **r_failed);
123static void sil_qc_prep(struct ata_queued_cmd *qc);
124static void sil_bmdma_setup(struct ata_queued_cmd *qc);
125static void sil_bmdma_start(struct ata_queued_cmd *qc);
126static void sil_bmdma_stop(struct ata_queued_cmd *qc);
127static void sil_freeze(struct ata_port *ap);
128static void sil_thaw(struct ata_port *ap);
129
130
131static 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 },
139
140 { }
141};
142
143
144
145static 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 },
161 { }
162};
163
164static 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
173};
174
175static struct scsi_host_template sil_sht = {
176 ATA_BASE_SHT(DRV_NAME),
177
178
179
180 .dma_boundary = SIL_DMA_BOUNDARY,
181 .sg_tablesize = ATA_MAX_PRD
182};
183
184static struct ata_port_operations sil_ops = {
185 .inherits = &ata_bmdma32_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,
196};
197
198static const struct ata_port_info sil_port_info[] = {
199
200 {
201 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_MOD15WRITE,
202 .pio_mask = ATA_PIO4,
203 .mwdma_mask = ATA_MWDMA2,
204 .udma_mask = ATA_UDMA5,
205 .port_ops = &sil_ops,
206 },
207
208 {
209 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_MOD15WRITE |
210 SIL_FLAG_NO_SATA_IRQ,
211 .pio_mask = ATA_PIO4,
212 .mwdma_mask = ATA_MWDMA2,
213 .udma_mask = ATA_UDMA5,
214 .port_ops = &sil_ops,
215 },
216
217 {
218 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_RERR_ON_DMA_ACT,
219 .pio_mask = ATA_PIO4,
220 .mwdma_mask = ATA_MWDMA2,
221 .udma_mask = ATA_UDMA5,
222 .port_ops = &sil_ops,
223 },
224
225 {
226 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_RERR_ON_DMA_ACT,
227 .pio_mask = ATA_PIO4,
228 .mwdma_mask = ATA_MWDMA2,
229 .udma_mask = ATA_UDMA5,
230 .port_ops = &sil_ops,
231 },
232};
233
234
235
236static const struct {
237 unsigned long tf;
238 unsigned long ctl;
239 unsigned long bmdma;
240 unsigned long bmdma2;
241 unsigned long fifo_cfg;
242 unsigned long scr;
243 unsigned long sien;
244 unsigned long xfer_mode;
245 unsigned long sfis_cfg;
246} sil_port[] = {
247
248
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
254};
255
256MODULE_AUTHOR("Jeff Garzik");
257MODULE_DESCRIPTION("low-level driver for Silicon Image SATA controller");
258MODULE_LICENSE("GPL");
259MODULE_DEVICE_TABLE(pci, sil_pci_tbl);
260MODULE_VERSION(DRV_VERSION);
261
262static int slow_down;
263module_param(slow_down, int, 0444);
264MODULE_PARM_DESC(slow_down, "Sledgehammer used to work around random problems, by limiting commands to 15 sectors (0=off, 1=on)");
265
266
267static void sil_bmdma_stop(struct ata_queued_cmd *qc)
268{
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;
272
273
274 iowrite8(0, bmdma2);
275
276
277 ata_sff_dma_pause(ap);
278}
279
280static void sil_bmdma_setup(struct ata_queued_cmd *qc)
281{
282 struct ata_port *ap = qc->ap;
283 void __iomem *bmdma = ap->ioaddr.bmdma_addr;
284
285
286 iowrite32(ap->bmdma_prd_dma, bmdma + ATA_DMA_TABLE_OFS);
287
288
289 ap->ops->sff_exec_command(ap, &qc->tf);
290}
291
292static void sil_bmdma_start(struct ata_queued_cmd *qc)
293{
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;
299
300
301
302
303 if (!rw)
304 dmactl |= ATA_DMA_WR;
305 iowrite8(dmactl, bmdma2);
306}
307
308
309static void sil_fill_sg(struct ata_queued_cmd *qc)
310{
311 struct scatterlist *sg;
312 struct ata_port *ap = qc->ap;
313 struct ata_bmdma_prd *prd, *last_prd = NULL;
314 unsigned int si;
315
316 prd = &ap->bmdma_prd[0];
317 for_each_sg(qc->sg, sg, qc->n_elem, si) {
318
319
320
321 u32 addr = (u32) sg_dma_address(sg);
322 u32 sg_len = sg_dma_len(sg);
323
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", si, addr, sg_len);
327
328 last_prd = prd;
329 prd++;
330 }
331
332 if (likely(last_prd))
333 last_prd->flags_len |= cpu_to_le32(ATA_PRD_EOT);
334}
335
336static void sil_qc_prep(struct ata_queued_cmd *qc)
337{
338 if (!(qc->flags & ATA_QCFLAG_DMAMAP))
339 return;
340
341 sil_fill_sg(qc);
342}
343
344static unsigned char sil_get_device_cache_line(struct pci_dev *pdev)
345{
346 u8 cache_line = 0;
347 pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE, &cache_line);
348 return cache_line;
349}
350
351
352
353
354
355
356
357
358
359
360static int sil_set_mode(struct ata_link *link, struct ata_device **r_failed)
361{
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;
368
369 rc = ata_do_set_mode(link, r_failed);
370 if (rc)
371 return rc;
372
373 ata_for_each_dev(dev, link, ALL) {
374 if (!ata_dev_enabled(dev))
375 dev_mode[dev->devno] = 0;
376 else if (dev->flags & ATA_DFLAG_PIO)
377 dev_mode[dev->devno] = 1;
378 else
379 dev_mode[dev->devno] = 3;
380
381 }
382
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);
389 return 0;
390}
391
392static inline void __iomem *sil_scr_addr(struct ata_port *ap,
393 unsigned int sc_reg)
394{
395 void __iomem *offset = ap->ioaddr.scr_addr;
396
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
406 break;
407 }
408
409 return NULL;
410}
411
412static int sil_scr_read(struct ata_link *link, unsigned int sc_reg, u32 *val)
413{
414 void __iomem *mmio = sil_scr_addr(link->ap, sc_reg);
415
416 if (mmio) {
417 *val = readl(mmio);
418 return 0;
419 }
420 return -EINVAL;
421}
422
423static int sil_scr_write(struct ata_link *link, unsigned int sc_reg, u32 val)
424{
425 void __iomem *mmio = sil_scr_addr(link->ap, sc_reg);
426
427 if (mmio) {
428 writel(val, mmio);
429 return 0;
430 }
431 return -EINVAL;
432}
433
434static void sil_host_intr(struct ata_port *ap, u32 bmdma2)
435{
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;
439
440 if (unlikely(bmdma2 & SIL_DMA_SATA_IRQ)) {
441 u32 serror;
442
443
444
445
446
447 sil_scr_read(&ap->link, SCR_ERROR, &serror);
448 sil_scr_write(&ap->link, SCR_ERROR, serror);
449
450
451
452
453 if (serror & SERR_PHYRDY_CHG) {
454 ap->link.eh_info.serror |= serror;
455 goto freeze;
456 }
457
458 if (!(bmdma2 & SIL_DMA_COMPLETE))
459 return;
460 }
461
462 if (unlikely(!qc || (qc->tf.flags & ATA_TFLAG_POLLING))) {
463
464 ap->ops->sff_check_status(ap);
465 return;
466 }
467
468
469 switch (ap->hsm_task_state) {
470 case HSM_ST_FIRST:
471
472
473
474
475
476
477
478
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
485 ap->ops->bmdma_stop(qc);
486
487 if (bmdma2 & SIL_DMA_ERROR) {
488 qc->err_mask |= AC_ERR_HOST_BUS;
489 ap->hsm_task_state = HSM_ST_ERR;
490 }
491 }
492 break;
493 case HSM_ST:
494 break;
495 default:
496 goto err_hsm;
497 }
498
499
500 status = ap->ops->sff_check_status(ap);
501 if (unlikely(status & ATA_BUSY))
502 goto err_hsm;
503
504
505 ata_bmdma_irq_clear(ap);
506
507
508 ata_sff_hsm_move(ap, qc, status, 0);
509
510 if (unlikely(qc->err_mask) && ata_is_dma(qc->tf.protocol))
511 ata_ehi_push_desc(ehi, "BMDMA2 stat 0x%x", bmdma2);
512
513 return;
514
515 err_hsm:
516 qc->err_mask |= AC_ERR_HSM;
517 freeze:
518 ata_port_freeze(ap);
519}
520
521static irqreturn_t sil_interrupt(int irq, void *dev_instance)
522{
523 struct ata_host *host = dev_instance;
524 void __iomem *mmio_base = host->iomap[SIL_MMIO_BAR];
525 int handled = 0;
526 int i;
527
528 spin_lock(&host->lock);
529
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);
533
534
535 if (ap->flags & SIL_FLAG_NO_SATA_IRQ)
536 bmdma2 &= ~SIL_DMA_SATA_IRQ;
537
538 if (bmdma2 == 0xffffffff ||
539 !(bmdma2 & (SIL_DMA_COMPLETE | SIL_DMA_SATA_IRQ)))
540 continue;
541
542 sil_host_intr(ap, bmdma2);
543 handled = 1;
544 }
545
546 spin_unlock(&host->lock);
547
548 return IRQ_RETVAL(handled);
549}
550
551static void sil_freeze(struct ata_port *ap)
552{
553 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
554 u32 tmp;
555
556
557 writel(0, mmio_base + sil_port[ap->port_no].sien);
558
559
560 tmp = readl(mmio_base + SIL_SYSCFG);
561 tmp |= SIL_MASK_IDE0_INT << ap->port_no;
562 writel(tmp, mmio_base + SIL_SYSCFG);
563 readl(mmio_base + SIL_SYSCFG);
564
565
566
567
568
569
570 iowrite8(ioread8(ap->ioaddr.bmdma_addr) & ~SIL_DMA_ENABLE,
571 ap->ioaddr.bmdma_addr);
572
573
574
575
576 ioread8(ap->ioaddr.bmdma_addr);
577}
578
579static void sil_thaw(struct ata_port *ap)
580{
581 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
582 u32 tmp;
583
584
585 ap->ops->sff_check_status(ap);
586 ata_bmdma_irq_clear(ap);
587
588
589 if (!(ap->flags & SIL_FLAG_NO_SATA_IRQ))
590 writel(SIL_SIEN_N, mmio_base + sil_port[ap->port_no].sien);
591
592
593 tmp = readl(mmio_base + SIL_SYSCFG);
594 tmp &= ~(SIL_MASK_IDE0_INT << ap->port_no);
595 writel(tmp, mmio_base + SIL_SYSCFG);
596}
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626static void sil_dev_config(struct ata_device *dev)
627{
628 struct ata_port *ap = dev->link->ap;
629 int print_info = ap->link.eh_context.i.flags & ATA_EHI_PRINTINFO;
630 unsigned int n, quirks = 0;
631 unsigned char model_num[ATA_ID_PROD_LEN + 1];
632
633 ata_id_c_string(dev->id, model_num, ATA_ID_PROD, sizeof(model_num));
634
635 for (n = 0; sil_blacklist[n].product; n++)
636 if (!strcmp(sil_blacklist[n].product, model_num)) {
637 quirks = sil_blacklist[n].quirk;
638 break;
639 }
640
641
642 if (slow_down ||
643 ((ap->flags & SIL_FLAG_MOD15WRITE) &&
644 (quirks & SIL_QUIRK_MOD15WRITE))) {
645 if (print_info)
646 ata_dev_printk(dev, KERN_INFO, "applying Seagate "
647 "errata fix (mod15write workaround)\n");
648 dev->max_sectors = 15;
649 return;
650 }
651
652
653 if (quirks & SIL_QUIRK_UDMA5MAX) {
654 if (print_info)
655 ata_dev_printk(dev, KERN_INFO, "applying Maxtor "
656 "errata fix %s\n", model_num);
657 dev->udma_mask &= ATA_UDMA5;
658 return;
659 }
660}
661
662static void sil_init_controller(struct ata_host *host)
663{
664 struct pci_dev *pdev = to_pci_dev(host->dev);
665 void __iomem *mmio_base = host->iomap[SIL_MMIO_BAR];
666 u8 cls;
667 u32 tmp;
668 int i;
669
670
671 cls = sil_get_device_cache_line(pdev);
672 if (cls) {
673 cls >>= 3;
674 cls++;
675 for (i = 0; i < host->n_ports; i++)
676 writew(cls << 8 | cls,
677 mmio_base + sil_port[i].fifo_cfg);
678 } else
679 dev_printk(KERN_WARNING, &pdev->dev,
680 "cache line size not set. Driver may not function\n");
681
682
683 if (host->ports[0]->flags & SIL_FLAG_RERR_ON_DMA_ACT) {
684 int cnt;
685
686 for (i = 0, cnt = 0; i < host->n_ports; i++) {
687 tmp = readl(mmio_base + sil_port[i].sfis_cfg);
688 if ((tmp & 0x3) != 0x01)
689 continue;
690 if (!cnt)
691 dev_printk(KERN_INFO, &pdev->dev,
692 "Applying R_ERR on DMA activate "
693 "FIS errata fix\n");
694 writel(tmp & ~0x3, mmio_base + sil_port[i].sfis_cfg);
695 cnt++;
696 }
697 }
698
699 if (host->n_ports == 4) {
700
701 tmp = readl(mmio_base + sil_port[2].bmdma);
702 if ((tmp & SIL_INTR_STEERING) == 0)
703 writel(tmp | SIL_INTR_STEERING,
704 mmio_base + sil_port[2].bmdma);
705 }
706}
707
708static bool sil_broken_system_poweroff(struct pci_dev *pdev)
709{
710 static const struct dmi_system_id broken_systems[] = {
711 {
712 .ident = "HP Compaq nx6325",
713 .matches = {
714 DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
715 DMI_MATCH(DMI_PRODUCT_NAME, "HP Compaq nx6325"),
716 },
717
718 .driver_data = (void *)0x12UL,
719 },
720
721 { }
722 };
723 const struct dmi_system_id *dmi = dmi_first_match(broken_systems);
724
725 if (dmi) {
726 unsigned long slot = (unsigned long)dmi->driver_data;
727
728 return slot == PCI_SLOT(pdev->devfn);
729 }
730
731 return false;
732}
733
734static int sil_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
735{
736 static int printed_version;
737 int board_id = ent->driver_data;
738 struct ata_port_info pi = sil_port_info[board_id];
739 const struct ata_port_info *ppi[] = { &pi, NULL };
740 struct ata_host *host;
741 void __iomem *mmio_base;
742 int n_ports, rc;
743 unsigned int i;
744
745 if (!printed_version++)
746 dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
747
748
749 n_ports = 2;
750 if (board_id == sil_3114)
751 n_ports = 4;
752
753 if (sil_broken_system_poweroff(pdev)) {
754 pi.flags |= ATA_FLAG_NO_POWEROFF_SPINDOWN |
755 ATA_FLAG_NO_HIBERNATE_SPINDOWN;
756 dev_info(&pdev->dev, "quirky BIOS, skipping spindown "
757 "on poweroff and hibernation\n");
758 }
759
760 host = ata_host_alloc_pinfo(&pdev->dev, ppi, n_ports);
761 if (!host)
762 return -ENOMEM;
763
764
765 rc = pcim_enable_device(pdev);
766 if (rc)
767 return rc;
768
769 rc = pcim_iomap_regions(pdev, 1 << SIL_MMIO_BAR, DRV_NAME);
770 if (rc == -EBUSY)
771 pcim_pin_device(pdev);
772 if (rc)
773 return rc;
774 host->iomap = pcim_iomap_table(pdev);
775
776 rc = pci_set_dma_mask(pdev, ATA_DMA_MASK);
777 if (rc)
778 return rc;
779 rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK);
780 if (rc)
781 return rc;
782
783 mmio_base = host->iomap[SIL_MMIO_BAR];
784
785 for (i = 0; i < host->n_ports; i++) {
786 struct ata_port *ap = host->ports[i];
787 struct ata_ioports *ioaddr = &ap->ioaddr;
788
789 ioaddr->cmd_addr = mmio_base + sil_port[i].tf;
790 ioaddr->altstatus_addr =
791 ioaddr->ctl_addr = mmio_base + sil_port[i].ctl;
792 ioaddr->bmdma_addr = mmio_base + sil_port[i].bmdma;
793 ioaddr->scr_addr = mmio_base + sil_port[i].scr;
794 ata_sff_std_ports(ioaddr);
795
796 ata_port_pbar_desc(ap, SIL_MMIO_BAR, -1, "mmio");
797 ata_port_pbar_desc(ap, SIL_MMIO_BAR, sil_port[i].tf, "tf");
798 }
799
800
801 sil_init_controller(host);
802
803 pci_set_master(pdev);
804 return ata_host_activate(host, pdev->irq, sil_interrupt, IRQF_SHARED,
805 &sil_sht);
806}
807
808#ifdef CONFIG_PM
809static int sil_pci_device_resume(struct pci_dev *pdev)
810{
811 struct ata_host *host = dev_get_drvdata(&pdev->dev);
812 int rc;
813
814 rc = ata_pci_device_do_resume(pdev);
815 if (rc)
816 return rc;
817
818 sil_init_controller(host);
819 ata_host_resume(host);
820
821 return 0;
822}
823#endif
824
825static int __init sil_init(void)
826{
827 return pci_register_driver(&sil_pci_driver);
828}
829
830static void __exit sil_exit(void)
831{
832 pci_unregister_driver(&sil_pci_driver);
833}
834
835
836module_init(sil_init);
837module_exit(sil_exit);
838