2 * cmd64x.c: Enable interrupts at initialization time on Ultra/PCI machines.
3 * Due to massive hardware bugs, UltraDMA is only supported
4 * on the 646U2 and not on the 646U.
6 * Copyright (C) 1998 Eddie C. Dost (ecd@skynet.be)
7 * Copyright (C) 1998 David S. Miller (davem@redhat.com)
9 * Copyright (C) 1999-2002 Andre Hedrick <andre@linux-ide.org>
10 * Copyright (C) 2007 MontaVista Software, Inc. <source@mvista.com>
13 #include <linux/module.h>
14 #include <linux/types.h>
15 #include <linux/pci.h>
16 #include <linux/delay.h>
17 #include <linux/hdreg.h>
18 #include <linux/ide.h>
19 #include <linux/init.h>
26 #define cmdprintk(x...) printk(x)
28 #define cmdprintk(x...)
32 * CMD64x specific registers definition.
35 #define CFR_INTR_CH0 0x04
43 #define ARTTIM23_DIS_RA2 0x04
44 #define ARTTIM23_DIS_RA3 0x08
45 #define ARTTIM23_INTR_CH1 0x10
52 #define MRDMODE_INTR_CH0 0x04
53 #define MRDMODE_INTR_CH1 0x08
54 #define UDIDETCR0 0x73
58 #define UDIDETCR1 0x7B
61 static u8
quantize_timing(int timing
, int quant
)
63 return (timing
+ quant
- 1) / quant
;
67 * This routine calculates active/recovery counts and then writes them into
68 * the chipset registers.
70 static void program_cycle_times (ide_drive_t
*drive
, int cycle_time
, int active_time
)
72 struct pci_dev
*dev
= to_pci_dev(drive
->hwif
->dev
);
73 int clock_time
= 1000 / system_bus_clock();
74 u8 cycle_count
, active_count
, recovery_count
, drwtim
;
75 static const u8 recovery_values
[] =
76 {15, 15, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 0};
77 static const u8 drwtim_regs
[4] = {DRWTIM0
, DRWTIM1
, DRWTIM2
, DRWTIM3
};
79 cmdprintk("program_cycle_times parameters: total=%d, active=%d\n",
80 cycle_time
, active_time
);
82 cycle_count
= quantize_timing( cycle_time
, clock_time
);
83 active_count
= quantize_timing(active_time
, clock_time
);
84 recovery_count
= cycle_count
- active_count
;
87 * In case we've got too long recovery phase, try to lengthen
90 if (recovery_count
> 16) {
91 active_count
+= recovery_count
- 16;
94 if (active_count
> 16) /* shouldn't actually happen... */
97 cmdprintk("Final counts: total=%d, active=%d, recovery=%d\n",
98 cycle_count
, active_count
, recovery_count
);
101 * Convert values to internal chipset representation
103 recovery_count
= recovery_values
[recovery_count
];
104 active_count
&= 0x0f;
106 /* Program the active/recovery counts into the DRWTIM register */
107 drwtim
= (active_count
<< 4) | recovery_count
;
108 (void) pci_write_config_byte(dev
, drwtim_regs
[drive
->dn
], drwtim
);
109 cmdprintk("Write 0x%02x to reg 0x%x\n", drwtim
, drwtim_regs
[drive
->dn
]);
113 * This routine writes into the chipset registers
114 * PIO setup/active/recovery timings.
116 static void cmd64x_tune_pio(ide_drive_t
*drive
, const u8 pio
)
118 ide_hwif_t
*hwif
= HWIF(drive
);
119 struct pci_dev
*dev
= to_pci_dev(hwif
->dev
);
120 unsigned int cycle_time
;
121 u8 setup_count
, arttim
= 0;
123 static const u8 setup_values
[] = {0x40, 0x40, 0x40, 0x80, 0, 0xc0};
124 static const u8 arttim_regs
[4] = {ARTTIM0
, ARTTIM1
, ARTTIM23
, ARTTIM23
};
126 cycle_time
= ide_pio_cycle_time(drive
, pio
);
128 program_cycle_times(drive
, cycle_time
,
129 ide_pio_timings
[pio
].active_time
);
131 setup_count
= quantize_timing(ide_pio_timings
[pio
].setup_time
,
132 1000 / system_bus_clock());
135 * The primary channel has individual address setup timing registers
136 * for each drive and the hardware selects the slowest timing itself.
137 * The secondary channel has one common register and we have to select
138 * the slowest address setup timing ourselves.
141 ide_drive_t
*drives
= hwif
->drives
;
143 drive
->drive_data
= setup_count
;
144 setup_count
= max(drives
[0].drive_data
, drives
[1].drive_data
);
147 if (setup_count
> 5) /* shouldn't actually happen... */
149 cmdprintk("Final address setup count: %d\n", setup_count
);
152 * Program the address setup clocks into the ARTTIM registers.
153 * Avoid clearing the secondary channel's interrupt bit.
155 (void) pci_read_config_byte (dev
, arttim_regs
[drive
->dn
], &arttim
);
157 arttim
&= ~ARTTIM23_INTR_CH1
;
159 arttim
|= setup_values
[setup_count
];
160 (void) pci_write_config_byte(dev
, arttim_regs
[drive
->dn
], arttim
);
161 cmdprintk("Write 0x%02x to reg 0x%x\n", arttim
, arttim_regs
[drive
->dn
]);
165 * Attempts to set drive's PIO mode.
166 * Special cases are 8: prefetch off, 9: prefetch on (both never worked)
169 static void cmd64x_set_pio_mode(ide_drive_t
*drive
, const u8 pio
)
172 * Filter out the prefetch control values
173 * to prevent PIO5 from being programmed
175 if (pio
== 8 || pio
== 9)
178 cmd64x_tune_pio(drive
, pio
);
181 static void cmd64x_set_dma_mode(ide_drive_t
*drive
, const u8 speed
)
183 ide_hwif_t
*hwif
= HWIF(drive
);
184 struct pci_dev
*dev
= to_pci_dev(hwif
->dev
);
185 u8 unit
= drive
->dn
& 0x01;
186 u8 regU
= 0, pciU
= hwif
->channel
? UDIDETCR1
: UDIDETCR0
;
188 if (speed
>= XFER_SW_DMA_0
) {
189 (void) pci_read_config_byte(dev
, pciU
, ®U
);
190 regU
&= ~(unit
? 0xCA : 0x35);
195 regU
|= unit
? 0x0A : 0x05;
198 regU
|= unit
? 0x4A : 0x15;
201 regU
|= unit
? 0x8A : 0x25;
204 regU
|= unit
? 0x42 : 0x11;
207 regU
|= unit
? 0x82 : 0x21;
210 regU
|= unit
? 0xC2 : 0x31;
213 program_cycle_times(drive
, 120, 70);
216 program_cycle_times(drive
, 150, 80);
219 program_cycle_times(drive
, 480, 215);
223 if (speed
>= XFER_SW_DMA_0
)
224 (void) pci_write_config_byte(dev
, pciU
, regU
);
227 static int cmd648_ide_dma_end (ide_drive_t
*drive
)
229 ide_hwif_t
*hwif
= HWIF(drive
);
230 unsigned long base
= hwif
->dma_base
- (hwif
->channel
* 8);
231 int err
= __ide_dma_end(drive
);
232 u8 irq_mask
= hwif
->channel
? MRDMODE_INTR_CH1
:
234 u8 mrdmode
= inb(base
+ 1);
236 /* clear the interrupt bit */
237 outb((mrdmode
& ~(MRDMODE_INTR_CH0
| MRDMODE_INTR_CH1
)) | irq_mask
,
243 static int cmd64x_ide_dma_end (ide_drive_t
*drive
)
245 ide_hwif_t
*hwif
= HWIF(drive
);
246 struct pci_dev
*dev
= to_pci_dev(hwif
->dev
);
247 int irq_reg
= hwif
->channel
? ARTTIM23
: CFR
;
248 u8 irq_mask
= hwif
->channel
? ARTTIM23_INTR_CH1
:
251 int err
= __ide_dma_end(drive
);
253 (void) pci_read_config_byte(dev
, irq_reg
, &irq_stat
);
254 /* clear the interrupt bit */
255 (void) pci_write_config_byte(dev
, irq_reg
, irq_stat
| irq_mask
);
260 static int cmd648_ide_dma_test_irq (ide_drive_t
*drive
)
262 ide_hwif_t
*hwif
= HWIF(drive
);
263 unsigned long base
= hwif
->dma_base
- (hwif
->channel
* 8);
264 u8 irq_mask
= hwif
->channel
? MRDMODE_INTR_CH1
:
266 u8 dma_stat
= inb(hwif
->dma_status
);
267 u8 mrdmode
= inb(base
+ 1);
270 printk("%s: dma_stat: 0x%02x mrdmode: 0x%02x irq_mask: 0x%02x\n",
271 drive
->name
, dma_stat
, mrdmode
, irq_mask
);
273 if (!(mrdmode
& irq_mask
))
276 /* return 1 if INTR asserted */
283 static int cmd64x_ide_dma_test_irq (ide_drive_t
*drive
)
285 ide_hwif_t
*hwif
= HWIF(drive
);
286 struct pci_dev
*dev
= to_pci_dev(hwif
->dev
);
287 int irq_reg
= hwif
->channel
? ARTTIM23
: CFR
;
288 u8 irq_mask
= hwif
->channel
? ARTTIM23_INTR_CH1
:
290 u8 dma_stat
= inb(hwif
->dma_status
);
293 (void) pci_read_config_byte(dev
, irq_reg
, &irq_stat
);
296 printk("%s: dma_stat: 0x%02x irq_stat: 0x%02x irq_mask: 0x%02x\n",
297 drive
->name
, dma_stat
, irq_stat
, irq_mask
);
299 if (!(irq_stat
& irq_mask
))
302 /* return 1 if INTR asserted */
310 * ASUS P55T2P4D with CMD646 chipset revision 0x01 requires the old
311 * event order for DMA transfers.
314 static int cmd646_1_ide_dma_end (ide_drive_t
*drive
)
316 ide_hwif_t
*hwif
= HWIF(drive
);
317 u8 dma_stat
= 0, dma_cmd
= 0;
319 drive
->waiting_for_dma
= 0;
321 dma_stat
= inb(hwif
->dma_status
);
322 /* read DMA command state */
323 dma_cmd
= inb(hwif
->dma_command
);
325 outb(dma_cmd
& ~1, hwif
->dma_command
);
326 /* clear the INTR & ERROR bits */
327 outb(dma_stat
| 6, hwif
->dma_status
);
328 /* and free any DMA resources */
329 ide_destroy_dmatable(drive
);
330 /* verify good DMA status */
331 return (dma_stat
& 7) != 4;
334 static unsigned int __devinit
init_chipset_cmd64x(struct pci_dev
*dev
, const char *name
)
338 if (dev
->device
== PCI_DEVICE_ID_CMD_646
) {
340 switch (dev
->revision
) {
343 printk("%s: UltraDMA capable\n", name
);
347 printk("%s: MultiWord DMA force limited\n", name
);
350 printk("%s: MultiWord DMA limited, "
351 "IRQ workaround enabled\n", name
);
356 /* Set a good latency timer and cache line size value. */
357 (void) pci_write_config_byte(dev
, PCI_LATENCY_TIMER
, 64);
358 /* FIXME: pci_set_master() to ensure a good latency timer value */
361 * Enable interrupts, select MEMORY READ LINE for reads.
363 * NOTE: although not mentioned in the PCI0646U specs,
364 * bits 0-1 are write only and won't be read back as
365 * set or not -- PCI0646U2 specs clarify this point.
367 (void) pci_read_config_byte (dev
, MRDMODE
, &mrdmode
);
369 (void) pci_write_config_byte(dev
, MRDMODE
, (mrdmode
| 0x02));
374 static u8 __devinit
ata66_cmd64x(ide_hwif_t
*hwif
)
376 struct pci_dev
*dev
= to_pci_dev(hwif
->dev
);
377 u8 bmidecsr
= 0, mask
= hwif
->channel
? 0x02 : 0x01;
379 switch (dev
->device
) {
380 case PCI_DEVICE_ID_CMD_648
:
381 case PCI_DEVICE_ID_CMD_649
:
382 pci_read_config_byte(dev
, BMIDECSR
, &bmidecsr
);
383 return (bmidecsr
& mask
) ? ATA_CBL_PATA80
: ATA_CBL_PATA40
;
385 return ATA_CBL_PATA40
;
389 static void __devinit
init_hwif_cmd64x(ide_hwif_t
*hwif
)
391 struct pci_dev
*dev
= to_pci_dev(hwif
->dev
);
393 hwif
->set_pio_mode
= &cmd64x_set_pio_mode
;
394 hwif
->set_dma_mode
= &cmd64x_set_dma_mode
;
400 * UltraDMA only supported on PCI646U and PCI646U2, which
401 * correspond to revisions 0x03, 0x05 and 0x07 respectively.
402 * Actually, although the CMD tech support people won't
403 * tell me the details, the 0x03 revision cannot support
404 * UDMA correctly without hardware modifications, and even
405 * then it only works with Quantum disks due to some
406 * hold time assumptions in the 646U part which are fixed
409 * So we only do UltraDMA on revision 0x05 and 0x07 chipsets.
411 if (dev
->device
== PCI_DEVICE_ID_CMD_646
&& dev
->revision
< 5)
412 hwif
->ultra_mask
= 0x00;
414 if (hwif
->cbl
!= ATA_CBL_PATA40_SHORT
)
415 hwif
->cbl
= ata66_cmd64x(hwif
);
417 switch (dev
->device
) {
418 case PCI_DEVICE_ID_CMD_648
:
419 case PCI_DEVICE_ID_CMD_649
:
421 hwif
->ide_dma_end
= &cmd648_ide_dma_end
;
422 hwif
->ide_dma_test_irq
= &cmd648_ide_dma_test_irq
;
424 case PCI_DEVICE_ID_CMD_646
:
425 if (dev
->revision
== 0x01) {
426 hwif
->ide_dma_end
= &cmd646_1_ide_dma_end
;
428 } else if (dev
->revision
>= 0x03)
432 hwif
->ide_dma_end
= &cmd64x_ide_dma_end
;
433 hwif
->ide_dma_test_irq
= &cmd64x_ide_dma_test_irq
;
438 static const struct ide_port_info cmd64x_chipsets
[] __devinitdata
= {
441 .init_chipset
= init_chipset_cmd64x
,
442 .init_hwif
= init_hwif_cmd64x
,
443 .enablebits
= {{0x00,0x00,0x00}, {0x51,0x08,0x08}},
444 .host_flags
= IDE_HFLAG_CLEAR_SIMPLEX
|
445 IDE_HFLAG_ABUSE_PREFETCH
|
447 .pio_mask
= ATA_PIO5
,
448 .mwdma_mask
= ATA_MWDMA2
,
449 .udma_mask
= 0x00, /* no udma */
452 .init_chipset
= init_chipset_cmd64x
,
453 .init_hwif
= init_hwif_cmd64x
,
454 .enablebits
= {{0x51,0x04,0x04}, {0x51,0x08,0x08}},
455 .chipset
= ide_cmd646
,
456 .host_flags
= IDE_HFLAG_ABUSE_PREFETCH
| IDE_HFLAG_BOOTABLE
,
457 .pio_mask
= ATA_PIO5
,
458 .mwdma_mask
= ATA_MWDMA2
,
459 .udma_mask
= ATA_UDMA2
,
462 .init_chipset
= init_chipset_cmd64x
,
463 .init_hwif
= init_hwif_cmd64x
,
464 .enablebits
= {{0x51,0x04,0x04}, {0x51,0x08,0x08}},
465 .host_flags
= IDE_HFLAG_ABUSE_PREFETCH
| IDE_HFLAG_BOOTABLE
,
466 .pio_mask
= ATA_PIO5
,
467 .mwdma_mask
= ATA_MWDMA2
,
468 .udma_mask
= ATA_UDMA4
,
471 .init_chipset
= init_chipset_cmd64x
,
472 .init_hwif
= init_hwif_cmd64x
,
473 .enablebits
= {{0x51,0x04,0x04}, {0x51,0x08,0x08}},
474 .host_flags
= IDE_HFLAG_ABUSE_PREFETCH
| IDE_HFLAG_BOOTABLE
,
475 .pio_mask
= ATA_PIO5
,
476 .mwdma_mask
= ATA_MWDMA2
,
477 .udma_mask
= ATA_UDMA5
,
481 static int __devinit
cmd64x_init_one(struct pci_dev
*dev
, const struct pci_device_id
*id
)
483 struct ide_port_info d
;
484 u8 idx
= id
->driver_data
;
486 d
= cmd64x_chipsets
[idx
];
489 * The original PCI0646 didn't have the primary channel enable bit,
490 * it appeared starting with PCI0646U (i.e. revision ID 3).
492 if (idx
== 1 && dev
->revision
< 3)
493 d
.enablebits
[0].reg
= 0;
495 return ide_setup_pci_device(dev
, &d
);
498 static const struct pci_device_id cmd64x_pci_tbl
[] = {
499 { PCI_VDEVICE(CMD
, PCI_DEVICE_ID_CMD_643
), 0 },
500 { PCI_VDEVICE(CMD
, PCI_DEVICE_ID_CMD_646
), 1 },
501 { PCI_VDEVICE(CMD
, PCI_DEVICE_ID_CMD_648
), 2 },
502 { PCI_VDEVICE(CMD
, PCI_DEVICE_ID_CMD_649
), 3 },
505 MODULE_DEVICE_TABLE(pci
, cmd64x_pci_tbl
);
507 static struct pci_driver driver
= {
508 .name
= "CMD64x_IDE",
509 .id_table
= cmd64x_pci_tbl
,
510 .probe
= cmd64x_init_one
,
513 static int __init
cmd64x_ide_init(void)
515 return ide_pci_register_driver(&driver
);
518 module_init(cmd64x_ide_init
);
520 MODULE_AUTHOR("Eddie Dost, David Miller, Andre Hedrick");
521 MODULE_DESCRIPTION("PCI driver module for CMD64x IDE");
522 MODULE_LICENSE("GPL");