media: videobuf-dma-sg: Fix dma_{sync,unmap}_sg() calls
[linux/fpc-iii.git] / drivers / ata / sata_svw.c
bloba9d692c6c182d4d0d72e3f698f8eb7635a16fb4f
1 /*
2 * sata_svw.c - ServerWorks / Apple K2 SATA
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.
9 * Copyright 2003 Benjamin Herrenschmidt <benh@kernel.crashing.org>
11 * Bits from Jeff Garzik, Copyright RedHat, Inc.
13 * This driver probably works with non-Apple versions of the
14 * Broadcom chipset...
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.
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.
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.
32 * libata documentation is available via 'make {ps|pdf}docs',
33 * as Documentation/driver-api/libata.rst
35 * Hardware documentation available under NDA.
39 #include <linux/kernel.h>
40 #include <linux/module.h>
41 #include <linux/pci.h>
42 #include <linux/blkdev.h>
43 #include <linux/delay.h>
44 #include <linux/interrupt.h>
45 #include <linux/device.h>
46 #include <scsi/scsi_host.h>
47 #include <scsi/scsi_cmnd.h>
48 #include <scsi/scsi.h>
49 #include <linux/libata.h>
50 #include <linux/of.h>
52 #define DRV_NAME "sata_svw"
53 #define DRV_VERSION "2.3"
55 enum {
56 /* ap->flags bits */
57 K2_FLAG_SATA_8_PORTS = (1 << 24),
58 K2_FLAG_NO_ATAPI_DMA = (1 << 25),
59 K2_FLAG_BAR_POS_3 = (1 << 26),
61 /* Taskfile registers offsets */
62 K2_SATA_TF_CMD_OFFSET = 0x00,
63 K2_SATA_TF_DATA_OFFSET = 0x00,
64 K2_SATA_TF_ERROR_OFFSET = 0x04,
65 K2_SATA_TF_NSECT_OFFSET = 0x08,
66 K2_SATA_TF_LBAL_OFFSET = 0x0c,
67 K2_SATA_TF_LBAM_OFFSET = 0x10,
68 K2_SATA_TF_LBAH_OFFSET = 0x14,
69 K2_SATA_TF_DEVICE_OFFSET = 0x18,
70 K2_SATA_TF_CMDSTAT_OFFSET = 0x1c,
71 K2_SATA_TF_CTL_OFFSET = 0x20,
73 /* DMA base */
74 K2_SATA_DMA_CMD_OFFSET = 0x30,
76 /* SCRs base */
77 K2_SATA_SCR_STATUS_OFFSET = 0x40,
78 K2_SATA_SCR_ERROR_OFFSET = 0x44,
79 K2_SATA_SCR_CONTROL_OFFSET = 0x48,
81 /* Others */
82 K2_SATA_SICR1_OFFSET = 0x80,
83 K2_SATA_SICR2_OFFSET = 0x84,
84 K2_SATA_SIM_OFFSET = 0x88,
86 /* Port stride */
87 K2_SATA_PORT_OFFSET = 0x100,
89 chip_svw4 = 0,
90 chip_svw8 = 1,
91 chip_svw42 = 2, /* bar 3 */
92 chip_svw43 = 3, /* bar 5 */
95 static u8 k2_stat_check_status(struct ata_port *ap);
98 static int k2_sata_check_atapi_dma(struct ata_queued_cmd *qc)
100 u8 cmnd = qc->scsicmd->cmnd[0];
102 if (qc->ap->flags & K2_FLAG_NO_ATAPI_DMA)
103 return -1; /* ATAPI DMA not supported */
104 else {
105 switch (cmnd) {
106 case READ_10:
107 case READ_12:
108 case READ_16:
109 case WRITE_10:
110 case WRITE_12:
111 case WRITE_16:
112 return 0;
114 default:
115 return -1;
121 static int k2_sata_scr_read(struct ata_link *link,
122 unsigned int sc_reg, u32 *val)
124 if (sc_reg > SCR_CONTROL)
125 return -EINVAL;
126 *val = readl(link->ap->ioaddr.scr_addr + (sc_reg * 4));
127 return 0;
131 static int k2_sata_scr_write(struct ata_link *link,
132 unsigned int sc_reg, u32 val)
134 if (sc_reg > SCR_CONTROL)
135 return -EINVAL;
136 writel(val, link->ap->ioaddr.scr_addr + (sc_reg * 4));
137 return 0;
140 static int k2_sata_softreset(struct ata_link *link,
141 unsigned int *class, unsigned long deadline)
143 u8 dmactl;
144 void __iomem *mmio = link->ap->ioaddr.bmdma_addr;
146 dmactl = readb(mmio + ATA_DMA_CMD);
148 /* Clear the start bit */
149 if (dmactl & ATA_DMA_START) {
150 dmactl &= ~ATA_DMA_START;
151 writeb(dmactl, mmio + ATA_DMA_CMD);
154 return ata_sff_softreset(link, class, deadline);
157 static int k2_sata_hardreset(struct ata_link *link,
158 unsigned int *class, unsigned long deadline)
160 u8 dmactl;
161 void __iomem *mmio = link->ap->ioaddr.bmdma_addr;
163 dmactl = readb(mmio + ATA_DMA_CMD);
165 /* Clear the start bit */
166 if (dmactl & ATA_DMA_START) {
167 dmactl &= ~ATA_DMA_START;
168 writeb(dmactl, mmio + ATA_DMA_CMD);
171 return sata_sff_hardreset(link, class, deadline);
174 static void k2_sata_tf_load(struct ata_port *ap, const struct ata_taskfile *tf)
176 struct ata_ioports *ioaddr = &ap->ioaddr;
177 unsigned int is_addr = tf->flags & ATA_TFLAG_ISADDR;
179 if (tf->ctl != ap->last_ctl) {
180 writeb(tf->ctl, ioaddr->ctl_addr);
181 ap->last_ctl = tf->ctl;
182 ata_wait_idle(ap);
184 if (is_addr && (tf->flags & ATA_TFLAG_LBA48)) {
185 writew(tf->feature | (((u16)tf->hob_feature) << 8),
186 ioaddr->feature_addr);
187 writew(tf->nsect | (((u16)tf->hob_nsect) << 8),
188 ioaddr->nsect_addr);
189 writew(tf->lbal | (((u16)tf->hob_lbal) << 8),
190 ioaddr->lbal_addr);
191 writew(tf->lbam | (((u16)tf->hob_lbam) << 8),
192 ioaddr->lbam_addr);
193 writew(tf->lbah | (((u16)tf->hob_lbah) << 8),
194 ioaddr->lbah_addr);
195 } else if (is_addr) {
196 writew(tf->feature, ioaddr->feature_addr);
197 writew(tf->nsect, ioaddr->nsect_addr);
198 writew(tf->lbal, ioaddr->lbal_addr);
199 writew(tf->lbam, ioaddr->lbam_addr);
200 writew(tf->lbah, ioaddr->lbah_addr);
203 if (tf->flags & ATA_TFLAG_DEVICE)
204 writeb(tf->device, ioaddr->device_addr);
206 ata_wait_idle(ap);
210 static void k2_sata_tf_read(struct ata_port *ap, struct ata_taskfile *tf)
212 struct ata_ioports *ioaddr = &ap->ioaddr;
213 u16 nsect, lbal, lbam, lbah, feature;
215 tf->command = k2_stat_check_status(ap);
216 tf->device = readw(ioaddr->device_addr);
217 feature = readw(ioaddr->error_addr);
218 nsect = readw(ioaddr->nsect_addr);
219 lbal = readw(ioaddr->lbal_addr);
220 lbam = readw(ioaddr->lbam_addr);
221 lbah = readw(ioaddr->lbah_addr);
223 tf->feature = feature;
224 tf->nsect = nsect;
225 tf->lbal = lbal;
226 tf->lbam = lbam;
227 tf->lbah = lbah;
229 if (tf->flags & ATA_TFLAG_LBA48) {
230 tf->hob_feature = feature >> 8;
231 tf->hob_nsect = nsect >> 8;
232 tf->hob_lbal = lbal >> 8;
233 tf->hob_lbam = lbam >> 8;
234 tf->hob_lbah = lbah >> 8;
239 * k2_bmdma_setup_mmio - Set up PCI IDE BMDMA transaction (MMIO)
240 * @qc: Info associated with this ATA transaction.
242 * LOCKING:
243 * spin_lock_irqsave(host lock)
246 static void k2_bmdma_setup_mmio(struct ata_queued_cmd *qc)
248 struct ata_port *ap = qc->ap;
249 unsigned int rw = (qc->tf.flags & ATA_TFLAG_WRITE);
250 u8 dmactl;
251 void __iomem *mmio = ap->ioaddr.bmdma_addr;
253 /* load PRD table addr. */
254 mb(); /* make sure PRD table writes are visible to controller */
255 writel(ap->bmdma_prd_dma, mmio + ATA_DMA_TABLE_OFS);
257 /* specify data direction, triple-check start bit is clear */
258 dmactl = readb(mmio + ATA_DMA_CMD);
259 dmactl &= ~(ATA_DMA_WR | ATA_DMA_START);
260 if (!rw)
261 dmactl |= ATA_DMA_WR;
262 writeb(dmactl, mmio + ATA_DMA_CMD);
264 /* issue r/w command if this is not a ATA DMA command*/
265 if (qc->tf.protocol != ATA_PROT_DMA)
266 ap->ops->sff_exec_command(ap, &qc->tf);
270 * k2_bmdma_start_mmio - Start a PCI IDE BMDMA transaction (MMIO)
271 * @qc: Info associated with this ATA transaction.
273 * LOCKING:
274 * spin_lock_irqsave(host lock)
277 static void k2_bmdma_start_mmio(struct ata_queued_cmd *qc)
279 struct ata_port *ap = qc->ap;
280 void __iomem *mmio = ap->ioaddr.bmdma_addr;
281 u8 dmactl;
283 /* start host DMA transaction */
284 dmactl = readb(mmio + ATA_DMA_CMD);
285 writeb(dmactl | ATA_DMA_START, mmio + ATA_DMA_CMD);
286 /* This works around possible data corruption.
288 On certain SATA controllers that can be seen when the r/w
289 command is given to the controller before the host DMA is
290 started.
292 On a Read command, the controller would initiate the
293 command to the drive even before it sees the DMA
294 start. When there are very fast drives connected to the
295 controller, or when the data request hits in the drive
296 cache, there is the possibility that the drive returns a
297 part or all of the requested data to the controller before
298 the DMA start is issued. In this case, the controller
299 would become confused as to what to do with the data. In
300 the worst case when all the data is returned back to the
301 controller, the controller could hang. In other cases it
302 could return partial data returning in data
303 corruption. This problem has been seen in PPC systems and
304 can also appear on an system with very fast disks, where
305 the SATA controller is sitting behind a number of bridges,
306 and hence there is significant latency between the r/w
307 command and the start command. */
308 /* issue r/w command if the access is to ATA */
309 if (qc->tf.protocol == ATA_PROT_DMA)
310 ap->ops->sff_exec_command(ap, &qc->tf);
314 static u8 k2_stat_check_status(struct ata_port *ap)
316 return readl(ap->ioaddr.status_addr);
319 static int k2_sata_show_info(struct seq_file *m, struct Scsi_Host *shost)
321 struct ata_port *ap;
322 struct device_node *np;
323 int index;
325 /* Find the ata_port */
326 ap = ata_shost_to_port(shost);
327 if (ap == NULL)
328 return 0;
330 /* Find the OF node for the PCI device proper */
331 np = pci_device_to_OF_node(to_pci_dev(ap->host->dev));
332 if (np == NULL)
333 return 0;
335 /* Match it to a port node */
336 index = (ap == ap->host->ports[0]) ? 0 : 1;
337 for (np = np->child; np != NULL; np = np->sibling) {
338 const u32 *reg = of_get_property(np, "reg", NULL);
339 if (!reg)
340 continue;
341 if (index == *reg) {
342 seq_printf(m, "devspec: %pOF\n", np);
343 break;
346 return 0;
349 static struct scsi_host_template k2_sata_sht = {
350 ATA_BMDMA_SHT(DRV_NAME),
351 .show_info = k2_sata_show_info,
355 static struct ata_port_operations k2_sata_ops = {
356 .inherits = &ata_bmdma_port_ops,
357 .softreset = k2_sata_softreset,
358 .hardreset = k2_sata_hardreset,
359 .sff_tf_load = k2_sata_tf_load,
360 .sff_tf_read = k2_sata_tf_read,
361 .sff_check_status = k2_stat_check_status,
362 .check_atapi_dma = k2_sata_check_atapi_dma,
363 .bmdma_setup = k2_bmdma_setup_mmio,
364 .bmdma_start = k2_bmdma_start_mmio,
365 .scr_read = k2_sata_scr_read,
366 .scr_write = k2_sata_scr_write,
369 static const struct ata_port_info k2_port_info[] = {
370 /* chip_svw4 */
372 .flags = ATA_FLAG_SATA | K2_FLAG_NO_ATAPI_DMA,
373 .pio_mask = ATA_PIO4,
374 .mwdma_mask = ATA_MWDMA2,
375 .udma_mask = ATA_UDMA6,
376 .port_ops = &k2_sata_ops,
378 /* chip_svw8 */
380 .flags = ATA_FLAG_SATA | K2_FLAG_NO_ATAPI_DMA |
381 K2_FLAG_SATA_8_PORTS,
382 .pio_mask = ATA_PIO4,
383 .mwdma_mask = ATA_MWDMA2,
384 .udma_mask = ATA_UDMA6,
385 .port_ops = &k2_sata_ops,
387 /* chip_svw42 */
389 .flags = ATA_FLAG_SATA | K2_FLAG_BAR_POS_3,
390 .pio_mask = ATA_PIO4,
391 .mwdma_mask = ATA_MWDMA2,
392 .udma_mask = ATA_UDMA6,
393 .port_ops = &k2_sata_ops,
395 /* chip_svw43 */
397 .flags = ATA_FLAG_SATA,
398 .pio_mask = ATA_PIO4,
399 .mwdma_mask = ATA_MWDMA2,
400 .udma_mask = ATA_UDMA6,
401 .port_ops = &k2_sata_ops,
405 static void k2_sata_setup_port(struct ata_ioports *port, void __iomem *base)
407 port->cmd_addr = base + K2_SATA_TF_CMD_OFFSET;
408 port->data_addr = base + K2_SATA_TF_DATA_OFFSET;
409 port->feature_addr =
410 port->error_addr = base + K2_SATA_TF_ERROR_OFFSET;
411 port->nsect_addr = base + K2_SATA_TF_NSECT_OFFSET;
412 port->lbal_addr = base + K2_SATA_TF_LBAL_OFFSET;
413 port->lbam_addr = base + K2_SATA_TF_LBAM_OFFSET;
414 port->lbah_addr = base + K2_SATA_TF_LBAH_OFFSET;
415 port->device_addr = base + K2_SATA_TF_DEVICE_OFFSET;
416 port->command_addr =
417 port->status_addr = base + K2_SATA_TF_CMDSTAT_OFFSET;
418 port->altstatus_addr =
419 port->ctl_addr = base + K2_SATA_TF_CTL_OFFSET;
420 port->bmdma_addr = base + K2_SATA_DMA_CMD_OFFSET;
421 port->scr_addr = base + K2_SATA_SCR_STATUS_OFFSET;
425 static int k2_sata_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
427 const struct ata_port_info *ppi[] =
428 { &k2_port_info[ent->driver_data], NULL };
429 struct ata_host *host;
430 void __iomem *mmio_base;
431 int n_ports, i, rc, bar_pos;
433 ata_print_version_once(&pdev->dev, DRV_VERSION);
435 /* allocate host */
436 n_ports = 4;
437 if (ppi[0]->flags & K2_FLAG_SATA_8_PORTS)
438 n_ports = 8;
440 host = ata_host_alloc_pinfo(&pdev->dev, ppi, n_ports);
441 if (!host)
442 return -ENOMEM;
444 bar_pos = 5;
445 if (ppi[0]->flags & K2_FLAG_BAR_POS_3)
446 bar_pos = 3;
448 * If this driver happens to only be useful on Apple's K2, then
449 * we should check that here as it has a normal Serverworks ID
451 rc = pcim_enable_device(pdev);
452 if (rc)
453 return rc;
456 * Check if we have resources mapped at all (second function may
457 * have been disabled by firmware)
459 if (pci_resource_len(pdev, bar_pos) == 0) {
460 /* In IDE mode we need to pin the device to ensure that
461 pcim_release does not clear the busmaster bit in config
462 space, clearing causes busmaster DMA to fail on
463 ports 3 & 4 */
464 pcim_pin_device(pdev);
465 return -ENODEV;
468 /* Request and iomap PCI regions */
469 rc = pcim_iomap_regions(pdev, 1 << bar_pos, DRV_NAME);
470 if (rc == -EBUSY)
471 pcim_pin_device(pdev);
472 if (rc)
473 return rc;
474 host->iomap = pcim_iomap_table(pdev);
475 mmio_base = host->iomap[bar_pos];
477 /* different controllers have different number of ports - currently 4 or 8 */
478 /* All ports are on the same function. Multi-function device is no
479 * longer available. This should not be seen in any system. */
480 for (i = 0; i < host->n_ports; i++) {
481 struct ata_port *ap = host->ports[i];
482 unsigned int offset = i * K2_SATA_PORT_OFFSET;
484 k2_sata_setup_port(&ap->ioaddr, mmio_base + offset);
486 ata_port_pbar_desc(ap, 5, -1, "mmio");
487 ata_port_pbar_desc(ap, 5, offset, "port");
490 rc = dma_set_mask(&pdev->dev, ATA_DMA_MASK);
491 if (rc)
492 return rc;
493 rc = dma_set_coherent_mask(&pdev->dev, ATA_DMA_MASK);
494 if (rc)
495 return rc;
497 /* Clear a magic bit in SCR1 according to Darwin, those help
498 * some funky seagate drives (though so far, those were already
499 * set by the firmware on the machines I had access to)
501 writel(readl(mmio_base + K2_SATA_SICR1_OFFSET) & ~0x00040000,
502 mmio_base + K2_SATA_SICR1_OFFSET);
504 /* Clear SATA error & interrupts we don't use */
505 writel(0xffffffff, mmio_base + K2_SATA_SCR_ERROR_OFFSET);
506 writel(0x0, mmio_base + K2_SATA_SIM_OFFSET);
508 pci_set_master(pdev);
509 return ata_host_activate(host, pdev->irq, ata_bmdma_interrupt,
510 IRQF_SHARED, &k2_sata_sht);
513 /* 0x240 is device ID for Apple K2 device
514 * 0x241 is device ID for Serverworks Frodo4
515 * 0x242 is device ID for Serverworks Frodo8
516 * 0x24a is device ID for BCM5785 (aka HT1000) HT southbridge integrated SATA
517 * controller
518 * */
519 static const struct pci_device_id k2_sata_pci_tbl[] = {
520 { PCI_VDEVICE(SERVERWORKS, 0x0240), chip_svw4 },
521 { PCI_VDEVICE(SERVERWORKS, 0x0241), chip_svw8 },
522 { PCI_VDEVICE(SERVERWORKS, 0x0242), chip_svw4 },
523 { PCI_VDEVICE(SERVERWORKS, 0x024a), chip_svw4 },
524 { PCI_VDEVICE(SERVERWORKS, 0x024b), chip_svw4 },
525 { PCI_VDEVICE(SERVERWORKS, 0x0410), chip_svw42 },
526 { PCI_VDEVICE(SERVERWORKS, 0x0411), chip_svw43 },
531 static struct pci_driver k2_sata_pci_driver = {
532 .name = DRV_NAME,
533 .id_table = k2_sata_pci_tbl,
534 .probe = k2_sata_init_one,
535 .remove = ata_pci_remove_one,
538 module_pci_driver(k2_sata_pci_driver);
540 MODULE_AUTHOR("Benjamin Herrenschmidt");
541 MODULE_DESCRIPTION("low-level driver for K2 SATA controller");
542 MODULE_LICENSE("GPL");
543 MODULE_DEVICE_TABLE(pci, k2_sata_pci_tbl);
544 MODULE_VERSION(DRV_VERSION);