?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
added 2.6.29.6 aldebaran kernel
[nao-ulib.git] / kernel / 2.6.29.6-aldebaran-rt / drivers / ata / sata_sil.c
blobd0091609e210bde14a9c5eb85c0ab9f26dd3b087
1 /*
2 * sata_sil.c - Silicon Image SATA
3 *
4 * Maintained by: Jeff Garzik <jgarzik@pobox.com>
5 * Please ALWAYS copy linux-ide@vger.kernel.org
6 * on emails.
7 *
8 * Copyright 2003-2005 Red Hat, Inc.
9 * Copyright 2003 Benjamin Herrenschmidt
10 *
11 *
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.
16 *
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.
21 *
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.
25 *
26 *
27 * libata documentation is available via 'make {ps|pdf}docs',
28 * as Documentation/DocBook/libata.*
29 *
30 * Documentation for SiI 3112:
31 * http://gkernel.sourceforge.net/specs/sii/3112A_SiI-DS-0095-B2.pdf.bz2
32 *
33 * Other errata and documentation available under NDA.
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
54 enum {
55 SIL_MMIO_BAR = 5,
56
57 /*
58 * host flags
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 | ATA_FLAG_NO_LEGACY |
65 ATA_FLAG_MMIO,
66
67 /*
68 * Controller IDs
69 */
70 sil_3112 = 0,
71 sil_3112_no_sata_irq = 1,
72 sil_3512 = 2,
73 sil_3114 = 3,
74
75 /*
76 * Register offsets
77 */
78 SIL_SYSCFG = 0x48,
79
80 /*
81 * Register bits
82 */
83 /* SYSCFG */
84 SIL_MASK_IDE0_INT = (1 << 22),
85 SIL_MASK_IDE1_INT = (1 << 23),
86 SIL_MASK_IDE2_INT = (1 << 24),
87 SIL_MASK_IDE3_INT = (1 << 25),
88 SIL_MASK_2PORT = SIL_MASK_IDE0_INT | SIL_MASK_IDE1_INT,
89 SIL_MASK_4PORT = SIL_MASK_2PORT |
90 SIL_MASK_IDE2_INT | SIL_MASK_IDE3_INT,
91
92 /* BMDMA/BMDMA2 */
93 SIL_INTR_STEERING = (1 << 1),
94
95 SIL_DMA_ENABLE = (1 << 0), /* DMA run switch */
96 SIL_DMA_RDWR = (1 << 3), /* DMA Rd-Wr */
97 SIL_DMA_SATA_IRQ = (1 << 4), /* OR of all SATA IRQs */
98 SIL_DMA_ACTIVE = (1 << 16), /* DMA running */
99 SIL_DMA_ERROR = (1 << 17), /* PCI bus error */
100 SIL_DMA_COMPLETE = (1 << 18), /* cmd complete / IRQ pending */
101 SIL_DMA_N_SATA_IRQ = (1 << 6), /* SATA_IRQ for the next channel */
102 SIL_DMA_N_ACTIVE = (1 << 24), /* ACTIVE for the next channel */
103 SIL_DMA_N_ERROR = (1 << 25), /* ERROR for the next channel */
104 SIL_DMA_N_COMPLETE = (1 << 26), /* COMPLETE for the next channel */
105
106 /* SIEN */
107 SIL_SIEN_N = (1 << 16), /* triggered by SError.N */
108
109 /*
110 * Others
111 */
112 SIL_QUIRK_MOD15WRITE = (1 << 0),
113 SIL_QUIRK_UDMA5MAX = (1 << 1),
114 };
115
116 static int sil_init_one(struct pci_dev *pdev, const struct pci_device_id *ent);
117 #ifdef CONFIG_PM
118 static int sil_pci_device_resume(struct pci_dev *pdev);
119 #endif
120 static void sil_dev_config(struct ata_device *dev);
121 static int sil_scr_read(struct ata_link *link, unsigned int sc_reg, u32 *val);
122 static int sil_scr_write(struct ata_link *link, unsigned int sc_reg, u32 val);
123 static int sil_set_mode(struct ata_link *link, struct ata_device **r_failed);
124 static void sil_qc_prep(struct ata_queued_cmd *qc);
125 static void sil_bmdma_setup(struct ata_queued_cmd *qc);
126 static void sil_bmdma_start(struct ata_queued_cmd *qc);
127 static void sil_bmdma_stop(struct ata_queued_cmd *qc);
128 static void sil_freeze(struct ata_port *ap);
129 static void sil_thaw(struct ata_port *ap);
130
131
132 static const struct pci_device_id sil_pci_tbl[] = {
133 { PCI_VDEVICE(CMD, 0x3112), sil_3112 },
134 { PCI_VDEVICE(CMD, 0x0240), sil_3112 },
135 { PCI_VDEVICE(CMD, 0x3512), sil_3512 },
136 { PCI_VDEVICE(CMD, 0x3114), sil_3114 },
137 { PCI_VDEVICE(ATI, 0x436e), sil_3112 },
138 { PCI_VDEVICE(ATI, 0x4379), sil_3112_no_sata_irq },
139 { PCI_VDEVICE(ATI, 0x437a), sil_3112_no_sata_irq },
140
141 { } /* terminate list */
142 };
143
144
145 /* TODO firmware versions should be added - eric */
146 static const struct sil_drivelist {
147 const char *product;
148 unsigned int quirk;
149 } sil_blacklist [] = {
150 { "ST320012AS", SIL_QUIRK_MOD15WRITE },
151 { "ST330013AS", SIL_QUIRK_MOD15WRITE },
152 { "ST340017AS", SIL_QUIRK_MOD15WRITE },
153 { "ST360015AS", SIL_QUIRK_MOD15WRITE },
154 { "ST380023AS", SIL_QUIRK_MOD15WRITE },
155 { "ST3120023AS", SIL_QUIRK_MOD15WRITE },
156 { "ST340014ASL", SIL_QUIRK_MOD15WRITE },
157 { "ST360014ASL", SIL_QUIRK_MOD15WRITE },
158 { "ST380011ASL", SIL_QUIRK_MOD15WRITE },
159 { "ST3120022ASL", SIL_QUIRK_MOD15WRITE },
160 { "ST3160021ASL", SIL_QUIRK_MOD15WRITE },
161 { "Maxtor 4D060H3", SIL_QUIRK_UDMA5MAX },
162 { }
163 };
164
165 static struct pci_driver sil_pci_driver = {
166 .name = DRV_NAME,
167 .id_table = sil_pci_tbl,
168 .probe = sil_init_one,
169 .remove = ata_pci_remove_one,
170 #ifdef CONFIG_PM
171 .suspend = ata_pci_device_suspend,
172 .resume = sil_pci_device_resume,
173 #endif
174 };
175
176 static struct scsi_host_template sil_sht = {
177 ATA_BASE_SHT(DRV_NAME),
178 /** These controllers support Large Block Transfer which allows
179 transfer chunks up to 2GB and which cross 64KB boundaries,
180 therefore the DMA limits are more relaxed than standard ATA SFF. */
181 .dma_boundary = SIL_DMA_BOUNDARY,
182 .sg_tablesize = ATA_MAX_PRD
183 };
184
185 static struct ata_port_operations sil_ops = {
186 .inherits = &ata_bmdma_port_ops,
187 .dev_config = sil_dev_config,
188 .set_mode = sil_set_mode,
189 .bmdma_setup = sil_bmdma_setup,
190 .bmdma_start = sil_bmdma_start,
191 .bmdma_stop = sil_bmdma_stop,
192 .qc_prep = sil_qc_prep,
193 .freeze = sil_freeze,
194 .thaw = sil_thaw,
195 .scr_read = sil_scr_read,
196 .scr_write = sil_scr_write,
197 };
198
199 static const struct ata_port_info sil_port_info[] = {
200 /* sil_3112 */
201 {
202 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_MOD15WRITE,
203 .pio_mask = 0x1f, /* pio0-4 */
204 .mwdma_mask = 0x07, /* mwdma0-2 */
205 .udma_mask = ATA_UDMA5,
206 .port_ops = &sil_ops,
207 },
208 /* sil_3112_no_sata_irq */
209 {
210 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_MOD15WRITE |
211 SIL_FLAG_NO_SATA_IRQ,
212 .pio_mask = 0x1f, /* pio0-4 */
213 .mwdma_mask = 0x07, /* mwdma0-2 */
214 .udma_mask = ATA_UDMA5,
215 .port_ops = &sil_ops,
216 },
217 /* sil_3512 */
218 {
219 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_RERR_ON_DMA_ACT,
220 .pio_mask = 0x1f, /* pio0-4 */
221 .mwdma_mask = 0x07, /* mwdma0-2 */
222 .udma_mask = ATA_UDMA5,
223 .port_ops = &sil_ops,
224 },
225 /* sil_3114 */
226 {
227 .flags = SIL_DFL_PORT_FLAGS | SIL_FLAG_RERR_ON_DMA_ACT,
228 .pio_mask = 0x1f, /* pio0-4 */
229 .mwdma_mask = 0x07, /* mwdma0-2 */
230 .udma_mask = ATA_UDMA5,
231 .port_ops = &sil_ops,
232 },
233 };
234
235 /* per-port register offsets */
236 /* TODO: we can probably calculate rather than use a table */
237 static const struct {
238 unsigned long tf; /* ATA taskfile register block */
239 unsigned long ctl; /* ATA control/altstatus register block */
240 unsigned long bmdma; /* DMA register block */
241 unsigned long bmdma2; /* DMA register block #2 */
242 unsigned long fifo_cfg; /* FIFO Valid Byte Count and Control */
243 unsigned long scr; /* SATA control register block */
244 unsigned long sien; /* SATA Interrupt Enable register */
245 unsigned long xfer_mode;/* data transfer mode register */
246 unsigned long sfis_cfg; /* SATA FIS reception config register */
247 } sil_port[] = {
248 /* port 0 ... */
249 /* tf ctl bmdma bmdma2 fifo scr sien mode sfis */
250 { 0x80, 0x8A, 0x0, 0x10, 0x40, 0x100, 0x148, 0xb4, 0x14c },
251 { 0xC0, 0xCA, 0x8, 0x18, 0x44, 0x180, 0x1c8, 0xf4, 0x1cc },
252 { 0x280, 0x28A, 0x200, 0x210, 0x240, 0x300, 0x348, 0x2b4, 0x34c },
253 { 0x2C0, 0x2CA, 0x208, 0x218, 0x244, 0x380, 0x3c8, 0x2f4, 0x3cc },
254 /* ... port 3 */
255 };
256
257 MODULE_AUTHOR("Jeff Garzik");
258 MODULE_DESCRIPTION("low-level driver for Silicon Image SATA controller");
259 MODULE_LICENSE("GPL");
260 MODULE_DEVICE_TABLE(pci, sil_pci_tbl);
261 MODULE_VERSION(DRV_VERSION);
262
263 static int slow_down;
264 module_param(slow_down, int, 0444);
265 MODULE_PARM_DESC(slow_down, "Sledgehammer used to work around random problems, by limiting commands to 15 sectors (0=off, 1=on)");
266
267
268 static void sil_bmdma_stop(struct ata_queued_cmd *qc)
269 {
270 struct ata_port *ap = qc->ap;
271 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
272 void __iomem *bmdma2 = mmio_base + sil_port[ap->port_no].bmdma2;
273
274 /* clear start/stop bit - can safely always write 0 */
275 iowrite8(0, bmdma2);
276
277 /* one-PIO-cycle guaranteed wait, per spec, for HDMA1:0 transition */
278 ata_sff_dma_pause(ap);
279 }
280
281 static void sil_bmdma_setup(struct ata_queued_cmd *qc)
282 {
283 struct ata_port *ap = qc->ap;
284 void __iomem *bmdma = ap->ioaddr.bmdma_addr;
285
286 /* load PRD table addr. */
287 iowrite32(ap->prd_dma, bmdma + ATA_DMA_TABLE_OFS);
288
289 /* issue r/w command */
290 ap->ops->sff_exec_command(ap, &qc->tf);
291 }
292
293 static void sil_bmdma_start(struct ata_queued_cmd *qc)
294 {
295 unsigned int rw = (qc->tf.flags & ATA_TFLAG_WRITE);
296 struct ata_port *ap = qc->ap;
297 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
298 void __iomem *bmdma2 = mmio_base + sil_port[ap->port_no].bmdma2;
299 u8 dmactl = ATA_DMA_START;
300
301 /* set transfer direction, start host DMA transaction
302 Note: For Large Block Transfer to work, the DMA must be started
303 using the bmdma2 register. */
304 if (!rw)
305 dmactl |= ATA_DMA_WR;
306 iowrite8(dmactl, bmdma2);
307 }
308
309 /* The way God intended PCI IDE scatter/gather lists to look and behave... */
310 static void sil_fill_sg(struct ata_queued_cmd *qc)
311 {
312 struct scatterlist *sg;
313 struct ata_port *ap = qc->ap;
314 struct ata_prd *prd, *last_prd = NULL;
315 unsigned int si;
316
317 prd = &ap->prd[0];
318 for_each_sg(qc->sg, sg, qc->n_elem, si) {
319 /* Note h/w doesn't support 64-bit, so we unconditionally
320 * truncate dma_addr_t to u32.
321 */
322 u32 addr = (u32) sg_dma_address(sg);
323 u32 sg_len = sg_dma_len(sg);
324
325 prd->addr = cpu_to_le32(addr);
326 prd->flags_len = cpu_to_le32(sg_len);
327 VPRINTK("PRD[%u] = (0x%X, 0x%X)\n", si, addr, sg_len);
328
329 last_prd = prd;
330 prd++;
331 }
332
333 if (likely(last_prd))
334 last_prd->flags_len |= cpu_to_le32(ATA_PRD_EOT);
335 }
336
337 static void sil_qc_prep(struct ata_queued_cmd *qc)
338 {
339 if (!(qc->flags & ATA_QCFLAG_DMAMAP))
340 return;
341
342 sil_fill_sg(qc);
343 }
344
345 static unsigned char sil_get_device_cache_line(struct pci_dev *pdev)
346 {
347 u8 cache_line = 0;
348 pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE, &cache_line);
349 return cache_line;
350 }
351
352 /**
353 * sil_set_mode - wrap set_mode functions
354 * @link: link to set up
355 * @r_failed: returned device when we fail
356 *
357 * Wrap the libata method for device setup as after the setup we need
358 * to inspect the results and do some configuration work
359 */
360
361 static int sil_set_mode(struct ata_link *link, struct ata_device **r_failed)
362 {
363 struct ata_port *ap = link->ap;
364 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
365 void __iomem *addr = mmio_base + sil_port[ap->port_no].xfer_mode;
366 struct ata_device *dev;
367 u32 tmp, dev_mode[2] = { };
368 int rc;
369
370 rc = ata_do_set_mode(link, r_failed);
371 if (rc)
372 return rc;
373
374 ata_for_each_dev(dev, link, ALL) {
375 if (!ata_dev_enabled(dev))
376 dev_mode[dev->devno] = 0; /* PIO0/1/2 */
377 else if (dev->flags & ATA_DFLAG_PIO)
378 dev_mode[dev->devno] = 1; /* PIO3/4 */
379 else
380 dev_mode[dev->devno] = 3; /* UDMA */
381 /* value 2 indicates MDMA */
382 }
383
384 tmp = readl(addr);
385 tmp &= ~((1<<5) | (1<<4) | (1<<1) | (1<<0));
386 tmp |= dev_mode[0];
387 tmp |= (dev_mode[1] << 4);
388 writel(tmp, addr);
389 readl(addr); /* flush */
390 return 0;
391 }
392
393 static inline void __iomem *sil_scr_addr(struct ata_port *ap,
394 unsigned int sc_reg)
395 {
396 void __iomem *offset = ap->ioaddr.scr_addr;
397
398 switch (sc_reg) {
399 case SCR_STATUS:
400 return offset + 4;
401 case SCR_ERROR:
402 return offset + 8;
403 case SCR_CONTROL:
404 return offset;
405 default:
406 /* do nothing */
407 break;
408 }
409
410 return NULL;
411 }
412
413 static int sil_scr_read(struct ata_link *link, unsigned int sc_reg, u32 *val)
414 {
415 void __iomem *mmio = sil_scr_addr(link->ap, sc_reg);
416
417 if (mmio) {
418 *val = readl(mmio);
419 return 0;
420 }
421 return -EINVAL;
422 }
423
424 static int sil_scr_write(struct ata_link *link, unsigned int sc_reg, u32 val)
425 {
426 void __iomem *mmio = sil_scr_addr(link->ap, sc_reg);
427
428 if (mmio) {
429 writel(val, mmio);
430 return 0;
431 }
432 return -EINVAL;
433 }
434
435 static void sil_host_intr(struct ata_port *ap, u32 bmdma2)
436 {
437 struct ata_eh_info *ehi = &ap->link.eh_info;
438 struct ata_queued_cmd *qc = ata_qc_from_tag(ap, ap->link.active_tag);
439 u8 status;
440
441 if (unlikely(bmdma2 & SIL_DMA_SATA_IRQ)) {
442 u32 serror;
443
444 /* SIEN doesn't mask SATA IRQs on some 3112s. Those
445 * controllers continue to assert IRQ as long as
446 * SError bits are pending. Clear SError immediately.
447 */
448 sil_scr_read(&ap->link, SCR_ERROR, &serror);
449 sil_scr_write(&ap->link, SCR_ERROR, serror);
450
451 /* Sometimes spurious interrupts occur, double check
452 * it's PHYRDY CHG.
453 */
454 if (serror & SERR_PHYRDY_CHG) {
455 ap->link.eh_info.serror |= serror;
456 goto freeze;
457 }
458
459 if (!(bmdma2 & SIL_DMA_COMPLETE))
460 return;
461 }
462
463 if (unlikely(!qc || (qc->tf.flags & ATA_TFLAG_POLLING))) {
464 /* this sometimes happens, just clear IRQ */
465 ap->ops->sff_check_status(ap);
466 return;
467 }
468
469 /* Check whether we are expecting interrupt in this state */
470 switch (ap->hsm_task_state) {
471 case HSM_ST_FIRST:
472 /* Some pre-ATAPI-4 devices assert INTRQ
473 * at this state when ready to receive CDB.
474 */
475
476 /* Check the ATA_DFLAG_CDB_INTR flag is enough here.
477 * The flag was turned on only for atapi devices. No
478 * need to check ata_is_atapi(qc->tf.protocol) again.
479 */
480 if (!(qc->dev->flags & ATA_DFLAG_CDB_INTR))
481 goto err_hsm;
482 break;
483 case HSM_ST_LAST:
484 if (ata_is_dma(qc->tf.protocol)) {
485 /* clear DMA-Start bit */
486 ap->ops->bmdma_stop(qc);
487
488 if (bmdma2 & SIL_DMA_ERROR) {
489 qc->err_mask |= AC_ERR_HOST_BUS;
490 ap->hsm_task_state = HSM_ST_ERR;
491 }
492 }
493 break;
494 case HSM_ST:
495 break;
496 default:
497 goto err_hsm;
498 }
499
500 /* check main status, clearing INTRQ */
501 status = ap->ops->sff_check_status(ap);
502 if (unlikely(status & ATA_BUSY))
503 goto err_hsm;
504
505 /* ack bmdma irq events */
506 ata_sff_irq_clear(ap);
507
508 /* kick HSM in the ass */
509 ata_sff_hsm_move(ap, qc, status, 0);
510
511 if (unlikely(qc->err_mask) && ata_is_dma(qc->tf.protocol))
512 ata_ehi_push_desc(ehi, "BMDMA2 stat 0x%x", bmdma2);
513
514 return;
515
516 err_hsm:
517 qc->err_mask |= AC_ERR_HSM;
518 freeze:
519 ata_port_freeze(ap);
520 }
521
522 static irqreturn_t sil_interrupt(int irq, void *dev_instance)
523 {
524 struct ata_host *host = dev_instance;
525 void __iomem *mmio_base = host->iomap[SIL_MMIO_BAR];
526 int handled = 0;
527 int i;
528
529 spin_lock(&host->lock);
530
531 for (i = 0; i < host->n_ports; i++) {
532 struct ata_port *ap = host->ports[i];
533 u32 bmdma2 = readl(mmio_base + sil_port[ap->port_no].bmdma2);
534
535 if (unlikely(!ap || ap->flags & ATA_FLAG_DISABLED))
536 continue;
537
538 /* turn off SATA_IRQ if not supported */
539 if (ap->flags & SIL_FLAG_NO_SATA_IRQ)
540 bmdma2 &= ~SIL_DMA_SATA_IRQ;
541
542 if (bmdma2 == 0xffffffff ||
543 !(bmdma2 & (SIL_DMA_COMPLETE | SIL_DMA_SATA_IRQ)))
544 continue;
545
546 sil_host_intr(ap, bmdma2);
547 handled = 1;
548 }
549
550 spin_unlock(&host->lock);
551
552 return IRQ_RETVAL(handled);
553 }
554
555 static void sil_freeze(struct ata_port *ap)
556 {
557 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
558 u32 tmp;
559
560 /* global IRQ mask doesn't block SATA IRQ, turn off explicitly */
561 writel(0, mmio_base + sil_port[ap->port_no].sien);
562
563 /* plug IRQ */
564 tmp = readl(mmio_base + SIL_SYSCFG);
565 tmp |= SIL_MASK_IDE0_INT << ap->port_no;
566 writel(tmp, mmio_base + SIL_SYSCFG);
567 readl(mmio_base + SIL_SYSCFG); /* flush */
568 }
569
570 static void sil_thaw(struct ata_port *ap)
571 {
572 void __iomem *mmio_base = ap->host->iomap[SIL_MMIO_BAR];
573 u32 tmp;
574
575 /* clear IRQ */
576 ap->ops->sff_check_status(ap);
577 ata_sff_irq_clear(ap);
578
579 /* turn on SATA IRQ if supported */
580 if (!(ap->flags & SIL_FLAG_NO_SATA_IRQ))
581 writel(SIL_SIEN_N, mmio_base + sil_port[ap->port_no].sien);
582
583 /* turn on IRQ */
584 tmp = readl(mmio_base + SIL_SYSCFG);
585 tmp &= ~(SIL_MASK_IDE0_INT << ap->port_no);
586 writel(tmp, mmio_base + SIL_SYSCFG);
587 }
588
589 /**
590 * sil_dev_config - Apply device/host-specific errata fixups
591 * @dev: Device to be examined
592 *
593 * After the IDENTIFY [PACKET] DEVICE step is complete, and a
594 * device is known to be present, this function is called.
595 * We apply two errata fixups which are specific to Silicon Image,
596 * a Seagate and a Maxtor fixup.
597 *
598 * For certain Seagate devices, we must limit the maximum sectors
599 * to under 8K.
600 *
601 * For certain Maxtor devices, we must not program the drive
602 * beyond udma5.
603 *
604 * Both fixups are unfairly pessimistic. As soon as I get more
605 * information on these errata, I will create a more exhaustive
606 * list, and apply the fixups to only the specific
607 * devices/hosts/firmwares that need it.
608 *
609 * 20040111 - Seagate drives affected by the Mod15Write bug are blacklisted
610 * The Maxtor quirk is in the blacklist, but I'm keeping the original
611 * pessimistic fix for the following reasons...
612 * - There seems to be less info on it, only one device gleaned off the
613 * Windows driver, maybe only one is affected. More info would be greatly
614 * appreciated.
615 * - But then again UDMA5 is hardly anything to complain about
616 */
617 static void sil_dev_config(struct ata_device *dev)
618 {
619 struct ata_port *ap = dev->link->ap;
620 int print_info = ap->link.eh_context.i.flags & ATA_EHI_PRINTINFO;
621 unsigned int n, quirks = 0;
622 unsigned char model_num[ATA_ID_PROD_LEN + 1];
623
624 ata_id_c_string(dev->id, model_num, ATA_ID_PROD, sizeof(model_num));
625
626 for (n = 0; sil_blacklist[n].product; n++)
627 if (!strcmp(sil_blacklist[n].product, model_num)) {
628 quirks = sil_blacklist[n].quirk;
629 break;
630 }
631
632 /* limit requests to 15 sectors */
633 if (slow_down ||
634 ((ap->flags & SIL_FLAG_MOD15WRITE) &&
635 (quirks & SIL_QUIRK_MOD15WRITE))) {
636 if (print_info)
637 ata_dev_printk(dev, KERN_INFO, "applying Seagate "
638 "errata fix (mod15write workaround)\n");
639 dev->max_sectors = 15;
640 return;
641 }
642
643 /* limit to udma5 */
644 if (quirks & SIL_QUIRK_UDMA5MAX) {
645 if (print_info)
646 ata_dev_printk(dev, KERN_INFO, "applying Maxtor "
647 "errata fix %s\n", model_num);
648 dev->udma_mask &= ATA_UDMA5;
649 return;
650 }
651 }
652
653 static void sil_init_controller(struct ata_host *host)
654 {
655 struct pci_dev *pdev = to_pci_dev(host->dev);
656 void __iomem *mmio_base = host->iomap[SIL_MMIO_BAR];
657 u8 cls;
658 u32 tmp;
659 int i;
660
661 /* Initialize FIFO PCI bus arbitration */
662 cls = sil_get_device_cache_line(pdev);
663 if (cls) {
664 cls >>= 3;
665 cls++; /* cls = (line_size/8)+1 */
666 for (i = 0; i < host->n_ports; i++)
667 writew(cls << 8 | cls,
668 mmio_base + sil_port[i].fifo_cfg);
669 } else
670 dev_printk(KERN_WARNING, &pdev->dev,
671 "cache line size not set. Driver may not function\n");
672
673 /* Apply R_ERR on DMA activate FIS errata workaround */
674 if (host->ports[0]->flags & SIL_FLAG_RERR_ON_DMA_ACT) {
675 int cnt;
676
677 for (i = 0, cnt = 0; i < host->n_ports; i++) {
678 tmp = readl(mmio_base + sil_port[i].sfis_cfg);
679 if ((tmp & 0x3) != 0x01)
680 continue;
681 if (!cnt)
682 dev_printk(KERN_INFO, &pdev->dev,
683 "Applying R_ERR on DMA activate "
684 "FIS errata fix\n");
685 writel(tmp & ~0x3, mmio_base + sil_port[i].sfis_cfg);
686 cnt++;
687 }
688 }
689
690 if (host->n_ports == 4) {
691 /* flip the magic "make 4 ports work" bit */
692 tmp = readl(mmio_base + sil_port[2].bmdma);
693 if ((tmp & SIL_INTR_STEERING) == 0)
694 writel(tmp | SIL_INTR_STEERING,
695 mmio_base + sil_port[2].bmdma);
696 }
697 }
698
699 static bool sil_broken_system_poweroff(struct pci_dev *pdev)
700 {
701 static const struct dmi_system_id broken_systems[] = {
702 {
703 .ident = "HP Compaq nx6325",
704 .matches = {
705 DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
706 DMI_MATCH(DMI_PRODUCT_NAME, "HP Compaq nx6325"),
707 },
708 /* PCI slot number of the controller */
709 .driver_data = (void *)0x12UL,
710 },
711
712 { } /* terminate list */
713 };
714 const struct dmi_system_id *dmi = dmi_first_match(broken_systems);
715
716 if (dmi) {
717 unsigned long slot = (unsigned long)dmi->driver_data;
718 /* apply the quirk only to on-board controllers */
719 return slot == PCI_SLOT(pdev->devfn);
720 }
721
722 return false;
723 }
724
725 static int sil_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
726 {
727 static int printed_version;
728 int board_id = ent->driver_data;
729 struct ata_port_info pi = sil_port_info[board_id];
730 const struct ata_port_info *ppi[] = { &pi, NULL };
731 struct ata_host *host;
732 void __iomem *mmio_base;
733 int n_ports, rc;
734 unsigned int i;
735
736 if (!printed_version++)
737 dev_printk(KERN_DEBUG, &pdev->dev, "version " DRV_VERSION "\n");
738
739 /* allocate host */
740 n_ports = 2;
741 if (board_id == sil_3114)
742 n_ports = 4;
743
744 if (sil_broken_system_poweroff(pdev)) {
745 pi.flags |= ATA_FLAG_NO_POWEROFF_SPINDOWN |
746 ATA_FLAG_NO_HIBERNATE_SPINDOWN;
747 dev_info(&pdev->dev, "quirky BIOS, skipping spindown "
748 "on poweroff and hibernation\n");
749 }
750
751 host = ata_host_alloc_pinfo(&pdev->dev, ppi, n_ports);
752 if (!host)
753 return -ENOMEM;
754
755 /* acquire resources and fill host */
756 rc = pcim_enable_device(pdev);
757 if (rc)
758 return rc;
759
760 rc = pcim_iomap_regions(pdev, 1 << SIL_MMIO_BAR, DRV_NAME);
761 if (rc == -EBUSY)
762 pcim_pin_device(pdev);
763 if (rc)
764 return rc;
765 host->iomap = pcim_iomap_table(pdev);
766
767 rc = pci_set_dma_mask(pdev, ATA_DMA_MASK);
768 if (rc)
769 return rc;
770 rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK);
771 if (rc)
772 return rc;
773
774 mmio_base = host->iomap[SIL_MMIO_BAR];
775
776 for (i = 0; i < host->n_ports; i++) {
777 struct ata_port *ap = host->ports[i];
778 struct ata_ioports *ioaddr = &ap->ioaddr;
779
780 ioaddr->cmd_addr = mmio_base + sil_port[i].tf;
781 ioaddr->altstatus_addr =
782 ioaddr->ctl_addr = mmio_base + sil_port[i].ctl;
783 ioaddr->bmdma_addr = mmio_base + sil_port[i].bmdma;
784 ioaddr->scr_addr = mmio_base + sil_port[i].scr;
785 ata_sff_std_ports(ioaddr);
786
787 ata_port_pbar_desc(ap, SIL_MMIO_BAR, -1, "mmio");
788 ata_port_pbar_desc(ap, SIL_MMIO_BAR, sil_port[i].tf, "tf");
789 }
790
791 /* initialize and activate */
792 sil_init_controller(host);
793
794 pci_set_master(pdev);
795 return ata_host_activate(host, pdev->irq, sil_interrupt, IRQF_SHARED,
796 &sil_sht);
797 }
798
799 #ifdef CONFIG_PM
800 static int sil_pci_device_resume(struct pci_dev *pdev)
801 {
802 struct ata_host *host = dev_get_drvdata(&pdev->dev);
803 int rc;
804
805 rc = ata_pci_device_do_resume(pdev);
806 if (rc)
807 return rc;
808
809 sil_init_controller(host);
810 ata_host_resume(host);
811
812 return 0;
813 }
814 #endif
815
816 static int __init sil_init(void)
817 {
818 return pci_register_driver(&sil_pci_driver);
819 }
820
821 static void __exit sil_exit(void)
822 {
823 pci_unregister_driver(&sil_pci_driver);
824 }
825
826
827 module_init(sil_init);
828 module_exit(sil_exit);
Nao low-level kernelspace/userspace library that runs on our robots, Nao-Team HTWK