1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/module.h>
23#include <linux/types.h>
24#include <linux/pci.h>
25#include <linux/delay.h>
26#include <linux/init.h>
27#include <linux/kernel.h>
28#include <linux/ioport.h>
29#include <linux/blkdev.h>
30#include <linux/scatterlist.h>
31#include <linux/ioc4.h>
32#include <linux/io.h>
33#include <linux/ide.h>
34
35#define DRV_NAME "SGIIOC4"
36
37
38#define IOC4_CMD_OFFSET 0x100
39#define IOC4_CTRL_OFFSET 0x120
40#define IOC4_DMA_OFFSET 0x140
41#define IOC4_INTR_OFFSET 0x0
42
43#define IOC4_TIMING 0x00
44#define IOC4_DMA_PTR_L 0x01
45#define IOC4_DMA_PTR_H 0x02
46#define IOC4_DMA_ADDR_L 0x03
47#define IOC4_DMA_ADDR_H 0x04
48#define IOC4_BC_DEV 0x05
49#define IOC4_BC_MEM 0x06
50#define IOC4_DMA_CTRL 0x07
51#define IOC4_DMA_END_ADDR 0x08
52
53
54#define IOC4_S_DMA_START 0x01
55#define IOC4_S_DMA_STOP 0x02
56#define IOC4_S_DMA_DIR 0x04
57#define IOC4_S_DMA_ACTIVE 0x08
58#define IOC4_S_DMA_ERROR 0x10
59#define IOC4_ATA_MEMERR 0x02
60
61
62#define IOC4_DMA_WRITE 0x04
63#define IOC4_DMA_READ 0x00
64
65
66#define IOC4_INTR_REG 0x03
67#define IOC4_INTR_SET 0x05
68#define IOC4_INTR_CLEAR 0x07
69
70#define IOC4_IDE_CACHELINE_SIZE 128
71#define IOC4_CMD_CTL_BLK_SIZE 0x20
72#define IOC4_SUPPORTED_FIRMWARE_REV 46
73
74struct ioc4_dma_regs {
75 u32 timing_reg0;
76 u32 timing_reg1;
77 u32 low_mem_ptr;
78 u32 high_mem_ptr;
79 u32 low_mem_addr;
80 u32 high_mem_addr;
81 u32 dev_byte_count;
82 u32 mem_byte_count;
83 u32 status;
84};
85
86
87
88#define IOC4_PRD_BYTES 16
89#define IOC4_PRD_ENTRIES (PAGE_SIZE / (4 * IOC4_PRD_BYTES))
90
91
92static void sgiioc4_init_hwif_ports(struct ide_hw *hw,
93 unsigned long data_port,
94 unsigned long ctrl_port,
95 unsigned long irq_port)
96{
97 unsigned long reg = data_port;
98 int i;
99
100
101 for (i = 0; i <= 7; i++)
102 hw->io_ports_array[i] = reg + i * 4;
103
104 hw->io_ports.ctl_addr = ctrl_port;
105 hw->io_ports.irq_addr = irq_port;
106}
107
108static int sgiioc4_checkirq(ide_hwif_t *hwif)
109{
110 unsigned long intr_addr = hwif->io_ports.irq_addr + IOC4_INTR_REG * 4;
111
112 if (readl((void __iomem *)intr_addr) & 0x03)
113 return 1;
114
115 return 0;
116}
117
118static u8 sgiioc4_read_status(ide_hwif_t *);
119
120static int sgiioc4_clearirq(ide_drive_t *drive)
121{
122 u32 intr_reg;
123 ide_hwif_t *hwif = drive->hwif;
124 struct ide_io_ports *io_ports = &hwif->io_ports;
125 unsigned long other_ir = io_ports->irq_addr + (IOC4_INTR_REG << 2);
126
127
128 intr_reg = readl((void __iomem *)other_ir);
129 if (intr_reg & 0x03) {
130
131
132
133
134
135
136
137 u8 stat = sgiioc4_read_status(hwif);
138 int count = 0;
139
140 stat = sgiioc4_read_status(hwif);
141 while ((stat & ATA_BUSY) && (count++ < 100)) {
142 udelay(1);
143 stat = sgiioc4_read_status(hwif);
144 }
145
146 if (intr_reg & 0x02) {
147 struct pci_dev *dev = to_pci_dev(hwif->dev);
148
149 u32 pci_err_addr_low, pci_err_addr_high,
150 pci_stat_cmd_reg;
151
152 pci_err_addr_low =
153 readl((void __iomem *)io_ports->irq_addr);
154 pci_err_addr_high =
155 readl((void __iomem *)(io_ports->irq_addr + 4));
156 pci_read_config_dword(dev, PCI_COMMAND,
157 &pci_stat_cmd_reg);
158 printk(KERN_ERR "%s(%s): PCI Bus Error when doing DMA: "
159 "status-cmd reg is 0x%x\n",
160 __func__, drive->name, pci_stat_cmd_reg);
161 printk(KERN_ERR "%s(%s): PCI Error Address is 0x%x%x\n",
162 __func__, drive->name,
163 pci_err_addr_high, pci_err_addr_low);
164
165 pci_write_config_dword(dev, PCI_COMMAND, 0x00000146);
166 }
167
168
169 writel(0x03, (void __iomem *)other_ir);
170
171 intr_reg = readl((void __iomem *)other_ir);
172 }
173
174 return intr_reg & 3;
175}
176
177static void sgiioc4_dma_start(ide_drive_t *drive)
178{
179 ide_hwif_t *hwif = drive->hwif;
180 unsigned long ioc4_dma_addr = hwif->dma_base + IOC4_DMA_CTRL * 4;
181 unsigned int reg = readl((void __iomem *)ioc4_dma_addr);
182 unsigned int temp_reg = reg | IOC4_S_DMA_START;
183
184 writel(temp_reg, (void __iomem *)ioc4_dma_addr);
185}
186
187static u32 sgiioc4_ide_dma_stop(ide_hwif_t *hwif, u64 dma_base)
188{
189 unsigned long ioc4_dma_addr = dma_base + IOC4_DMA_CTRL * 4;
190 u32 ioc4_dma;
191 int count;
192
193 count = 0;
194 ioc4_dma = readl((void __iomem *)ioc4_dma_addr);
195 while ((ioc4_dma & IOC4_S_DMA_STOP) && (count++ < 200)) {
196 udelay(1);
197 ioc4_dma = readl((void __iomem *)ioc4_dma_addr);
198 }
199 return ioc4_dma;
200}
201
202
203static int sgiioc4_dma_end(ide_drive_t *drive)
204{
205 u32 ioc4_dma, bc_dev, bc_mem, num, valid = 0, cnt = 0;
206 ide_hwif_t *hwif = drive->hwif;
207 unsigned long dma_base = hwif->dma_base;
208 int dma_stat = 0;
209 unsigned long *ending_dma = ide_get_hwifdata(hwif);
210
211 writel(IOC4_S_DMA_STOP, (void __iomem *)(dma_base + IOC4_DMA_CTRL * 4));
212
213 ioc4_dma = sgiioc4_ide_dma_stop(hwif, dma_base);
214
215 if (ioc4_dma & IOC4_S_DMA_STOP) {
216 printk(KERN_ERR
217 "%s(%s): IOC4 DMA STOP bit is still 1 :"
218 "ioc4_dma_reg 0x%x\n",
219 __func__, drive->name, ioc4_dma);
220 dma_stat = 1;
221 }
222
223
224
225
226
227
228 while ((cnt++ < 200) && (!valid)) {
229 for (num = 0; num < 16; num++) {
230 if (ending_dma[num]) {
231 valid = 1;
232 break;
233 }
234 }
235 udelay(1);
236 }
237 if (!valid) {
238 printk(KERN_ERR "%s(%s) : DMA incomplete\n", __func__,
239 drive->name);
240 dma_stat = 1;
241 }
242
243 bc_dev = readl((void __iomem *)(dma_base + IOC4_BC_DEV * 4));
244 bc_mem = readl((void __iomem *)(dma_base + IOC4_BC_MEM * 4));
245
246 if ((bc_dev & 0x01FF) || (bc_mem & 0x1FF)) {
247 if (bc_dev > bc_mem + 8) {
248 printk(KERN_ERR
249 "%s(%s): WARNING!! byte_count_dev %d "
250 "!= byte_count_mem %d\n",
251 __func__, drive->name, bc_dev, bc_mem);
252 }
253 }
254
255 return dma_stat;
256}
257
258static void sgiioc4_set_dma_mode(ide_hwif_t *hwif, ide_drive_t *drive)
259{
260}
261
262
263static int sgiioc4_dma_test_irq(ide_drive_t *drive)
264{
265 return sgiioc4_checkirq(drive->hwif);
266}
267
268static void sgiioc4_dma_host_set(ide_drive_t *drive, int on)
269{
270 if (!on)
271 sgiioc4_clearirq(drive);
272}
273
274static void sgiioc4_resetproc(ide_drive_t *drive)
275{
276 struct ide_cmd *cmd = &drive->hwif->cmd;
277
278 sgiioc4_dma_end(drive);
279 ide_dma_unmap_sg(drive, cmd);
280 sgiioc4_clearirq(drive);
281}
282
283static void sgiioc4_dma_lost_irq(ide_drive_t *drive)
284{
285 sgiioc4_resetproc(drive);
286
287 ide_dma_lost_irq(drive);
288}
289
290static u8 sgiioc4_read_status(ide_hwif_t *hwif)
291{
292 unsigned long port = hwif->io_ports.status_addr;
293 u8 reg = (u8) readb((void __iomem *) port);
294
295 if (!(reg & ATA_BUSY)) {
296 unsigned long other_ir = port - 0x110;
297 unsigned int intr_reg = (u32) readl((void __iomem *) other_ir);
298
299
300 if (intr_reg & 0x03) {
301 writel(0x03, (void __iomem *) other_ir);
302 intr_reg = (u32) readl((void __iomem *) other_ir);
303 }
304 }
305
306 return reg;
307}
308
309
310static int ide_dma_sgiioc4(ide_hwif_t *hwif, const struct ide_port_info *d)
311{
312 struct pci_dev *dev = to_pci_dev(hwif->dev);
313 unsigned long dma_base = pci_resource_start(dev, 0) + IOC4_DMA_OFFSET;
314 int num_ports = sizeof(struct ioc4_dma_regs);
315 void *pad;
316
317 printk(KERN_INFO " %s: MMIO-DMA\n", hwif->name);
318
319 if (request_mem_region(dma_base, num_ports, hwif->name) == NULL) {
320 printk(KERN_ERR "%s(%s) -- ERROR: addresses 0x%08lx to 0x%08lx "
321 "already in use\n", __func__, hwif->name,
322 dma_base, dma_base + num_ports - 1);
323 return -1;
324 }
325
326 hwif->dma_base = (unsigned long)hwif->io_ports.irq_addr +
327 IOC4_DMA_OFFSET;
328
329 hwif->sg_max_nents = IOC4_PRD_ENTRIES;
330
331 hwif->prd_max_nents = IOC4_PRD_ENTRIES;
332 hwif->prd_ent_size = IOC4_PRD_BYTES;
333
334 if (ide_allocate_dma_engine(hwif))
335 goto dma_pci_alloc_failure;
336
337 pad = dma_alloc_coherent(&dev->dev, IOC4_IDE_CACHELINE_SIZE,
338 (dma_addr_t *)&hwif->extra_base, GFP_KERNEL);
339 if (pad) {
340 ide_set_hwifdata(hwif, pad);
341 return 0;
342 }
343
344 ide_release_dma_engine(hwif);
345
346 printk(KERN_ERR "%s(%s) -- ERROR: Unable to allocate DMA maps\n",
347 __func__, hwif->name);
348 printk(KERN_INFO "%s: changing from DMA to PIO mode", hwif->name);
349
350dma_pci_alloc_failure:
351 release_mem_region(dma_base, num_ports);
352
353 return -1;
354}
355
356
357static void sgiioc4_configure_for_dma(int dma_direction, ide_drive_t *drive)
358{
359 u32 ioc4_dma;
360 ide_hwif_t *hwif = drive->hwif;
361 unsigned long dma_base = hwif->dma_base;
362 unsigned long ioc4_dma_addr = dma_base + IOC4_DMA_CTRL * 4;
363 u32 dma_addr, ending_dma_addr;
364
365 ioc4_dma = readl((void __iomem *)ioc4_dma_addr);
366
367 if (ioc4_dma & IOC4_S_DMA_ACTIVE) {
368 printk(KERN_WARNING "%s(%s): Warning!! DMA from previous "
369 "transfer was still active\n", __func__, drive->name);
370 writel(IOC4_S_DMA_STOP, (void __iomem *)ioc4_dma_addr);
371 ioc4_dma = sgiioc4_ide_dma_stop(hwif, dma_base);
372
373 if (ioc4_dma & IOC4_S_DMA_STOP)
374 printk(KERN_ERR "%s(%s): IOC4 DMA STOP bit is "
375 "still 1\n", __func__, drive->name);
376 }
377
378 ioc4_dma = readl((void __iomem *)ioc4_dma_addr);
379 if (ioc4_dma & IOC4_S_DMA_ERROR) {
380 printk(KERN_WARNING "%s(%s): Warning!! DMA Error during "
381 "previous transfer, status 0x%x\n",
382 __func__, drive->name, ioc4_dma);
383 writel(IOC4_S_DMA_STOP, (void __iomem *)ioc4_dma_addr);
384 ioc4_dma = sgiioc4_ide_dma_stop(hwif, dma_base);
385
386 if (ioc4_dma & IOC4_S_DMA_STOP)
387 printk(KERN_ERR "%s(%s): IOC4 DMA STOP bit is "
388 "still 1\n", __func__, drive->name);
389 }
390
391
392 dma_addr = cpu_to_le32(hwif->dmatable_dma);
393 writel(dma_addr, (void __iomem *)(dma_base + IOC4_DMA_PTR_L * 4));
394
395
396 memset(ide_get_hwifdata(hwif), 0, IOC4_IDE_CACHELINE_SIZE);
397 ending_dma_addr = cpu_to_le32(hwif->extra_base);
398 writel(ending_dma_addr, (void __iomem *)(dma_base +
399 IOC4_DMA_END_ADDR * 4));
400
401 writel(dma_direction, (void __iomem *)ioc4_dma_addr);
402}
403
404
405
406
407
408
409
410
411
412
413
414static int sgiioc4_build_dmatable(ide_drive_t *drive, struct ide_cmd *cmd)
415{
416 ide_hwif_t *hwif = drive->hwif;
417 unsigned int *table = hwif->dmatable_cpu;
418 unsigned int count = 0, i = cmd->sg_nents;
419 struct scatterlist *sg = hwif->sg_table;
420
421 while (i && sg_dma_len(sg)) {
422 dma_addr_t cur_addr;
423 int cur_len;
424 cur_addr = sg_dma_address(sg);
425 cur_len = sg_dma_len(sg);
426
427 while (cur_len) {
428 if (count++ >= IOC4_PRD_ENTRIES) {
429 printk(KERN_WARNING
430 "%s: DMA table too small\n",
431 drive->name);
432 return 0;
433 } else {
434 u32 bcount =
435 0x10000 - (cur_addr & 0xffff);
436
437 if (bcount > cur_len)
438 bcount = cur_len;
439
440
441
442
443
444 *table = 0x0;
445 table++;
446 *table = cpu_to_be32(cur_addr);
447 table++;
448 *table = 0x0;
449 table++;
450
451 *table = cpu_to_be32(bcount);
452 table++;
453
454 cur_addr += bcount;
455 cur_len -= bcount;
456 }
457 }
458
459 sg = sg_next(sg);
460 i--;
461 }
462
463 if (count) {
464 table--;
465 *table |= cpu_to_be32(0x80000000);
466 return count;
467 }
468
469 return 0;
470}
471
472static int sgiioc4_dma_setup(ide_drive_t *drive, struct ide_cmd *cmd)
473{
474 int ddir;
475 u8 write = !!(cmd->tf_flags & IDE_TFLAG_WRITE);
476
477 if (sgiioc4_build_dmatable(drive, cmd) == 0)
478
479 return 1;
480
481 if (write)
482
483 ddir = IOC4_DMA_READ;
484 else
485
486 ddir = IOC4_DMA_WRITE;
487
488 sgiioc4_configure_for_dma(ddir, drive);
489
490 return 0;
491}
492
493static const struct ide_tp_ops sgiioc4_tp_ops = {
494 .exec_command = ide_exec_command,
495 .read_status = sgiioc4_read_status,
496 .read_altstatus = ide_read_altstatus,
497 .write_devctl = ide_write_devctl,
498
499 .dev_select = ide_dev_select,
500 .tf_load = ide_tf_load,
501 .tf_read = ide_tf_read,
502
503 .input_data = ide_input_data,
504 .output_data = ide_output_data,
505};
506
507static const struct ide_port_ops sgiioc4_port_ops = {
508 .set_dma_mode = sgiioc4_set_dma_mode,
509
510 .resetproc = sgiioc4_resetproc,
511};
512
513static const struct ide_dma_ops sgiioc4_dma_ops = {
514 .dma_host_set = sgiioc4_dma_host_set,
515 .dma_setup = sgiioc4_dma_setup,
516 .dma_start = sgiioc4_dma_start,
517 .dma_end = sgiioc4_dma_end,
518 .dma_test_irq = sgiioc4_dma_test_irq,
519 .dma_lost_irq = sgiioc4_dma_lost_irq,
520};
521
522static const struct ide_port_info sgiioc4_port_info = {
523 .name = DRV_NAME,
524 .chipset = ide_pci,
525 .init_dma = ide_dma_sgiioc4,
526 .tp_ops = &sgiioc4_tp_ops,
527 .port_ops = &sgiioc4_port_ops,
528 .dma_ops = &sgiioc4_dma_ops,
529 .host_flags = IDE_HFLAG_MMIO,
530 .irq_flags = IRQF_SHARED,
531 .mwdma_mask = ATA_MWDMA2_ONLY,
532};
533
534static int sgiioc4_ide_setup_pci_device(struct pci_dev *dev)
535{
536 unsigned long cmd_base, irqport;
537 unsigned long bar0, cmd_phys_base, ctl;
538 void __iomem *virt_base;
539 struct ide_hw hw, *hws[] = { &hw };
540 int rc;
541
542
543 bar0 = pci_resource_start(dev, 0);
544 virt_base = pci_ioremap_bar(dev, 0);
545 if (virt_base == NULL) {
546 printk(KERN_ERR "%s: Unable to remap BAR 0 address: 0x%lx\n",
547 DRV_NAME, bar0);
548 return -ENOMEM;
549 }
550 cmd_base = (unsigned long)virt_base + IOC4_CMD_OFFSET;
551 ctl = (unsigned long)virt_base + IOC4_CTRL_OFFSET;
552 irqport = (unsigned long)virt_base + IOC4_INTR_OFFSET;
553
554 cmd_phys_base = bar0 + IOC4_CMD_OFFSET;
555 if (request_mem_region(cmd_phys_base, IOC4_CMD_CTL_BLK_SIZE,
556 DRV_NAME) == NULL) {
557 printk(KERN_ERR "%s %s -- ERROR: addresses 0x%08lx to 0x%08lx "
558 "already in use\n", DRV_NAME, pci_name(dev),
559 cmd_phys_base, cmd_phys_base + IOC4_CMD_CTL_BLK_SIZE);
560 rc = -EBUSY;
561 goto req_mem_rgn_err;
562 }
563
564
565 memset(&hw, 0, sizeof(hw));
566 sgiioc4_init_hwif_ports(&hw, cmd_base, ctl, irqport);
567 hw.irq = dev->irq;
568 hw.dev = &dev->dev;
569
570
571 writel(0x03, (void __iomem *)(irqport + IOC4_INTR_SET * 4));
572
573 rc = ide_host_add(&sgiioc4_port_info, hws, 1, NULL);
574 if (!rc)
575 return 0;
576
577 release_mem_region(cmd_phys_base, IOC4_CMD_CTL_BLK_SIZE);
578req_mem_rgn_err:
579 iounmap(virt_base);
580 return rc;
581}
582
583static unsigned int pci_init_sgiioc4(struct pci_dev *dev)
584{
585 int ret;
586
587 printk(KERN_INFO "%s: IDE controller at PCI slot %s, revision %d\n",
588 DRV_NAME, pci_name(dev), dev->revision);
589
590 if (dev->revision < IOC4_SUPPORTED_FIRMWARE_REV) {
591 printk(KERN_ERR "Skipping %s IDE controller in slot %s: "
592 "firmware is obsolete - please upgrade to "
593 "revision46 or higher\n",
594 DRV_NAME, pci_name(dev));
595 ret = -EAGAIN;
596 goto out;
597 }
598 ret = sgiioc4_ide_setup_pci_device(dev);
599out:
600 return ret;
601}
602
603static int ioc4_ide_attach_one(struct ioc4_driver_data *idd)
604{
605
606
607
608
609 if (idd->idd_variant == IOC4_VARIANT_PCI_RT)
610 return 0;
611
612 return pci_init_sgiioc4(idd->idd_pdev);
613}
614
615static struct ioc4_submodule ioc4_ide_submodule = {
616 .is_name = "IOC4_ide",
617 .is_owner = THIS_MODULE,
618 .is_probe = ioc4_ide_attach_one,
619};
620
621static int __init ioc4_ide_init(void)
622{
623 return ioc4_register_submodule(&ioc4_ide_submodule);
624}
625
626late_initcall(ioc4_ide_init);
627
628MODULE_AUTHOR("Aniket Malatpure/Jeremy Higdon");
629MODULE_DESCRIPTION("IDE PCI driver module for SGI IOC4 Base-IO Card");
630MODULE_LICENSE("GPL");
631