Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 1 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | * cmd64x.c: Enable interrupts at initialization time on Ultra/PCI machines. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3 | * Due to massive hardware bugs, UltraDMA is only supported |
| 4 | * on the 646U2 and not on the 646U. |
| 5 | * |
| 6 | * Copyright (C) 1998 Eddie C. Dost (ecd@skynet.be) |
| 7 | * Copyright (C) 1998 David S. Miller (davem@redhat.com) |
| 8 | * |
| 9 | * Copyright (C) 1999-2002 Andre Hedrick <andre@linux-ide.org> |
Sergei Shtylyov | f92d50e6 | 2007-03-03 17:48:53 +0100 | [diff] [blame] | 10 | * Copyright (C) 2007 MontaVista Software, Inc. <source@mvista.com> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 11 | */ |
| 12 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 13 | #include <linux/module.h> |
| 14 | #include <linux/types.h> |
| 15 | #include <linux/pci.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | #include <linux/ide.h> |
| 17 | #include <linux/init.h> |
| 18 | |
| 19 | #include <asm/io.h> |
| 20 | |
Bartlomiej Zolnierkiewicz | ced3ec8 | 2008-07-24 22:53:32 +0200 | [diff] [blame] | 21 | #define DRV_NAME "cmd64x" |
| 22 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | #define CMD_DEBUG 0 |
| 24 | |
| 25 | #if CMD_DEBUG |
| 26 | #define cmdprintk(x...) printk(x) |
| 27 | #else |
| 28 | #define cmdprintk(x...) |
| 29 | #endif |
| 30 | |
| 31 | /* |
| 32 | * CMD64x specific registers definition. |
| 33 | */ |
| 34 | #define CFR 0x50 |
Sergei Shtylyov | e51e252 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 35 | #define CFR_INTR_CH0 0x04 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 36 | |
| 37 | #define CMDTIM 0x52 |
| 38 | #define ARTTIM0 0x53 |
| 39 | #define DRWTIM0 0x54 |
| 40 | #define ARTTIM1 0x55 |
| 41 | #define DRWTIM1 0x56 |
| 42 | #define ARTTIM23 0x57 |
| 43 | #define ARTTIM23_DIS_RA2 0x04 |
| 44 | #define ARTTIM23_DIS_RA3 0x08 |
| 45 | #define ARTTIM23_INTR_CH1 0x10 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 46 | #define DRWTIM2 0x58 |
| 47 | #define BRST 0x59 |
| 48 | #define DRWTIM3 0x5b |
| 49 | |
| 50 | #define BMIDECR0 0x70 |
| 51 | #define MRDMODE 0x71 |
| 52 | #define MRDMODE_INTR_CH0 0x04 |
| 53 | #define MRDMODE_INTR_CH1 0x08 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 54 | #define UDIDETCR0 0x73 |
| 55 | #define DTPR0 0x74 |
| 56 | #define BMIDECR1 0x78 |
| 57 | #define BMIDECSR 0x79 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | #define UDIDETCR1 0x7B |
| 59 | #define DTPR1 0x7C |
| 60 | |
Sergei Shtylyov | e277a1a | 2007-03-17 21:57:24 +0100 | [diff] [blame] | 61 | static u8 quantize_timing(int timing, int quant) |
| 62 | { |
| 63 | return (timing + quant - 1) / quant; |
| 64 | } |
| 65 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 66 | /* |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 67 | * This routine calculates active/recovery counts and then writes them into |
| 68 | * the chipset registers. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 69 | */ |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 70 | static void program_cycle_times (ide_drive_t *drive, int cycle_time, int active_time) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 71 | { |
Bartlomiej Zolnierkiewicz | ebae41a | 2008-04-27 15:38:29 +0200 | [diff] [blame] | 72 | struct pci_dev *dev = to_pci_dev(drive->hwif->dev); |
Bartlomiej Zolnierkiewicz | 30e5ee4 | 2008-07-15 21:21:46 +0200 | [diff] [blame] | 73 | int clock_time = 1000 / (ide_pci_clk ? ide_pci_clk : 33); |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 74 | u8 cycle_count, active_count, recovery_count, drwtim; |
| 75 | static const u8 recovery_values[] = |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 76 | {15, 15, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 0}; |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 77 | static const u8 drwtim_regs[4] = {DRWTIM0, DRWTIM1, DRWTIM2, DRWTIM3}; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 | |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 79 | cmdprintk("program_cycle_times parameters: total=%d, active=%d\n", |
| 80 | cycle_time, active_time); |
| 81 | |
| 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; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | |
| 86 | /* |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 87 | * In case we've got too long recovery phase, try to lengthen |
| 88 | * the active phase |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 90 | if (recovery_count > 16) { |
| 91 | active_count += recovery_count - 16; |
| 92 | recovery_count = 16; |
| 93 | } |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 94 | if (active_count > 16) /* shouldn't actually happen... */ |
| 95 | active_count = 16; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 96 | |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 97 | cmdprintk("Final counts: total=%d, active=%d, recovery=%d\n", |
| 98 | cycle_count, active_count, recovery_count); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 99 | |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 100 | /* |
| 101 | * Convert values to internal chipset representation |
| 102 | */ |
| 103 | recovery_count = recovery_values[recovery_count]; |
| 104 | active_count &= 0x0f; |
| 105 | |
| 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]); |
| 110 | } |
| 111 | |
| 112 | /* |
Bartlomiej Zolnierkiewicz | 26bcb87 | 2007-10-11 23:54:00 +0200 | [diff] [blame] | 113 | * This routine writes into the chipset registers |
| 114 | * PIO setup/active/recovery timings. |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 115 | */ |
Bartlomiej Zolnierkiewicz | 26bcb87 | 2007-10-11 23:54:00 +0200 | [diff] [blame] | 116 | static void cmd64x_tune_pio(ide_drive_t *drive, const u8 pio) |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 117 | { |
Bartlomiej Zolnierkiewicz | 898ec22 | 2009-01-06 17:20:52 +0100 | [diff] [blame] | 118 | ide_hwif_t *hwif = drive->hwif; |
Bartlomiej Zolnierkiewicz | 3650165 | 2008-02-01 23:09:31 +0100 | [diff] [blame] | 119 | struct pci_dev *dev = to_pci_dev(hwif->dev); |
Bartlomiej Zolnierkiewicz | 86a0e12 | 2008-07-16 20:33:38 +0200 | [diff] [blame] | 120 | struct ide_timing *t = ide_timing_find_mode(XFER_PIO_0 + pio); |
Bartlomiej Zolnierkiewicz | 7dd0008 | 2007-07-20 01:11:56 +0200 | [diff] [blame] | 121 | unsigned int cycle_time; |
Bartlomiej Zolnierkiewicz | 26bcb87 | 2007-10-11 23:54:00 +0200 | [diff] [blame] | 122 | u8 setup_count, arttim = 0; |
| 123 | |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 124 | static const u8 setup_values[] = {0x40, 0x40, 0x40, 0x80, 0, 0xc0}; |
| 125 | static const u8 arttim_regs[4] = {ARTTIM0, ARTTIM1, ARTTIM23, ARTTIM23}; |
Bartlomiej Zolnierkiewicz | 7dd0008 | 2007-07-20 01:11:56 +0200 | [diff] [blame] | 126 | |
Bartlomiej Zolnierkiewicz | 26bcb87 | 2007-10-11 23:54:00 +0200 | [diff] [blame] | 127 | cycle_time = ide_pio_cycle_time(drive, pio); |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 128 | |
Bartlomiej Zolnierkiewicz | 86a0e12 | 2008-07-16 20:33:38 +0200 | [diff] [blame] | 129 | program_cycle_times(drive, cycle_time, t->active); |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 130 | |
Bartlomiej Zolnierkiewicz | 86a0e12 | 2008-07-16 20:33:38 +0200 | [diff] [blame] | 131 | setup_count = quantize_timing(t->setup, |
Bartlomiej Zolnierkiewicz | 30e5ee4 | 2008-07-15 21:21:46 +0200 | [diff] [blame] | 132 | 1000 / (ide_pci_clk ? ide_pci_clk : 33)); |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 133 | |
| 134 | /* |
| 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. |
| 139 | */ |
| 140 | if (hwif->channel) { |
Bartlomiej Zolnierkiewicz | 5d44a15 | 2009-01-06 17:20:55 +0100 | [diff] [blame] | 141 | ide_drive_t *pair = ide_get_pair_dev(drive); |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 142 | |
| 143 | drive->drive_data = setup_count; |
Bartlomiej Zolnierkiewicz | 5d44a15 | 2009-01-06 17:20:55 +0100 | [diff] [blame] | 144 | |
| 145 | if (pair) |
| 146 | setup_count = max_t(u8, setup_count, pair->drive_data); |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 147 | } |
| 148 | |
| 149 | if (setup_count > 5) /* shouldn't actually happen... */ |
| 150 | setup_count = 5; |
| 151 | cmdprintk("Final address setup count: %d\n", setup_count); |
| 152 | |
| 153 | /* |
| 154 | * Program the address setup clocks into the ARTTIM registers. |
| 155 | * Avoid clearing the secondary channel's interrupt bit. |
| 156 | */ |
| 157 | (void) pci_read_config_byte (dev, arttim_regs[drive->dn], &arttim); |
| 158 | if (hwif->channel) |
| 159 | arttim &= ~ARTTIM23_INTR_CH1; |
| 160 | arttim &= ~0xc0; |
| 161 | arttim |= setup_values[setup_count]; |
| 162 | (void) pci_write_config_byte(dev, arttim_regs[drive->dn], arttim); |
| 163 | cmdprintk("Write 0x%02x to reg 0x%x\n", arttim, arttim_regs[drive->dn]); |
Sergei Shtylyov | f92d50e6 | 2007-03-03 17:48:53 +0100 | [diff] [blame] | 164 | } |
| 165 | |
| 166 | /* |
| 167 | * Attempts to set drive's PIO mode. |
Bartlomiej Zolnierkiewicz | 26bcb87 | 2007-10-11 23:54:00 +0200 | [diff] [blame] | 168 | * Special cases are 8: prefetch off, 9: prefetch on (both never worked) |
Sergei Shtylyov | f92d50e6 | 2007-03-03 17:48:53 +0100 | [diff] [blame] | 169 | */ |
Bartlomiej Zolnierkiewicz | 26bcb87 | 2007-10-11 23:54:00 +0200 | [diff] [blame] | 170 | |
| 171 | static void cmd64x_set_pio_mode(ide_drive_t *drive, const u8 pio) |
Sergei Shtylyov | f92d50e6 | 2007-03-03 17:48:53 +0100 | [diff] [blame] | 172 | { |
| 173 | /* |
| 174 | * Filter out the prefetch control values |
| 175 | * to prevent PIO5 from being programmed |
| 176 | */ |
| 177 | if (pio == 8 || pio == 9) |
| 178 | return; |
| 179 | |
Bartlomiej Zolnierkiewicz | 26bcb87 | 2007-10-11 23:54:00 +0200 | [diff] [blame] | 180 | cmd64x_tune_pio(drive, pio); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 181 | } |
| 182 | |
Bartlomiej Zolnierkiewicz | 88b2b32 | 2007-10-13 17:47:51 +0200 | [diff] [blame] | 183 | static void cmd64x_set_dma_mode(ide_drive_t *drive, const u8 speed) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 184 | { |
Bartlomiej Zolnierkiewicz | 898ec22 | 2009-01-06 17:20:52 +0100 | [diff] [blame] | 185 | ide_hwif_t *hwif = drive->hwif; |
Bartlomiej Zolnierkiewicz | 3650165 | 2008-02-01 23:09:31 +0100 | [diff] [blame] | 186 | struct pci_dev *dev = to_pci_dev(hwif->dev); |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 187 | u8 unit = drive->dn & 0x01; |
| 188 | u8 regU = 0, pciU = hwif->channel ? UDIDETCR1 : UDIDETCR0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 189 | |
Sergei Shtylyov | f92d50e6 | 2007-03-03 17:48:53 +0100 | [diff] [blame] | 190 | if (speed >= XFER_SW_DMA_0) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 191 | (void) pci_read_config_byte(dev, pciU, ®U); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 192 | regU &= ~(unit ? 0xCA : 0x35); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 193 | } |
| 194 | |
| 195 | switch(speed) { |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 196 | case XFER_UDMA_5: |
| 197 | regU |= unit ? 0x0A : 0x05; |
| 198 | break; |
| 199 | case XFER_UDMA_4: |
| 200 | regU |= unit ? 0x4A : 0x15; |
| 201 | break; |
| 202 | case XFER_UDMA_3: |
| 203 | regU |= unit ? 0x8A : 0x25; |
| 204 | break; |
| 205 | case XFER_UDMA_2: |
| 206 | regU |= unit ? 0x42 : 0x11; |
| 207 | break; |
| 208 | case XFER_UDMA_1: |
| 209 | regU |= unit ? 0x82 : 0x21; |
| 210 | break; |
| 211 | case XFER_UDMA_0: |
| 212 | regU |= unit ? 0xC2 : 0x31; |
| 213 | break; |
| 214 | case XFER_MW_DMA_2: |
| 215 | program_cycle_times(drive, 120, 70); |
| 216 | break; |
| 217 | case XFER_MW_DMA_1: |
| 218 | program_cycle_times(drive, 150, 80); |
| 219 | break; |
| 220 | case XFER_MW_DMA_0: |
| 221 | program_cycle_times(drive, 480, 215); |
| 222 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 223 | } |
| 224 | |
Sergei Shtylyov | 60e7a82 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 225 | if (speed >= XFER_SW_DMA_0) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 226 | (void) pci_write_config_byte(dev, pciU, regU); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 227 | } |
| 228 | |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 229 | static int cmd648_dma_end(ide_drive_t *drive) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 230 | { |
Bartlomiej Zolnierkiewicz | 898ec22 | 2009-01-06 17:20:52 +0100 | [diff] [blame] | 231 | ide_hwif_t *hwif = drive->hwif; |
Bartlomiej Zolnierkiewicz | 1c029fd | 2008-01-25 22:17:05 +0100 | [diff] [blame] | 232 | unsigned long base = hwif->dma_base - (hwif->channel * 8); |
Bartlomiej Zolnierkiewicz | 653bcf5 | 2008-10-13 21:39:46 +0200 | [diff] [blame] | 233 | int err = ide_dma_end(drive); |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 234 | u8 irq_mask = hwif->channel ? MRDMODE_INTR_CH1 : |
| 235 | MRDMODE_INTR_CH0; |
Bartlomiej Zolnierkiewicz | 1c029fd | 2008-01-25 22:17:05 +0100 | [diff] [blame] | 236 | u8 mrdmode = inb(base + 1); |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 237 | |
| 238 | /* clear the interrupt bit */ |
Sergei Shtylyov | 6183289 | 2007-11-13 22:09:14 +0100 | [diff] [blame] | 239 | outb((mrdmode & ~(MRDMODE_INTR_CH0 | MRDMODE_INTR_CH1)) | irq_mask, |
Bartlomiej Zolnierkiewicz | 1c029fd | 2008-01-25 22:17:05 +0100 | [diff] [blame] | 240 | base + 1); |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 241 | |
| 242 | return err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 243 | } |
| 244 | |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 245 | static int cmd64x_dma_end(ide_drive_t *drive) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 246 | { |
Bartlomiej Zolnierkiewicz | 898ec22 | 2009-01-06 17:20:52 +0100 | [diff] [blame] | 247 | ide_hwif_t *hwif = drive->hwif; |
Bartlomiej Zolnierkiewicz | 3650165 | 2008-02-01 23:09:31 +0100 | [diff] [blame] | 248 | struct pci_dev *dev = to_pci_dev(hwif->dev); |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 249 | int irq_reg = hwif->channel ? ARTTIM23 : CFR; |
| 250 | u8 irq_mask = hwif->channel ? ARTTIM23_INTR_CH1 : |
| 251 | CFR_INTR_CH0; |
| 252 | u8 irq_stat = 0; |
Bartlomiej Zolnierkiewicz | 653bcf5 | 2008-10-13 21:39:46 +0200 | [diff] [blame] | 253 | int err = ide_dma_end(drive); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 254 | |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 255 | (void) pci_read_config_byte(dev, irq_reg, &irq_stat); |
| 256 | /* clear the interrupt bit */ |
| 257 | (void) pci_write_config_byte(dev, irq_reg, irq_stat | irq_mask); |
| 258 | |
| 259 | return err; |
| 260 | } |
| 261 | |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 262 | static int cmd648_dma_test_irq(ide_drive_t *drive) |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 263 | { |
Bartlomiej Zolnierkiewicz | 898ec22 | 2009-01-06 17:20:52 +0100 | [diff] [blame] | 264 | ide_hwif_t *hwif = drive->hwif; |
Bartlomiej Zolnierkiewicz | 1c029fd | 2008-01-25 22:17:05 +0100 | [diff] [blame] | 265 | unsigned long base = hwif->dma_base - (hwif->channel * 8); |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 266 | u8 irq_mask = hwif->channel ? MRDMODE_INTR_CH1 : |
| 267 | MRDMODE_INTR_CH0; |
Bartlomiej Zolnierkiewicz | cab7f8e | 2008-07-23 19:55:51 +0200 | [diff] [blame] | 268 | u8 dma_stat = inb(hwif->dma_base + ATA_DMA_STATUS); |
Bartlomiej Zolnierkiewicz | 1c029fd | 2008-01-25 22:17:05 +0100 | [diff] [blame] | 269 | u8 mrdmode = inb(base + 1); |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 270 | |
| 271 | #ifdef DEBUG |
| 272 | printk("%s: dma_stat: 0x%02x mrdmode: 0x%02x irq_mask: 0x%02x\n", |
| 273 | drive->name, dma_stat, mrdmode, irq_mask); |
| 274 | #endif |
| 275 | if (!(mrdmode & irq_mask)) |
| 276 | return 0; |
| 277 | |
| 278 | /* return 1 if INTR asserted */ |
| 279 | if (dma_stat & 4) |
| 280 | return 1; |
| 281 | |
| 282 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 283 | } |
| 284 | |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 285 | static int cmd64x_dma_test_irq(ide_drive_t *drive) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 286 | { |
Bartlomiej Zolnierkiewicz | 898ec22 | 2009-01-06 17:20:52 +0100 | [diff] [blame] | 287 | ide_hwif_t *hwif = drive->hwif; |
Bartlomiej Zolnierkiewicz | 3650165 | 2008-02-01 23:09:31 +0100 | [diff] [blame] | 288 | struct pci_dev *dev = to_pci_dev(hwif->dev); |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 289 | int irq_reg = hwif->channel ? ARTTIM23 : CFR; |
| 290 | u8 irq_mask = hwif->channel ? ARTTIM23_INTR_CH1 : |
| 291 | CFR_INTR_CH0; |
Bartlomiej Zolnierkiewicz | cab7f8e | 2008-07-23 19:55:51 +0200 | [diff] [blame] | 292 | u8 dma_stat = inb(hwif->dma_base + ATA_DMA_STATUS); |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 293 | u8 irq_stat = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 294 | |
Sergei Shtylyov | e51e252 | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 295 | (void) pci_read_config_byte(dev, irq_reg, &irq_stat); |
| 296 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 297 | #ifdef DEBUG |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 298 | printk("%s: dma_stat: 0x%02x irq_stat: 0x%02x irq_mask: 0x%02x\n", |
| 299 | drive->name, dma_stat, irq_stat, irq_mask); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 300 | #endif |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 301 | if (!(irq_stat & irq_mask)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 302 | return 0; |
| 303 | |
| 304 | /* return 1 if INTR asserted */ |
Sergei Shtylyov | 66602c8 | 2007-05-05 22:03:50 +0200 | [diff] [blame] | 305 | if (dma_stat & 4) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 306 | return 1; |
| 307 | |
| 308 | return 0; |
| 309 | } |
| 310 | |
| 311 | /* |
| 312 | * ASUS P55T2P4D with CMD646 chipset revision 0x01 requires the old |
| 313 | * event order for DMA transfers. |
| 314 | */ |
| 315 | |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 316 | static int cmd646_1_dma_end(ide_drive_t *drive) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 317 | { |
Bartlomiej Zolnierkiewicz | 898ec22 | 2009-01-06 17:20:52 +0100 | [diff] [blame] | 318 | ide_hwif_t *hwif = drive->hwif; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 319 | u8 dma_stat = 0, dma_cmd = 0; |
| 320 | |
| 321 | drive->waiting_for_dma = 0; |
| 322 | /* get DMA status */ |
Bartlomiej Zolnierkiewicz | cab7f8e | 2008-07-23 19:55:51 +0200 | [diff] [blame] | 323 | dma_stat = inb(hwif->dma_base + ATA_DMA_STATUS); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 324 | /* read DMA command state */ |
Bartlomiej Zolnierkiewicz | cab7f8e | 2008-07-23 19:55:51 +0200 | [diff] [blame] | 325 | dma_cmd = inb(hwif->dma_base + ATA_DMA_CMD); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 326 | /* stop DMA */ |
Bartlomiej Zolnierkiewicz | cab7f8e | 2008-07-23 19:55:51 +0200 | [diff] [blame] | 327 | outb(dma_cmd & ~1, hwif->dma_base + ATA_DMA_CMD); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 328 | /* clear the INTR & ERROR bits */ |
Bartlomiej Zolnierkiewicz | cab7f8e | 2008-07-23 19:55:51 +0200 | [diff] [blame] | 329 | outb(dma_stat | 6, hwif->dma_base + ATA_DMA_STATUS); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 330 | /* and free any DMA resources */ |
| 331 | ide_destroy_dmatable(drive); |
| 332 | /* verify good DMA status */ |
| 333 | return (dma_stat & 7) != 4; |
| 334 | } |
| 335 | |
Bartlomiej Zolnierkiewicz | 2ed0ef5 | 2009-03-24 23:22:53 +0100 | [diff] [blame] | 336 | static int init_chipset_cmd64x(struct pci_dev *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 337 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 338 | u8 mrdmode = 0; |
| 339 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 340 | /* Set a good latency timer and cache line size value. */ |
| 341 | (void) pci_write_config_byte(dev, PCI_LATENCY_TIMER, 64); |
| 342 | /* FIXME: pci_set_master() to ensure a good latency timer value */ |
| 343 | |
Sergei Shtylyov | 83a6d4a | 2007-07-09 23:17:55 +0200 | [diff] [blame] | 344 | /* |
| 345 | * Enable interrupts, select MEMORY READ LINE for reads. |
| 346 | * |
| 347 | * NOTE: although not mentioned in the PCI0646U specs, |
| 348 | * bits 0-1 are write only and won't be read back as |
| 349 | * set or not -- PCI0646U2 specs clarify this point. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 350 | */ |
Sergei Shtylyov | 83a6d4a | 2007-07-09 23:17:55 +0200 | [diff] [blame] | 351 | (void) pci_read_config_byte (dev, MRDMODE, &mrdmode); |
| 352 | mrdmode &= ~0x30; |
| 353 | (void) pci_write_config_byte(dev, MRDMODE, (mrdmode | 0x02)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 354 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 355 | return 0; |
| 356 | } |
| 357 | |
Bartlomiej Zolnierkiewicz | f454cbe | 2008-08-05 18:17:04 +0200 | [diff] [blame] | 358 | static u8 cmd64x_cable_detect(ide_hwif_t *hwif) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 359 | { |
Bartlomiej Zolnierkiewicz | 3650165 | 2008-02-01 23:09:31 +0100 | [diff] [blame] | 360 | struct pci_dev *dev = to_pci_dev(hwif->dev); |
Sergei Shtylyov | 83a6d4a | 2007-07-09 23:17:55 +0200 | [diff] [blame] | 361 | u8 bmidecsr = 0, mask = hwif->channel ? 0x02 : 0x01; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 362 | |
Sergei Shtylyov | 83a6d4a | 2007-07-09 23:17:55 +0200 | [diff] [blame] | 363 | switch (dev->device) { |
| 364 | case PCI_DEVICE_ID_CMD_648: |
| 365 | case PCI_DEVICE_ID_CMD_649: |
| 366 | pci_read_config_byte(dev, BMIDECSR, &bmidecsr); |
Bartlomiej Zolnierkiewicz | 49521f9 | 2007-07-09 23:17:58 +0200 | [diff] [blame] | 367 | return (bmidecsr & mask) ? ATA_CBL_PATA80 : ATA_CBL_PATA40; |
Sergei Shtylyov | 83a6d4a | 2007-07-09 23:17:55 +0200 | [diff] [blame] | 368 | default: |
Bartlomiej Zolnierkiewicz | 49521f9 | 2007-07-09 23:17:58 +0200 | [diff] [blame] | 369 | return ATA_CBL_PATA40; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 370 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 371 | } |
| 372 | |
Bartlomiej Zolnierkiewicz | ac95bee | 2008-04-26 22:25:14 +0200 | [diff] [blame] | 373 | static const struct ide_port_ops cmd64x_port_ops = { |
| 374 | .set_pio_mode = cmd64x_set_pio_mode, |
| 375 | .set_dma_mode = cmd64x_set_dma_mode, |
| 376 | .cable_detect = cmd64x_cable_detect, |
| 377 | }; |
| 378 | |
Bartlomiej Zolnierkiewicz | f37afda | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 379 | static const struct ide_dma_ops cmd64x_dma_ops = { |
| 380 | .dma_host_set = ide_dma_host_set, |
| 381 | .dma_setup = ide_dma_setup, |
| 382 | .dma_exec_cmd = ide_dma_exec_cmd, |
| 383 | .dma_start = ide_dma_start, |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 384 | .dma_end = cmd64x_dma_end, |
| 385 | .dma_test_irq = cmd64x_dma_test_irq, |
Bartlomiej Zolnierkiewicz | f37afda | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 386 | .dma_lost_irq = ide_dma_lost_irq, |
| 387 | .dma_timeout = ide_dma_timeout, |
Sergei Shtylyov | 592b531 | 2009-01-06 17:21:02 +0100 | [diff] [blame] | 388 | .dma_sff_read_status = ide_dma_sff_read_status, |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 389 | }; |
| 390 | |
Bartlomiej Zolnierkiewicz | f37afda | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 391 | static const struct ide_dma_ops cmd646_rev1_dma_ops = { |
| 392 | .dma_host_set = ide_dma_host_set, |
| 393 | .dma_setup = ide_dma_setup, |
| 394 | .dma_exec_cmd = ide_dma_exec_cmd, |
| 395 | .dma_start = ide_dma_start, |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 396 | .dma_end = cmd646_1_dma_end, |
Bartlomiej Zolnierkiewicz | f37afda | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 397 | .dma_test_irq = ide_dma_test_irq, |
| 398 | .dma_lost_irq = ide_dma_lost_irq, |
| 399 | .dma_timeout = ide_dma_timeout, |
Sergei Shtylyov | 592b531 | 2009-01-06 17:21:02 +0100 | [diff] [blame] | 400 | .dma_sff_read_status = ide_dma_sff_read_status, |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 401 | }; |
| 402 | |
Bartlomiej Zolnierkiewicz | f37afda | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 403 | static const struct ide_dma_ops cmd648_dma_ops = { |
| 404 | .dma_host_set = ide_dma_host_set, |
| 405 | .dma_setup = ide_dma_setup, |
| 406 | .dma_exec_cmd = ide_dma_exec_cmd, |
| 407 | .dma_start = ide_dma_start, |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 408 | .dma_end = cmd648_dma_end, |
| 409 | .dma_test_irq = cmd648_dma_test_irq, |
Bartlomiej Zolnierkiewicz | f37afda | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 410 | .dma_lost_irq = ide_dma_lost_irq, |
| 411 | .dma_timeout = ide_dma_timeout, |
Sergei Shtylyov | 592b531 | 2009-01-06 17:21:02 +0100 | [diff] [blame] | 412 | .dma_sff_read_status = ide_dma_sff_read_status, |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 413 | }; |
| 414 | |
Bartlomiej Zolnierkiewicz | 8562043 | 2007-10-20 00:32:34 +0200 | [diff] [blame] | 415 | static const struct ide_port_info cmd64x_chipsets[] __devinitdata = { |
Bartlomiej Zolnierkiewicz | ced3ec8 | 2008-07-24 22:53:32 +0200 | [diff] [blame] | 416 | { /* 0: CMD643 */ |
| 417 | .name = DRV_NAME, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 418 | .init_chipset = init_chipset_cmd64x, |
Sergei Shtylyov | 7accbff | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 419 | .enablebits = {{0x00,0x00,0x00}, {0x51,0x08,0x08}}, |
Bartlomiej Zolnierkiewicz | ac95bee | 2008-04-26 22:25:14 +0200 | [diff] [blame] | 420 | .port_ops = &cmd64x_port_ops, |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 421 | .dma_ops = &cmd64x_dma_ops, |
Bartlomiej Zolnierkiewicz | 8ac2b42a | 2008-02-01 23:09:30 +0100 | [diff] [blame] | 422 | .host_flags = IDE_HFLAG_CLEAR_SIMPLEX | |
Bartlomiej Zolnierkiewicz | 5e71d9c | 2008-04-26 17:36:35 +0200 | [diff] [blame] | 423 | IDE_HFLAG_ABUSE_PREFETCH, |
Bartlomiej Zolnierkiewicz | 4099d14 | 2007-07-20 01:11:59 +0200 | [diff] [blame] | 424 | .pio_mask = ATA_PIO5, |
Bartlomiej Zolnierkiewicz | 5f8b6c3 | 2007-10-19 00:30:07 +0200 | [diff] [blame] | 425 | .mwdma_mask = ATA_MWDMA2, |
Bartlomiej Zolnierkiewicz | 1813720 | 2007-05-10 00:01:07 +0200 | [diff] [blame] | 426 | .udma_mask = 0x00, /* no udma */ |
Bartlomiej Zolnierkiewicz | ced3ec8 | 2008-07-24 22:53:32 +0200 | [diff] [blame] | 427 | }, |
| 428 | { /* 1: CMD646 */ |
| 429 | .name = DRV_NAME, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 430 | .init_chipset = init_chipset_cmd64x, |
Sergei Shtylyov | 7accbff | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 431 | .enablebits = {{0x51,0x04,0x04}, {0x51,0x08,0x08}}, |
Bartlomiej Zolnierkiewicz | ac95bee | 2008-04-26 22:25:14 +0200 | [diff] [blame] | 432 | .port_ops = &cmd64x_port_ops, |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 433 | .dma_ops = &cmd648_dma_ops, |
Bartlomiej Zolnierkiewicz | 6b5cde3 | 2008-12-29 20:27:32 +0100 | [diff] [blame] | 434 | .host_flags = IDE_HFLAG_SERIALIZE | |
| 435 | IDE_HFLAG_ABUSE_PREFETCH, |
Bartlomiej Zolnierkiewicz | 4099d14 | 2007-07-20 01:11:59 +0200 | [diff] [blame] | 436 | .pio_mask = ATA_PIO5, |
Bartlomiej Zolnierkiewicz | 5f8b6c3 | 2007-10-19 00:30:07 +0200 | [diff] [blame] | 437 | .mwdma_mask = ATA_MWDMA2, |
| 438 | .udma_mask = ATA_UDMA2, |
Bartlomiej Zolnierkiewicz | ced3ec8 | 2008-07-24 22:53:32 +0200 | [diff] [blame] | 439 | }, |
| 440 | { /* 2: CMD648 */ |
| 441 | .name = DRV_NAME, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 442 | .init_chipset = init_chipset_cmd64x, |
Sergei Shtylyov | 7accbff | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 443 | .enablebits = {{0x51,0x04,0x04}, {0x51,0x08,0x08}}, |
Bartlomiej Zolnierkiewicz | ac95bee | 2008-04-26 22:25:14 +0200 | [diff] [blame] | 444 | .port_ops = &cmd64x_port_ops, |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 445 | .dma_ops = &cmd648_dma_ops, |
Bartlomiej Zolnierkiewicz | 5e71d9c | 2008-04-26 17:36:35 +0200 | [diff] [blame] | 446 | .host_flags = IDE_HFLAG_ABUSE_PREFETCH, |
Bartlomiej Zolnierkiewicz | 4099d14 | 2007-07-20 01:11:59 +0200 | [diff] [blame] | 447 | .pio_mask = ATA_PIO5, |
Bartlomiej Zolnierkiewicz | 5f8b6c3 | 2007-10-19 00:30:07 +0200 | [diff] [blame] | 448 | .mwdma_mask = ATA_MWDMA2, |
| 449 | .udma_mask = ATA_UDMA4, |
Bartlomiej Zolnierkiewicz | ced3ec8 | 2008-07-24 22:53:32 +0200 | [diff] [blame] | 450 | }, |
| 451 | { /* 3: CMD649 */ |
| 452 | .name = DRV_NAME, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 453 | .init_chipset = init_chipset_cmd64x, |
Sergei Shtylyov | 7accbff | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 454 | .enablebits = {{0x51,0x04,0x04}, {0x51,0x08,0x08}}, |
Bartlomiej Zolnierkiewicz | ac95bee | 2008-04-26 22:25:14 +0200 | [diff] [blame] | 455 | .port_ops = &cmd64x_port_ops, |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 456 | .dma_ops = &cmd648_dma_ops, |
Bartlomiej Zolnierkiewicz | 5e71d9c | 2008-04-26 17:36:35 +0200 | [diff] [blame] | 457 | .host_flags = IDE_HFLAG_ABUSE_PREFETCH, |
Bartlomiej Zolnierkiewicz | 4099d14 | 2007-07-20 01:11:59 +0200 | [diff] [blame] | 458 | .pio_mask = ATA_PIO5, |
Bartlomiej Zolnierkiewicz | 5f8b6c3 | 2007-10-19 00:30:07 +0200 | [diff] [blame] | 459 | .mwdma_mask = ATA_MWDMA2, |
| 460 | .udma_mask = ATA_UDMA5, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 461 | } |
| 462 | }; |
| 463 | |
| 464 | static int __devinit cmd64x_init_one(struct pci_dev *dev, const struct pci_device_id *id) |
| 465 | { |
Bartlomiej Zolnierkiewicz | 039788e | 2007-10-20 00:32:34 +0200 | [diff] [blame] | 466 | struct ide_port_info d; |
Bartlomiej Zolnierkiewicz | bfd314a | 2007-10-19 00:30:09 +0200 | [diff] [blame] | 467 | u8 idx = id->driver_data; |
Sergei Shtylyov | 7accbff | 2007-05-05 22:03:49 +0200 | [diff] [blame] | 468 | |
Bartlomiej Zolnierkiewicz | bfd314a | 2007-10-19 00:30:09 +0200 | [diff] [blame] | 469 | d = cmd64x_chipsets[idx]; |
| 470 | |
Bartlomiej Zolnierkiewicz | 5e37bdc | 2008-04-26 22:25:24 +0200 | [diff] [blame] | 471 | if (idx == 1) { |
| 472 | /* |
| 473 | * UltraDMA only supported on PCI646U and PCI646U2, which |
| 474 | * correspond to revisions 0x03, 0x05 and 0x07 respectively. |
| 475 | * Actually, although the CMD tech support people won't |
| 476 | * tell me the details, the 0x03 revision cannot support |
| 477 | * UDMA correctly without hardware modifications, and even |
| 478 | * then it only works with Quantum disks due to some |
| 479 | * hold time assumptions in the 646U part which are fixed |
| 480 | * in the 646U2. |
| 481 | * |
| 482 | * So we only do UltraDMA on revision 0x05 and 0x07 chipsets. |
| 483 | */ |
| 484 | if (dev->revision < 5) { |
| 485 | d.udma_mask = 0x00; |
| 486 | /* |
| 487 | * The original PCI0646 didn't have the primary |
| 488 | * channel enable bit, it appeared starting with |
| 489 | * PCI0646U (i.e. revision ID 3). |
| 490 | */ |
| 491 | if (dev->revision < 3) { |
| 492 | d.enablebits[0].reg = 0; |
| 493 | if (dev->revision == 1) |
| 494 | d.dma_ops = &cmd646_rev1_dma_ops; |
| 495 | else |
| 496 | d.dma_ops = &cmd64x_dma_ops; |
| 497 | } |
| 498 | } |
| 499 | } |
Bartlomiej Zolnierkiewicz | bfd314a | 2007-10-19 00:30:09 +0200 | [diff] [blame] | 500 | |
Bartlomiej Zolnierkiewicz | 6cdf6eb | 2008-07-24 22:53:14 +0200 | [diff] [blame] | 501 | return ide_pci_init_one(dev, &d, NULL); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 502 | } |
| 503 | |
Bartlomiej Zolnierkiewicz | 9cbcc5e | 2007-10-16 22:29:56 +0200 | [diff] [blame] | 504 | static const struct pci_device_id cmd64x_pci_tbl[] = { |
| 505 | { PCI_VDEVICE(CMD, PCI_DEVICE_ID_CMD_643), 0 }, |
| 506 | { PCI_VDEVICE(CMD, PCI_DEVICE_ID_CMD_646), 1 }, |
| 507 | { PCI_VDEVICE(CMD, PCI_DEVICE_ID_CMD_648), 2 }, |
| 508 | { PCI_VDEVICE(CMD, PCI_DEVICE_ID_CMD_649), 3 }, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 509 | { 0, }, |
| 510 | }; |
| 511 | MODULE_DEVICE_TABLE(pci, cmd64x_pci_tbl); |
| 512 | |
Bartlomiej Zolnierkiewicz | a9ab09e2 | 2008-10-13 21:39:41 +0200 | [diff] [blame] | 513 | static struct pci_driver cmd64x_pci_driver = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 514 | .name = "CMD64x_IDE", |
| 515 | .id_table = cmd64x_pci_tbl, |
| 516 | .probe = cmd64x_init_one, |
Bartlomiej Zolnierkiewicz | e2b15b4 | 2008-07-24 22:53:20 +0200 | [diff] [blame] | 517 | .remove = ide_pci_remove, |
Bartlomiej Zolnierkiewicz | feb22b7 | 2008-10-10 22:39:32 +0200 | [diff] [blame] | 518 | .suspend = ide_pci_suspend, |
| 519 | .resume = ide_pci_resume, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 520 | }; |
| 521 | |
Bartlomiej Zolnierkiewicz | 82ab1ee | 2007-01-27 13:46:56 +0100 | [diff] [blame] | 522 | static int __init cmd64x_ide_init(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 523 | { |
Bartlomiej Zolnierkiewicz | a9ab09e2 | 2008-10-13 21:39:41 +0200 | [diff] [blame] | 524 | return ide_pci_register_driver(&cmd64x_pci_driver); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 525 | } |
| 526 | |
Bartlomiej Zolnierkiewicz | e2b15b4 | 2008-07-24 22:53:20 +0200 | [diff] [blame] | 527 | static void __exit cmd64x_ide_exit(void) |
| 528 | { |
Bartlomiej Zolnierkiewicz | a9ab09e2 | 2008-10-13 21:39:41 +0200 | [diff] [blame] | 529 | pci_unregister_driver(&cmd64x_pci_driver); |
Bartlomiej Zolnierkiewicz | e2b15b4 | 2008-07-24 22:53:20 +0200 | [diff] [blame] | 530 | } |
| 531 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 532 | module_init(cmd64x_ide_init); |
Bartlomiej Zolnierkiewicz | e2b15b4 | 2008-07-24 22:53:20 +0200 | [diff] [blame] | 533 | module_exit(cmd64x_ide_exit); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 534 | |
| 535 | MODULE_AUTHOR("Eddie Dost, David Miller, Andre Hedrick"); |
| 536 | MODULE_DESCRIPTION("PCI driver module for CMD64x IDE"); |
| 537 | MODULE_LICENSE("GPL"); |