Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/sage/ceph...
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / ata / sata_svw.c
1 /*
2 * sata_svw.c - ServerWorks / Apple K2 SATA
3 *
4 * Maintained by: Benjamin Herrenschmidt <benh@kernel.crashing.org> and
5 * Jeff Garzik <jgarzik@pobox.com>
6 * Please ALWAYS copy linux-ide@vger.kernel.org
7 * on emails.
8 *
9 * Copyright 2003 Benjamin Herrenschmidt <benh@kernel.crashing.org>
10 *
11 * Bits from Jeff Garzik, Copyright RedHat, Inc.
12 *
13 * This driver probably works with non-Apple versions of the
14 * Broadcom chipset...
15 *
16 *
17 * This program is free software; you can redistribute it and/or modify
18 * it under the terms of the GNU General Public License as published by
19 * the Free Software Foundation; either version 2, or (at your option)
20 * any later version.
21 *
22 * This program is distributed in the hope that it will be useful,
23 * but WITHOUT ANY WARRANTY; without even the implied warranty of
24 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
25 * GNU General Public License for more details.
26 *
27 * You should have received a copy of the GNU General Public License
28 * along with this program; see the file COPYING. If not, write to
29 * the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
30 *
31 *
32 * libata documentation is available via 'make {ps|pdf}docs',
33 * as Documentation/DocBook/libata.*
34 *
35 * Hardware documentation available under NDA.
36 *
37 */
38
39 #include <linux/kernel.h>
40 #include <linux/module.h>
41 #include <linux/pci.h>
42 #include <linux/init.h>
43 #include <linux/blkdev.h>
44 #include <linux/delay.h>
45 #include <linux/interrupt.h>
46 #include <linux/device.h>
47 #include <scsi/scsi_host.h>
48 #include <scsi/scsi_cmnd.h>
49 #include <scsi/scsi.h>
50 #include <linux/libata.h>
51
52 #ifdef CONFIG_PPC_OF
53 #include <asm/prom.h>
54 #include <asm/pci-bridge.h>
55 #endif /* CONFIG_PPC_OF */
56
57 #define DRV_NAME "sata_svw"
58 #define DRV_VERSION "2.3"
59
60 enum {
61 /* ap->flags bits */
62 K2_FLAG_SATA_8_PORTS = (1 << 24),
63 K2_FLAG_NO_ATAPI_DMA = (1 << 25),
64 K2_FLAG_BAR_POS_3 = (1 << 26),
65
66 /* Taskfile registers offsets */
67 K2_SATA_TF_CMD_OFFSET = 0x00,
68 K2_SATA_TF_DATA_OFFSET = 0x00,
69 K2_SATA_TF_ERROR_OFFSET = 0x04,
70 K2_SATA_TF_NSECT_OFFSET = 0x08,
71 K2_SATA_TF_LBAL_OFFSET = 0x0c,
72 K2_SATA_TF_LBAM_OFFSET = 0x10,
73 K2_SATA_TF_LBAH_OFFSET = 0x14,
74 K2_SATA_TF_DEVICE_OFFSET = 0x18,
75 K2_SATA_TF_CMDSTAT_OFFSET = 0x1c,
76 K2_SATA_TF_CTL_OFFSET = 0x20,
77
78 /* DMA base */
79 K2_SATA_DMA_CMD_OFFSET = 0x30,
80
81 /* SCRs base */
82 K2_SATA_SCR_STATUS_OFFSET = 0x40,
83 K2_SATA_SCR_ERROR_OFFSET = 0x44,
84 K2_SATA_SCR_CONTROL_OFFSET = 0x48,
85
86 /* Others */
87 K2_SATA_SICR1_OFFSET = 0x80,
88 K2_SATA_SICR2_OFFSET = 0x84,
89 K2_SATA_SIM_OFFSET = 0x88,
90
91 /* Port stride */
92 K2_SATA_PORT_OFFSET = 0x100,
93
94 chip_svw4 = 0,
95 chip_svw8 = 1,
96 chip_svw42 = 2, /* bar 3 */
97 chip_svw43 = 3, /* bar 5 */
98 };
99
100 static u8 k2_stat_check_status(struct ata_port *ap);
101
102
103 static int k2_sata_check_atapi_dma(struct ata_queued_cmd *qc)
104 {
105 u8 cmnd = qc->scsicmd->cmnd[0];
106
107 if (qc->ap->flags & K2_FLAG_NO_ATAPI_DMA)
108 return -1; /* ATAPI DMA not supported */
109 else {
110 switch (cmnd) {
111 case READ_10:
112 case READ_12:
113 case READ_16:
114 case WRITE_10:
115 case WRITE_12:
116 case WRITE_16:
117 return 0;
118
119 default:
120 return -1;
121 }
122
123 }
124 }
125
126 static int k2_sata_scr_read(struct ata_link *link,
127 unsigned int sc_reg, u32 *val)
128 {
129 if (sc_reg > SCR_CONTROL)
130 return -EINVAL;
131 *val = readl(link->ap->ioaddr.scr_addr + (sc_reg * 4));
132 return 0;
133 }
134
135
136 static int k2_sata_scr_write(struct ata_link *link,
137 unsigned int sc_reg, u32 val)
138 {
139 if (sc_reg > SCR_CONTROL)
140 return -EINVAL;
141 writel(val, link->ap->ioaddr.scr_addr + (sc_reg * 4));
142 return 0;
143 }
144
145 static int k2_sata_softreset(struct ata_link *link,
146 unsigned int *class, unsigned long deadline)
147 {
148 u8 dmactl;
149 void __iomem *mmio = link->ap->ioaddr.bmdma_addr;
150
151 dmactl = readb(mmio + ATA_DMA_CMD);
152
153 /* Clear the start bit */
154 if (dmactl & ATA_DMA_START) {
155 dmactl &= ~ATA_DMA_START;
156 writeb(dmactl, mmio + ATA_DMA_CMD);
157 }
158
159 return ata_sff_softreset(link, class, deadline);
160 }
161
162 static int k2_sata_hardreset(struct ata_link *link,
163 unsigned int *class, unsigned long deadline)
164 {
165 u8 dmactl;
166 void __iomem *mmio = link->ap->ioaddr.bmdma_addr;
167
168 dmactl = readb(mmio + ATA_DMA_CMD);
169
170 /* Clear the start bit */
171 if (dmactl & ATA_DMA_START) {
172 dmactl &= ~ATA_DMA_START;
173 writeb(dmactl, mmio + ATA_DMA_CMD);
174 }
175
176 return sata_sff_hardreset(link, class, deadline);
177 }
178
179 static void k2_sata_tf_load(struct ata_port *ap, const struct ata_taskfile *tf)
180 {
181 struct ata_ioports *ioaddr = &ap->ioaddr;
182 unsigned int is_addr = tf->flags & ATA_TFLAG_ISADDR;
183
184 if (tf->ctl != ap->last_ctl) {
185 writeb(tf->ctl, ioaddr->ctl_addr);
186 ap->last_ctl = tf->ctl;
187 ata_wait_idle(ap);
188 }
189 if (is_addr && (tf->flags & ATA_TFLAG_LBA48)) {
190 writew(tf->feature | (((u16)tf->hob_feature) << 8),
191 ioaddr->feature_addr);
192 writew(tf->nsect | (((u16)tf->hob_nsect) << 8),
193 ioaddr->nsect_addr);
194 writew(tf->lbal | (((u16)tf->hob_lbal) << 8),
195 ioaddr->lbal_addr);
196 writew(tf->lbam | (((u16)tf->hob_lbam) << 8),
197 ioaddr->lbam_addr);
198 writew(tf->lbah | (((u16)tf->hob_lbah) << 8),
199 ioaddr->lbah_addr);
200 } else if (is_addr) {
201 writew(tf->feature, ioaddr->feature_addr);
202 writew(tf->nsect, ioaddr->nsect_addr);
203 writew(tf->lbal, ioaddr->lbal_addr);
204 writew(tf->lbam, ioaddr->lbam_addr);
205 writew(tf->lbah, ioaddr->lbah_addr);
206 }
207
208 if (tf->flags & ATA_TFLAG_DEVICE)
209 writeb(tf->device, ioaddr->device_addr);
210
211 ata_wait_idle(ap);
212 }
213
214
215 static void k2_sata_tf_read(struct ata_port *ap, struct ata_taskfile *tf)
216 {
217 struct ata_ioports *ioaddr = &ap->ioaddr;
218 u16 nsect, lbal, lbam, lbah, feature;
219
220 tf->command = k2_stat_check_status(ap);
221 tf->device = readw(ioaddr->device_addr);
222 feature = readw(ioaddr->error_addr);
223 nsect = readw(ioaddr->nsect_addr);
224 lbal = readw(ioaddr->lbal_addr);
225 lbam = readw(ioaddr->lbam_addr);
226 lbah = readw(ioaddr->lbah_addr);
227
228 tf->feature = feature;
229 tf->nsect = nsect;
230 tf->lbal = lbal;
231 tf->lbam = lbam;
232 tf->lbah = lbah;
233
234 if (tf->flags & ATA_TFLAG_LBA48) {
235 tf->hob_feature = feature >> 8;
236 tf->hob_nsect = nsect >> 8;
237 tf->hob_lbal = lbal >> 8;
238 tf->hob_lbam = lbam >> 8;
239 tf->hob_lbah = lbah >> 8;
240 }
241 }
242
243 /**
244 * k2_bmdma_setup_mmio - Set up PCI IDE BMDMA transaction (MMIO)
245 * @qc: Info associated with this ATA transaction.
246 *
247 * LOCKING:
248 * spin_lock_irqsave(host lock)
249 */
250
251 static void k2_bmdma_setup_mmio(struct ata_queued_cmd *qc)
252 {
253 struct ata_port *ap = qc->ap;
254 unsigned int rw = (qc->tf.flags & ATA_TFLAG_WRITE);
255 u8 dmactl;
256 void __iomem *mmio = ap->ioaddr.bmdma_addr;
257
258 /* load PRD table addr. */
259 mb(); /* make sure PRD table writes are visible to controller */
260 writel(ap->bmdma_prd_dma, mmio + ATA_DMA_TABLE_OFS);
261
262 /* specify data direction, triple-check start bit is clear */
263 dmactl = readb(mmio + ATA_DMA_CMD);
264 dmactl &= ~(ATA_DMA_WR | ATA_DMA_START);
265 if (!rw)
266 dmactl |= ATA_DMA_WR;
267 writeb(dmactl, mmio + ATA_DMA_CMD);
268
269 /* issue r/w command if this is not a ATA DMA command*/
270 if (qc->tf.protocol != ATA_PROT_DMA)
271 ap->ops->sff_exec_command(ap, &qc->tf);
272 }
273
274 /**
275 * k2_bmdma_start_mmio - Start a PCI IDE BMDMA transaction (MMIO)
276 * @qc: Info associated with this ATA transaction.
277 *
278 * LOCKING:
279 * spin_lock_irqsave(host lock)
280 */
281
282 static void k2_bmdma_start_mmio(struct ata_queued_cmd *qc)
283 {
284 struct ata_port *ap = qc->ap;
285 void __iomem *mmio = ap->ioaddr.bmdma_addr;
286 u8 dmactl;
287
288 /* start host DMA transaction */
289 dmactl = readb(mmio + ATA_DMA_CMD);
290 writeb(dmactl | ATA_DMA_START, mmio + ATA_DMA_CMD);
291 /* This works around possible data corruption.
292
293 On certain SATA controllers that can be seen when the r/w
294 command is given to the controller before the host DMA is
295 started.
296
297 On a Read command, the controller would initiate the
298 command to the drive even before it sees the DMA
299 start. When there are very fast drives connected to the
300 controller, or when the data request hits in the drive
301 cache, there is the possibility that the drive returns a
302 part or all of the requested data to the controller before
303 the DMA start is issued. In this case, the controller
304 would become confused as to what to do with the data. In
305 the worst case when all the data is returned back to the
306 controller, the controller could hang. In other cases it
307 could return partial data returning in data
308 corruption. This problem has been seen in PPC systems and
309 can also appear on an system with very fast disks, where
310 the SATA controller is sitting behind a number of bridges,
311 and hence there is significant latency between the r/w
312 command and the start command. */
313 /* issue r/w command if the access is to ATA */
314 if (qc->tf.protocol == ATA_PROT_DMA)
315 ap->ops->sff_exec_command(ap, &qc->tf);
316 }
317
318
319 static u8 k2_stat_check_status(struct ata_port *ap)
320 {
321 return readl(ap->ioaddr.status_addr);
322 }
323
324 #ifdef CONFIG_PPC_OF
325 static int k2_sata_show_info(struct seq_file *m, struct Scsi_Host *shost)
326 {
327 struct ata_port *ap;
328 struct device_node *np;
329 int index;
330
331 /* Find the ata_port */
332 ap = ata_shost_to_port(shost);
333 if (ap == NULL)
334 return 0;
335
336 /* Find the OF node for the PCI device proper */
337 np = pci_device_to_OF_node(to_pci_dev(ap->host->dev));
338 if (np == NULL)
339 return 0;
340
341 /* Match it to a port node */
342 index = (ap == ap->host->ports[0]) ? 0 : 1;
343 for (np = np->child; np != NULL; np = np->sibling) {
344 const u32 *reg = of_get_property(np, "reg", NULL);
345 if (!reg)
346 continue;
347 if (index == *reg) {
348 seq_printf(m, "devspec: %s\n", np->full_name);
349 break;
350 }
351 }
352 return 0;
353 }
354 #endif /* CONFIG_PPC_OF */
355
356
357 static struct scsi_host_template k2_sata_sht = {
358 ATA_BMDMA_SHT(DRV_NAME),
359 #ifdef CONFIG_PPC_OF
360 .show_info = k2_sata_show_info,
361 #endif
362 };
363
364
365 static struct ata_port_operations k2_sata_ops = {
366 .inherits = &ata_bmdma_port_ops,
367 .softreset = k2_sata_softreset,
368 .hardreset = k2_sata_hardreset,
369 .sff_tf_load = k2_sata_tf_load,
370 .sff_tf_read = k2_sata_tf_read,
371 .sff_check_status = k2_stat_check_status,
372 .check_atapi_dma = k2_sata_check_atapi_dma,
373 .bmdma_setup = k2_bmdma_setup_mmio,
374 .bmdma_start = k2_bmdma_start_mmio,
375 .scr_read = k2_sata_scr_read,
376 .scr_write = k2_sata_scr_write,
377 };
378
379 static const struct ata_port_info k2_port_info[] = {
380 /* chip_svw4 */
381 {
382 .flags = ATA_FLAG_SATA | K2_FLAG_NO_ATAPI_DMA,
383 .pio_mask = ATA_PIO4,
384 .mwdma_mask = ATA_MWDMA2,
385 .udma_mask = ATA_UDMA6,
386 .port_ops = &k2_sata_ops,
387 },
388 /* chip_svw8 */
389 {
390 .flags = ATA_FLAG_SATA | K2_FLAG_NO_ATAPI_DMA |
391 K2_FLAG_SATA_8_PORTS,
392 .pio_mask = ATA_PIO4,
393 .mwdma_mask = ATA_MWDMA2,
394 .udma_mask = ATA_UDMA6,
395 .port_ops = &k2_sata_ops,
396 },
397 /* chip_svw42 */
398 {
399 .flags = ATA_FLAG_SATA | K2_FLAG_BAR_POS_3,
400 .pio_mask = ATA_PIO4,
401 .mwdma_mask = ATA_MWDMA2,
402 .udma_mask = ATA_UDMA6,
403 .port_ops = &k2_sata_ops,
404 },
405 /* chip_svw43 */
406 {
407 .flags = ATA_FLAG_SATA,
408 .pio_mask = ATA_PIO4,
409 .mwdma_mask = ATA_MWDMA2,
410 .udma_mask = ATA_UDMA6,
411 .port_ops = &k2_sata_ops,
412 },
413 };
414
415 static void k2_sata_setup_port(struct ata_ioports *port, void __iomem *base)
416 {
417 port->cmd_addr = base + K2_SATA_TF_CMD_OFFSET;
418 port->data_addr = base + K2_SATA_TF_DATA_OFFSET;
419 port->feature_addr =
420 port->error_addr = base + K2_SATA_TF_ERROR_OFFSET;
421 port->nsect_addr = base + K2_SATA_TF_NSECT_OFFSET;
422 port->lbal_addr = base + K2_SATA_TF_LBAL_OFFSET;
423 port->lbam_addr = base + K2_SATA_TF_LBAM_OFFSET;
424 port->lbah_addr = base + K2_SATA_TF_LBAH_OFFSET;
425 port->device_addr = base + K2_SATA_TF_DEVICE_OFFSET;
426 port->command_addr =
427 port->status_addr = base + K2_SATA_TF_CMDSTAT_OFFSET;
428 port->altstatus_addr =
429 port->ctl_addr = base + K2_SATA_TF_CTL_OFFSET;
430 port->bmdma_addr = base + K2_SATA_DMA_CMD_OFFSET;
431 port->scr_addr = base + K2_SATA_SCR_STATUS_OFFSET;
432 }
433
434
435 static int k2_sata_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
436 {
437 const struct ata_port_info *ppi[] =
438 { &k2_port_info[ent->driver_data], NULL };
439 struct ata_host *host;
440 void __iomem *mmio_base;
441 int n_ports, i, rc, bar_pos;
442
443 ata_print_version_once(&pdev->dev, DRV_VERSION);
444
445 /* allocate host */
446 n_ports = 4;
447 if (ppi[0]->flags & K2_FLAG_SATA_8_PORTS)
448 n_ports = 8;
449
450 host = ata_host_alloc_pinfo(&pdev->dev, ppi, n_ports);
451 if (!host)
452 return -ENOMEM;
453
454 bar_pos = 5;
455 if (ppi[0]->flags & K2_FLAG_BAR_POS_3)
456 bar_pos = 3;
457 /*
458 * If this driver happens to only be useful on Apple's K2, then
459 * we should check that here as it has a normal Serverworks ID
460 */
461 rc = pcim_enable_device(pdev);
462 if (rc)
463 return rc;
464
465 /*
466 * Check if we have resources mapped at all (second function may
467 * have been disabled by firmware)
468 */
469 if (pci_resource_len(pdev, bar_pos) == 0) {
470 /* In IDE mode we need to pin the device to ensure that
471 pcim_release does not clear the busmaster bit in config
472 space, clearing causes busmaster DMA to fail on
473 ports 3 & 4 */
474 pcim_pin_device(pdev);
475 return -ENODEV;
476 }
477
478 /* Request and iomap PCI regions */
479 rc = pcim_iomap_regions(pdev, 1 << bar_pos, DRV_NAME);
480 if (rc == -EBUSY)
481 pcim_pin_device(pdev);
482 if (rc)
483 return rc;
484 host->iomap = pcim_iomap_table(pdev);
485 mmio_base = host->iomap[bar_pos];
486
487 /* different controllers have different number of ports - currently 4 or 8 */
488 /* All ports are on the same function. Multi-function device is no
489 * longer available. This should not be seen in any system. */
490 for (i = 0; i < host->n_ports; i++) {
491 struct ata_port *ap = host->ports[i];
492 unsigned int offset = i * K2_SATA_PORT_OFFSET;
493
494 k2_sata_setup_port(&ap->ioaddr, mmio_base + offset);
495
496 ata_port_pbar_desc(ap, 5, -1, "mmio");
497 ata_port_pbar_desc(ap, 5, offset, "port");
498 }
499
500 rc = pci_set_dma_mask(pdev, ATA_DMA_MASK);
501 if (rc)
502 return rc;
503 rc = pci_set_consistent_dma_mask(pdev, ATA_DMA_MASK);
504 if (rc)
505 return rc;
506
507 /* Clear a magic bit in SCR1 according to Darwin, those help
508 * some funky seagate drives (though so far, those were already
509 * set by the firmware on the machines I had access to)
510 */
511 writel(readl(mmio_base + K2_SATA_SICR1_OFFSET) & ~0x00040000,
512 mmio_base + K2_SATA_SICR1_OFFSET);
513
514 /* Clear SATA error & interrupts we don't use */
515 writel(0xffffffff, mmio_base + K2_SATA_SCR_ERROR_OFFSET);
516 writel(0x0, mmio_base + K2_SATA_SIM_OFFSET);
517
518 pci_set_master(pdev);
519 return ata_host_activate(host, pdev->irq, ata_bmdma_interrupt,
520 IRQF_SHARED, &k2_sata_sht);
521 }
522
523 /* 0x240 is device ID for Apple K2 device
524 * 0x241 is device ID for Serverworks Frodo4
525 * 0x242 is device ID for Serverworks Frodo8
526 * 0x24a is device ID for BCM5785 (aka HT1000) HT southbridge integrated SATA
527 * controller
528 * */
529 static const struct pci_device_id k2_sata_pci_tbl[] = {
530 { PCI_VDEVICE(SERVERWORKS, 0x0240), chip_svw4 },
531 { PCI_VDEVICE(SERVERWORKS, 0x0241), chip_svw8 },
532 { PCI_VDEVICE(SERVERWORKS, 0x0242), chip_svw4 },
533 { PCI_VDEVICE(SERVERWORKS, 0x024a), chip_svw4 },
534 { PCI_VDEVICE(SERVERWORKS, 0x024b), chip_svw4 },
535 { PCI_VDEVICE(SERVERWORKS, 0x0410), chip_svw42 },
536 { PCI_VDEVICE(SERVERWORKS, 0x0411), chip_svw43 },
537
538 { }
539 };
540
541 static struct pci_driver k2_sata_pci_driver = {
542 .name = DRV_NAME,
543 .id_table = k2_sata_pci_tbl,
544 .probe = k2_sata_init_one,
545 .remove = ata_pci_remove_one,
546 };
547
548 module_pci_driver(k2_sata_pci_driver);
549
550 MODULE_AUTHOR("Benjamin Herrenschmidt");
551 MODULE_DESCRIPTION("low-level driver for K2 SATA controller");
552 MODULE_LICENSE("GPL");
553 MODULE_DEVICE_TABLE(pci, k2_sata_pci_tbl);
554 MODULE_VERSION(DRV_VERSION);