Blame view
drivers/ata/pata_cmd64x.c
12.9 KB
669a5db41 [libata] Add a bu... |
1 |
/* |
fb9f8905a [libata] pata_cmd... |
2 |
* pata_cmd64x.c - CMD64x PATA for new ATA layer |
669a5db41 [libata] Add a bu... |
3 |
* (C) 2005 Red Hat Inc |
ab7716300 ata: Switch all m... |
4 |
* Alan Cox <alan@lxorguk.ukuu.org.uk> |
a2bd62207 pata_cmd64x: fix ... |
5 |
* (C) 2009-2010 Bartlomiej Zolnierkiewicz |
8a686bc98 pata_cmd64x: use ... |
6 |
* (C) 2012 MontaVista Software, LLC <source@mvista.com> |
669a5db41 [libata] Add a bu... |
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 |
* * Based upon * linux/drivers/ide/pci/cmd64x.c Version 1.30 Sept 10, 2002 * * cmd64x.c: Enable interrupts at initialization time on Ultra/PCI machines. * Note, this driver is not used at all on other systems because * there the "BIOS" has done all of the following already. * Due to massive hardware bugs, UltraDMA is only supported * on the 646U2 and not on the 646U. * * Copyright (C) 1998 Eddie C. Dost (ecd@skynet.be) * Copyright (C) 1998 David S. Miller (davem@redhat.com) * * Copyright (C) 1999-2002 Andre Hedrick <andre@linux-ide.org> * * TODO * Testing work */ |
85cd7251b [libata #pata-dri... |
25 |
|
669a5db41 [libata] Add a bu... |
26 27 28 |
#include <linux/kernel.h> #include <linux/module.h> #include <linux/pci.h> |
669a5db41 [libata] Add a bu... |
29 30 31 32 33 34 |
#include <linux/blkdev.h> #include <linux/delay.h> #include <scsi/scsi_host.h> #include <linux/libata.h> #define DRV_NAME "pata_cmd64x" |
b8cec3c25 pata_cmd64x: impl... |
35 |
#define DRV_VERSION "0.2.18" |
669a5db41 [libata] Add a bu... |
36 37 38 39 |
/* * CMD64x specific registers definition. */ |
85cd7251b [libata #pata-dri... |
40 |
|
669a5db41 [libata] Add a bu... |
41 42 |
enum { CFR = 0x50, |
03a849e6d pata_cmd64x: cmd6... |
43 |
CFR_INTR_CH0 = 0x04, |
9281b16ca pata_cm64x: fix b... |
44 45 46 |
CNTRL = 0x51, CNTRL_CH0 = 0x04, CNTRL_CH1 = 0x08, |
669a5db41 [libata] Add a bu... |
47 48 49 50 51 52 53 54 55 |
CMDTIM = 0x52, ARTTIM0 = 0x53, DRWTIM0 = 0x54, ARTTIM1 = 0x55, DRWTIM1 = 0x56, ARTTIM23 = 0x57, ARTTIM23_DIS_RA2 = 0x04, ARTTIM23_DIS_RA3 = 0x08, ARTTIM23_INTR_CH1 = 0x10, |
669a5db41 [libata] Add a bu... |
56 57 58 59 60 61 62 |
DRWTIM2 = 0x58, BRST = 0x59, DRWTIM3 = 0x5b, BMIDECR0 = 0x70, MRDMODE = 0x71, MRDMODE_INTR_CH0 = 0x04, MRDMODE_INTR_CH1 = 0x08, |
669a5db41 [libata] Add a bu... |
63 64 65 66 67 |
BMIDESR0 = 0x72, UDIDETCR0 = 0x73, DTPR0 = 0x74, BMIDECR1 = 0x78, BMIDECSR = 0x79, |
669a5db41 [libata] Add a bu... |
68 69 70 |
UDIDETCR1 = 0x7B, DTPR1 = 0x7C }; |
a73984a0d [libata] More PAT... |
71 |
static int cmd648_cable_detect(struct ata_port *ap) |
669a5db41 [libata] Add a bu... |
72 73 74 75 76 77 78 |
{ struct pci_dev *pdev = to_pci_dev(ap->host->dev); u8 r; /* Check cable detect bits */ pci_read_config_byte(pdev, BMIDECSR, &r); if (r & (1 << ap->port_no)) |
a73984a0d [libata] More PAT... |
79 80 |
return ATA_CBL_PATA80; return ATA_CBL_PATA40; |
669a5db41 [libata] Add a bu... |
81 82 83 |
} /** |
57242762e pata_cmd64x: docu... |
84 |
* cmd64x_set_timing - set PIO and MWDMA timing |
669a5db41 [libata] Add a bu... |
85 86 |
* @ap: ATA interface * @adev: ATA device |
05d1efffd pata_cmd64x: Set ... |
87 |
* @mode: mode |
669a5db41 [libata] Add a bu... |
88 |
* |
05d1efffd pata_cmd64x: Set ... |
89 |
* Called to do the PIO and MWDMA mode setup. |
669a5db41 [libata] Add a bu... |
90 |
*/ |
85cd7251b [libata #pata-dri... |
91 |
|
05d1efffd pata_cmd64x: Set ... |
92 |
static void cmd64x_set_timing(struct ata_port *ap, struct ata_device *adev, u8 mode) |
669a5db41 [libata] Add a bu... |
93 94 95 96 97 |
{ struct pci_dev *pdev = to_pci_dev(ap->host->dev); struct ata_timing t; const unsigned long T = 1000000 / 33; const u8 setup_data[] = { 0x40, 0x40, 0x40, 0x80, 0x00 }; |
85cd7251b [libata #pata-dri... |
98 |
|
669a5db41 [libata] Add a bu... |
99 |
u8 reg; |
85cd7251b [libata #pata-dri... |
100 |
|
669a5db41 [libata] Add a bu... |
101 |
/* Port layout is not logical so use a table */ |
85cd7251b [libata #pata-dri... |
102 |
const u8 arttim_port[2][2] = { |
669a5db41 [libata] Add a bu... |
103 104 105 106 107 108 109 |
{ ARTTIM0, ARTTIM1 }, { ARTTIM23, ARTTIM23 } }; const u8 drwtim_port[2][2] = { { DRWTIM0, DRWTIM1 }, { DRWTIM2, DRWTIM3 } }; |
85cd7251b [libata #pata-dri... |
110 |
|
669a5db41 [libata] Add a bu... |
111 112 |
int arttim = arttim_port[ap->port_no][adev->devno]; int drwtim = drwtim_port[ap->port_no][adev->devno]; |
85cd7251b [libata #pata-dri... |
113 |
|
05d1efffd pata_cmd64x: Set ... |
114 115 116 |
/* ata_timing_compute is smart and will produce timings for MWDMA that don't violate the drives PIO capabilities. */ if (ata_timing_compute(adev, mode, &t, T, 0) < 0) { |
669a5db41 [libata] Add a bu... |
117 118 119 120 121 122 123 |
printk(KERN_ERR DRV_NAME ": mode computation failed. "); return; } if (ap->port_no) { /* Slave has shared address setup */ struct ata_device *pair = ata_dev_pair(adev); |
85cd7251b [libata #pata-dri... |
124 |
|
669a5db41 [libata] Add a bu... |
125 126 127 128 129 130 |
if (pair) { struct ata_timing tp; ata_timing_compute(pair, pair->pio_mode, &tp, T, 0); ata_timing_merge(&t, &tp, &t, ATA_TIMING_SETUP); } } |
85cd7251b [libata #pata-dri... |
131 |
|
669a5db41 [libata] Add a bu... |
132 133 134 135 136 137 138 139 140 |
printk(KERN_DEBUG DRV_NAME ": active %d recovery %d setup %d. ", t.active, t.recover, t.setup); if (t.recover > 16) { t.active += t.recover - 16; t.recover = 16; } if (t.active > 16) t.active = 16; |
85cd7251b [libata #pata-dri... |
141 |
|
669a5db41 [libata] Add a bu... |
142 143 |
/* Now convert the clocks into values we can actually stuff into the chip */ |
85cd7251b [libata #pata-dri... |
144 |
|
a2bd62207 pata_cmd64x: fix ... |
145 146 147 |
if (t.recover == 16) t.recover = 0; else if (t.recover > 1) |
669a5db41 [libata] Add a bu... |
148 149 150 |
t.recover--; else t.recover = 15; |
85cd7251b [libata #pata-dri... |
151 |
|
669a5db41 [libata] Add a bu... |
152 153 154 155 |
if (t.setup > 4) t.setup = 0xC0; else t.setup = setup_data[t.setup]; |
85cd7251b [libata #pata-dri... |
156 |
|
669a5db41 [libata] Add a bu... |
157 |
t.active &= 0x0F; /* 0 = 16 */ |
85cd7251b [libata #pata-dri... |
158 |
|
669a5db41 [libata] Add a bu... |
159 160 161 162 163 |
/* Load setup timing */ pci_read_config_byte(pdev, arttim, ®); reg &= 0x3F; reg |= t.setup; pci_write_config_byte(pdev, arttim, reg); |
85cd7251b [libata #pata-dri... |
164 |
|
669a5db41 [libata] Add a bu... |
165 |
/* Load active/recovery */ |
85cd7251b [libata #pata-dri... |
166 |
pci_write_config_byte(pdev, drwtim, (t.active << 4) | t.recover); |
669a5db41 [libata] Add a bu... |
167 168 169 |
} /** |
05d1efffd pata_cmd64x: Set ... |
170 171 172 173 174 175 176 177 178 179 180 181 182 183 |
* cmd64x_set_piomode - set initial PIO mode data * @ap: ATA interface * @adev: ATA device * * Used when configuring the devices ot set the PIO timings. All the * actual work is done by the PIO/MWDMA setting helper */ static void cmd64x_set_piomode(struct ata_port *ap, struct ata_device *adev) { cmd64x_set_timing(ap, adev, adev->pio_mode); } /** |
669a5db41 [libata] Add a bu... |
184 185 186 187 188 189 |
* cmd64x_set_dmamode - set initial DMA mode data * @ap: ATA interface * @adev: ATA device * * Called to do the DMA mode setup. */ |
85cd7251b [libata #pata-dri... |
190 |
|
669a5db41 [libata] Add a bu... |
191 192 193 |
static void cmd64x_set_dmamode(struct ata_port *ap, struct ata_device *adev) { static const u8 udma_data[] = { |
6a40da02b libata cmd64x: wh... |
194 |
0x30, 0x20, 0x10, 0x20, 0x10, 0x00 |
669a5db41 [libata] Add a bu... |
195 |
}; |
85cd7251b [libata #pata-dri... |
196 |
|
669a5db41 [libata] Add a bu... |
197 198 199 200 201 202 |
struct pci_dev *pdev = to_pci_dev(ap->host->dev); u8 regU, regD; int pciU = UDIDETCR0 + 8 * ap->port_no; int pciD = BMIDESR0 + 8 * ap->port_no; int shift = 2 * adev->devno; |
85cd7251b [libata #pata-dri... |
203 |
|
669a5db41 [libata] Add a bu... |
204 205 |
pci_read_config_byte(pdev, pciD, ®D); pci_read_config_byte(pdev, pciU, ®U); |
6a40da02b libata cmd64x: wh... |
206 207 208 209 210 211 |
/* DMA bits off */ regD &= ~(0x20 << adev->devno); /* DMA control bits */ regU &= ~(0x30 << shift); /* DMA timing bits */ regU &= ~(0x05 << adev->devno); |
85cd7251b [libata #pata-dri... |
212 |
|
6a40da02b libata cmd64x: wh... |
213 |
if (adev->dma_mode >= XFER_UDMA_0) { |
24b7ce985 pata_cmd64x.c typ... |
214 |
/* Merge the timing value */ |
669a5db41 [libata] Add a bu... |
215 |
regU |= udma_data[adev->dma_mode - XFER_UDMA_0] << shift; |
6a40da02b libata cmd64x: wh... |
216 217 |
/* Merge the control bits */ regU |= 1 << adev->devno; /* UDMA on */ |
509426bd4 pata_cmd64x: fix ... |
218 |
if (adev->dma_mode > XFER_UDMA_2) /* 15nS timing */ |
6a40da02b libata cmd64x: wh... |
219 |
regU |= 4 << adev->devno; |
05d1efffd pata_cmd64x: Set ... |
220 221 222 223 |
} else { regU &= ~ (1 << adev->devno); /* UDMA off */ cmd64x_set_timing(ap, adev, adev->dma_mode); } |
669a5db41 [libata] Add a bu... |
224 225 226 227 228 229 230 231 |
regD |= 0x20 << adev->devno; pci_write_config_byte(pdev, pciU, regU); pci_write_config_byte(pdev, pciD, regD); } /** |
b8cec3c25 pata_cmd64x: impl... |
232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 |
* cmd64x_sff_irq_check - check IDE interrupt * @ap: ATA interface * * Check IDE interrupt in CFR/ARTTIM23 registers. */ static bool cmd64x_sff_irq_check(struct ata_port *ap) { struct pci_dev *pdev = to_pci_dev(ap->host->dev); int irq_mask = ap->port_no ? ARTTIM23_INTR_CH1 : CFR_INTR_CH0; int irq_reg = ap->port_no ? ARTTIM23 : CFR; u8 irq_stat; /* NOTE: reading the register should clear the interrupt */ pci_read_config_byte(pdev, irq_reg, &irq_stat); return irq_stat & irq_mask; } /** |
419fd2461 pata_cmd64x: impl... |
252 253 |
* cmd64x_sff_irq_clear - clear IDE interrupt * @ap: ATA interface |
8a686bc98 pata_cmd64x: use ... |
254 |
* |
419fd2461 pata_cmd64x: impl... |
255 |
* Clear IDE interrupt in CFR/ARTTIM23 and DMA status registers. |
8a686bc98 pata_cmd64x: use ... |
256 |
*/ |
419fd2461 pata_cmd64x: impl... |
257 |
static void cmd64x_sff_irq_clear(struct ata_port *ap) |
8a686bc98 pata_cmd64x: use ... |
258 |
{ |
8a686bc98 pata_cmd64x: use ... |
259 260 261 |
struct pci_dev *pdev = to_pci_dev(ap->host->dev); int irq_reg = ap->port_no ? ARTTIM23 : CFR; u8 irq_stat; |
419fd2461 pata_cmd64x: impl... |
262 |
ata_bmdma_irq_clear(ap); |
8a686bc98 pata_cmd64x: use ... |
263 264 265 266 267 268 |
/* Reading the register should be enough to clear the interrupt */ pci_read_config_byte(pdev, irq_reg, &irq_stat); } /** |
b8cec3c25 pata_cmd64x: impl... |
269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 |
* cmd648_sff_irq_check - check IDE interrupt * @ap: ATA interface * * Check IDE interrupt in MRDMODE register. */ static bool cmd648_sff_irq_check(struct ata_port *ap) { struct pci_dev *pdev = to_pci_dev(ap->host->dev); unsigned long base = pci_resource_start(pdev, 4); int irq_mask = ap->port_no ? MRDMODE_INTR_CH1 : MRDMODE_INTR_CH0; u8 mrdmode = inb(base + 1); return mrdmode & irq_mask; } /** |
419fd2461 pata_cmd64x: impl... |
286 287 |
* cmd648_sff_irq_clear - clear IDE interrupt * @ap: ATA interface |
669a5db41 [libata] Add a bu... |
288 |
* |
419fd2461 pata_cmd64x: impl... |
289 |
* Clear IDE interrupt in MRDMODE and DMA status registers. |
669a5db41 [libata] Add a bu... |
290 |
*/ |
419fd2461 pata_cmd64x: impl... |
291 |
static void cmd648_sff_irq_clear(struct ata_port *ap) |
669a5db41 [libata] Add a bu... |
292 |
{ |
669a5db41 [libata] Add a bu... |
293 |
struct pci_dev *pdev = to_pci_dev(ap->host->dev); |
8a686bc98 pata_cmd64x: use ... |
294 295 296 |
unsigned long base = pci_resource_start(pdev, 4); int irq_mask = ap->port_no ? MRDMODE_INTR_CH1 : MRDMODE_INTR_CH0; u8 mrdmode; |
85cd7251b [libata #pata-dri... |
297 |
|
419fd2461 pata_cmd64x: impl... |
298 |
ata_bmdma_irq_clear(ap); |
85cd7251b [libata #pata-dri... |
299 |
|
8a686bc98 pata_cmd64x: use ... |
300 301 302 303 |
/* Clear this port's interrupt bit (leaving the other port alone) */ mrdmode = inb(base + 1); mrdmode &= ~(MRDMODE_INTR_CH0 | MRDMODE_INTR_CH1); outb(mrdmode | irq_mask, base + 1); |
669a5db41 [libata] Add a bu... |
304 |
} |
85cd7251b [libata #pata-dri... |
305 |
|
669a5db41 [libata] Add a bu... |
306 |
/** |
8a686bc98 pata_cmd64x: use ... |
307 |
* cmd646r1_bmdma_stop - DMA stop callback |
669a5db41 [libata] Add a bu... |
308 309 |
* @qc: Command in progress * |
06393afde Revert "pata_cmd6... |
310 |
* Stub for now while investigating the r1 quirk in the old driver. |
669a5db41 [libata] Add a bu... |
311 |
*/ |
06393afde Revert "pata_cmd6... |
312 |
static void cmd646r1_bmdma_stop(struct ata_queued_cmd *qc) |
669a5db41 [libata] Add a bu... |
313 314 315 |
{ ata_bmdma_stop(qc); } |
85cd7251b [libata #pata-dri... |
316 |
|
669a5db41 [libata] Add a bu... |
317 |
static struct scsi_host_template cmd64x_sht = { |
68d1d07b5 libata: implement... |
318 |
ATA_BMDMA_SHT(DRV_NAME), |
669a5db41 [libata] Add a bu... |
319 |
}; |
029cfd6b7 libata: implement... |
320 321 |
static const struct ata_port_operations cmd64x_base_ops = { .inherits = &ata_bmdma_port_ops, |
669a5db41 [libata] Add a bu... |
322 323 |
.set_piomode = cmd64x_set_piomode, .set_dmamode = cmd64x_set_dmamode, |
85cd7251b [libata #pata-dri... |
324 |
}; |
669a5db41 [libata] Add a bu... |
325 |
|
029cfd6b7 libata: implement... |
326 327 |
static struct ata_port_operations cmd64x_port_ops = { .inherits = &cmd64x_base_ops, |
b8cec3c25 pata_cmd64x: impl... |
328 |
.sff_irq_check = cmd64x_sff_irq_check, |
419fd2461 pata_cmd64x: impl... |
329 |
.sff_irq_clear = cmd64x_sff_irq_clear, |
a73984a0d [libata] More PAT... |
330 |
.cable_detect = ata_cable_40wire, |
029cfd6b7 libata: implement... |
331 |
}; |
669a5db41 [libata] Add a bu... |
332 |
|
029cfd6b7 libata: implement... |
333 334 |
static struct ata_port_operations cmd646r1_port_ops = { .inherits = &cmd64x_base_ops, |
b8cec3c25 pata_cmd64x: impl... |
335 |
.sff_irq_check = cmd64x_sff_irq_check, |
419fd2461 pata_cmd64x: impl... |
336 |
.sff_irq_clear = cmd64x_sff_irq_clear, |
06393afde Revert "pata_cmd6... |
337 |
.bmdma_stop = cmd646r1_bmdma_stop, |
029cfd6b7 libata: implement... |
338 |
.cable_detect = ata_cable_40wire, |
85cd7251b [libata #pata-dri... |
339 |
}; |
669a5db41 [libata] Add a bu... |
340 |
|
8a686bc98 pata_cmd64x: use ... |
341 342 |
static struct ata_port_operations cmd646r3_port_ops = { .inherits = &cmd64x_base_ops, |
b8cec3c25 pata_cmd64x: impl... |
343 |
.sff_irq_check = cmd648_sff_irq_check, |
419fd2461 pata_cmd64x: impl... |
344 |
.sff_irq_clear = cmd648_sff_irq_clear, |
8a686bc98 pata_cmd64x: use ... |
345 346 |
.cable_detect = ata_cable_40wire, }; |
669a5db41 [libata] Add a bu... |
347 |
static struct ata_port_operations cmd648_port_ops = { |
029cfd6b7 libata: implement... |
348 |
.inherits = &cmd64x_base_ops, |
b8cec3c25 pata_cmd64x: impl... |
349 |
.sff_irq_check = cmd648_sff_irq_check, |
419fd2461 pata_cmd64x: impl... |
350 |
.sff_irq_clear = cmd648_sff_irq_clear, |
029cfd6b7 libata: implement... |
351 |
.cable_detect = cmd648_cable_detect, |
85cd7251b [libata #pata-dri... |
352 |
}; |
f4c6ae502 pata_cmd64x: add ... |
353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 |
static void cmd64x_fixup(struct pci_dev *pdev) { u8 mrdmode; pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 64); pci_read_config_byte(pdev, MRDMODE, &mrdmode); mrdmode &= ~0x30; /* IRQ set up */ mrdmode |= 0x02; /* Memory read line enable */ pci_write_config_byte(pdev, MRDMODE, mrdmode); /* PPC specific fixup copied from old driver */ #ifdef CONFIG_PPC pci_write_config_byte(pdev, UDIDETCR0, 0xF0); #endif } |
669a5db41 [libata] Add a bu... |
368 369 |
static int cmd64x_init_one(struct pci_dev *pdev, const struct pci_device_id *id) { |
8a686bc98 pata_cmd64x: use ... |
370 |
static const struct ata_port_info cmd_info[7] = { |
669a5db41 [libata] Add a bu... |
371 |
{ /* CMD 643 - no UDMA */ |
1d2808fd3 [libata] PATA dri... |
372 |
.flags = ATA_FLAG_SLAVE_POSS, |
14bdef982 [libata] convert ... |
373 374 |
.pio_mask = ATA_PIO4, .mwdma_mask = ATA_MWDMA2, |
669a5db41 [libata] Add a bu... |
375 376 377 |
.port_ops = &cmd64x_port_ops }, { /* CMD 646 with broken UDMA */ |
1d2808fd3 [libata] PATA dri... |
378 |
.flags = ATA_FLAG_SLAVE_POSS, |
14bdef982 [libata] convert ... |
379 380 |
.pio_mask = ATA_PIO4, .mwdma_mask = ATA_MWDMA2, |
669a5db41 [libata] Add a bu... |
381 382 |
.port_ops = &cmd64x_port_ops }, |
8a686bc98 pata_cmd64x: use ... |
383 384 385 386 387 388 389 |
{ /* CMD 646U with broken UDMA */ .flags = ATA_FLAG_SLAVE_POSS, .pio_mask = ATA_PIO4, .mwdma_mask = ATA_MWDMA2, .port_ops = &cmd646r3_port_ops }, { /* CMD 646U2 with working UDMA */ |
1d2808fd3 [libata] PATA dri... |
390 |
.flags = ATA_FLAG_SLAVE_POSS, |
14bdef982 [libata] convert ... |
391 392 |
.pio_mask = ATA_PIO4, .mwdma_mask = ATA_MWDMA2, |
dbf0c89c8 pata_cmd64x: Corr... |
393 |
.udma_mask = ATA_UDMA2, |
8a686bc98 pata_cmd64x: use ... |
394 |
.port_ops = &cmd646r3_port_ops |
669a5db41 [libata] Add a bu... |
395 396 |
}, { /* CMD 646 rev 1 */ |
1d2808fd3 [libata] PATA dri... |
397 |
.flags = ATA_FLAG_SLAVE_POSS, |
14bdef982 [libata] convert ... |
398 399 |
.pio_mask = ATA_PIO4, .mwdma_mask = ATA_MWDMA2, |
669a5db41 [libata] Add a bu... |
400 401 402 |
.port_ops = &cmd646r1_port_ops }, { /* CMD 648 */ |
1d2808fd3 [libata] PATA dri... |
403 |
.flags = ATA_FLAG_SLAVE_POSS, |
14bdef982 [libata] convert ... |
404 405 |
.pio_mask = ATA_PIO4, .mwdma_mask = ATA_MWDMA2, |
dbf0c89c8 pata_cmd64x: Corr... |
406 |
.udma_mask = ATA_UDMA4, |
669a5db41 [libata] Add a bu... |
407 408 409 |
.port_ops = &cmd648_port_ops }, { /* CMD 649 */ |
1d2808fd3 [libata] PATA dri... |
410 |
.flags = ATA_FLAG_SLAVE_POSS, |
14bdef982 [libata] convert ... |
411 412 |
.pio_mask = ATA_PIO4, .mwdma_mask = ATA_MWDMA2, |
dbf0c89c8 pata_cmd64x: Corr... |
413 |
.udma_mask = ATA_UDMA5, |
669a5db41 [libata] Add a bu... |
414 415 416 |
.port_ops = &cmd648_port_ops } }; |
641589bff [libata] pata_cmd... |
417 |
const struct ata_port_info *ppi[] = { |
9281b16ca pata_cm64x: fix b... |
418 419 420 421 |
&cmd_info[id->driver_data], &cmd_info[id->driver_data], NULL }; |
f4c6ae502 pata_cmd64x: add ... |
422 |
u8 reg; |
f08048e94 libata: PCI devic... |
423 |
int rc; |
9281b16ca pata_cm64x: fix b... |
424 425 426 427 428 429 |
struct pci_dev *bridge = pdev->bus->self; /* mobility split bridges don't report enabled ports correctly */ int port_ok = !(bridge && bridge->vendor == PCI_VENDOR_ID_MOBILITY_ELECTRONICS); /* all (with exceptions below) apart from 643 have CNTRL_CH0 bit */ int cntrl_ch0_ok = (id->driver_data != 0); |
f08048e94 libata: PCI devic... |
430 431 432 433 |
rc = pcim_enable_device(pdev); if (rc) return rc; |
85cd7251b [libata #pata-dri... |
434 |
|
669a5db41 [libata] Add a bu... |
435 |
if (id->driver_data == 0) /* 643 */ |
9363c3825 libata: rename SF... |
436 |
ata_pci_bmdma_clear_simplex(pdev); |
85cd7251b [libata #pata-dri... |
437 |
|
8fcfa7bd1 pata_cmd64x: turn... |
438 439 440 441 |
if (pdev->device == PCI_DEVICE_ID_CMD_646) switch (pdev->revision) { /* UDMA works since rev 5 */ default: |
8a686bc98 pata_cmd64x: use ... |
442 443 |
ppi[0] = &cmd_info[3]; ppi[1] = &cmd_info[3]; |
8fcfa7bd1 pata_cmd64x: turn... |
444 |
break; |
8a686bc98 pata_cmd64x: use ... |
445 |
/* Interrupts in MRDMODE since rev 3 */ |
8fcfa7bd1 pata_cmd64x: turn... |
446 447 |
case 3: case 4: |
8a686bc98 pata_cmd64x: use ... |
448 449 |
ppi[0] = &cmd_info[2]; ppi[1] = &cmd_info[2]; |
8fcfa7bd1 pata_cmd64x: turn... |
450 451 452 |
break; /* Rev 1 with other problems? */ case 1: |
8a686bc98 pata_cmd64x: use ... |
453 454 |
ppi[0] = &cmd_info[4]; ppi[1] = &cmd_info[4]; |
8fcfa7bd1 pata_cmd64x: turn... |
455 456 457 458 |
/* FALL THRU */ /* Early revs have no CNTRL_CH0 */ case 2: case 0: |
9281b16ca pata_cm64x: fix b... |
459 |
cntrl_ch0_ok = 0; |
8fcfa7bd1 pata_cmd64x: turn... |
460 461 |
break; } |
669a5db41 [libata] Add a bu... |
462 |
|
f4c6ae502 pata_cmd64x: add ... |
463 |
cmd64x_fixup(pdev); |
85cd7251b [libata #pata-dri... |
464 |
|
9281b16ca pata_cm64x: fix b... |
465 466 467 |
/* check for enabled ports */ pci_read_config_byte(pdev, CNTRL, ®); if (!port_ok) |
a52f514c9 ata: Convert dev_... |
468 469 |
dev_notice(&pdev->dev, "Mobility Bridge detected, ignoring CNTRL port enable/disable "); |
9281b16ca pata_cm64x: fix b... |
470 |
if (port_ok && cntrl_ch0_ok && !(reg & CNTRL_CH0)) { |
a52f514c9 ata: Convert dev_... |
471 472 |
dev_notice(&pdev->dev, "Primary port is disabled "); |
9281b16ca pata_cm64x: fix b... |
473 |
ppi[0] = &ata_dummy_port_info; |
641589bff [libata] pata_cmd... |
474 |
|
9281b16ca pata_cm64x: fix b... |
475 476 |
} if (port_ok && !(reg & CNTRL_CH1)) { |
a52f514c9 ata: Convert dev_... |
477 478 |
dev_notice(&pdev->dev, "Secondary port is disabled "); |
9281b16ca pata_cm64x: fix b... |
479 480 |
ppi[1] = &ata_dummy_port_info; } |
1c5afdf7a libata-sff: separ... |
481 |
return ata_pci_bmdma_init_one(pdev, ppi, &cmd64x_sht, NULL, 0); |
669a5db41 [libata] Add a bu... |
482 |
} |
58eb8cd56 ata: use CONFIG_P... |
483 |
#ifdef CONFIG_PM_SLEEP |
7f72a3791 [PATCH] pata_cmd6... |
484 485 |
static int cmd64x_reinit_one(struct pci_dev *pdev) { |
0a86e1c85 ata: use pci_get_... |
486 |
struct ata_host *host = pci_get_drvdata(pdev); |
f08048e94 libata: PCI devic... |
487 488 489 490 491 |
int rc; rc = ata_pci_device_do_resume(pdev); if (rc) return rc; |
f4c6ae502 pata_cmd64x: add ... |
492 |
cmd64x_fixup(pdev); |
f08048e94 libata: PCI devic... |
493 494 |
ata_host_resume(host); return 0; |
7f72a3791 [PATCH] pata_cmd6... |
495 |
} |
438ac6d5e libata: add missi... |
496 |
#endif |
7f72a3791 [PATCH] pata_cmd6... |
497 |
|
2d2744fc8 [libata] PCI ID t... |
498 499 500 |
static const struct pci_device_id cmd64x[] = { { PCI_VDEVICE(CMD, PCI_DEVICE_ID_CMD_643), 0 }, { PCI_VDEVICE(CMD, PCI_DEVICE_ID_CMD_646), 1 }, |
8a686bc98 pata_cmd64x: use ... |
501 502 |
{ PCI_VDEVICE(CMD, PCI_DEVICE_ID_CMD_648), 5 }, { PCI_VDEVICE(CMD, PCI_DEVICE_ID_CMD_649), 6 }, |
2d2744fc8 [libata] PCI ID t... |
503 504 |
{ }, |
669a5db41 [libata] Add a bu... |
505 506 507 |
}; static struct pci_driver cmd64x_pci_driver = { |
2d2744fc8 [libata] PCI ID t... |
508 |
.name = DRV_NAME, |
669a5db41 [libata] Add a bu... |
509 510 |
.id_table = cmd64x, .probe = cmd64x_init_one, |
7f72a3791 [PATCH] pata_cmd6... |
511 |
.remove = ata_pci_remove_one, |
58eb8cd56 ata: use CONFIG_P... |
512 |
#ifdef CONFIG_PM_SLEEP |
7f72a3791 [PATCH] pata_cmd6... |
513 514 |
.suspend = ata_pci_device_suspend, .resume = cmd64x_reinit_one, |
438ac6d5e libata: add missi... |
515 |
#endif |
669a5db41 [libata] Add a bu... |
516 |
}; |
2fc75da0c ata: use module_p... |
517 |
module_pci_driver(cmd64x_pci_driver); |
669a5db41 [libata] Add a bu... |
518 |
|
669a5db41 [libata] Add a bu... |
519 520 521 522 523 |
MODULE_AUTHOR("Alan Cox"); MODULE_DESCRIPTION("low-level driver for CMD64x series PATA controllers"); MODULE_LICENSE("GPL"); MODULE_DEVICE_TABLE(pci, cmd64x); MODULE_VERSION(DRV_VERSION); |