]>
Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
af36d7f0 JG |
2 | * ata_piix.c - Intel PATA/SATA controllers |
3 | * | |
4 | * Maintained by: Jeff Garzik <[email protected]> | |
5 | * Please ALWAYS copy [email protected] | |
6 | * on emails. | |
7 | * | |
8 | * | |
9 | * Copyright 2003-2005 Red Hat Inc | |
10 | * Copyright 2003-2005 Jeff Garzik | |
11 | * | |
12 | * | |
13 | * Copyright header from piix.c: | |
14 | * | |
15 | * Copyright (C) 1998-1999 Andrzej Krzysztofowicz, Author and Maintainer | |
16 | * Copyright (C) 1998-2000 Andre Hedrick <[email protected]> | |
17 | * Copyright (C) 2003 Red Hat Inc <[email protected]> | |
18 | * | |
19 | * | |
20 | * This program is free software; you can redistribute it and/or modify | |
21 | * it under the terms of the GNU General Public License as published by | |
22 | * the Free Software Foundation; either version 2, or (at your option) | |
23 | * any later version. | |
24 | * | |
25 | * This program is distributed in the hope that it will be useful, | |
26 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
27 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
28 | * GNU General Public License for more details. | |
29 | * | |
30 | * You should have received a copy of the GNU General Public License | |
31 | * along with this program; see the file COPYING. If not, write to | |
32 | * the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA. | |
33 | * | |
34 | * | |
35 | * libata documentation is available via 'make {ps|pdf}docs', | |
36 | * as Documentation/DocBook/libata.* | |
37 | * | |
38 | * Hardware documentation available at http://developer.intel.com/ | |
39 | * | |
1da177e4 LT |
40 | */ |
41 | ||
42 | #include <linux/kernel.h> | |
43 | #include <linux/module.h> | |
44 | #include <linux/pci.h> | |
45 | #include <linux/init.h> | |
46 | #include <linux/blkdev.h> | |
47 | #include <linux/delay.h> | |
48 | #include "scsi.h" | |
49 | #include <scsi/scsi_host.h> | |
50 | #include <linux/libata.h> | |
51 | ||
52 | #define DRV_NAME "ata_piix" | |
6885433c | 53 | #define DRV_VERSION "1.04" |
1da177e4 LT |
54 | |
55 | enum { | |
56 | PIIX_IOCFG = 0x54, /* IDE I/O configuration register */ | |
57 | ICH5_PMR = 0x90, /* port mapping register */ | |
58 | ICH5_PCS = 0x92, /* port control and status */ | |
7b6dbd68 | 59 | PIIX_SCC = 0x0A, /* sub-class code register */ |
1da177e4 LT |
60 | |
61 | PIIX_FLAG_AHCI = (1 << 28), /* AHCI possible */ | |
62 | PIIX_FLAG_CHECKINTR = (1 << 29), /* make sure PCI INTx enabled */ | |
63 | PIIX_FLAG_COMBINED = (1 << 30), /* combined mode possible */ | |
64 | ||
65 | /* combined mode. if set, PATA is channel 0. | |
66 | * if clear, PATA is channel 1. | |
67 | */ | |
68 | PIIX_COMB_PATA_P0 = (1 << 1), | |
69 | PIIX_COMB = (1 << 2), /* combined mode enabled? */ | |
70 | ||
71 | PIIX_PORT_PRESENT = (1 << 0), | |
72 | PIIX_PORT_ENABLED = (1 << 4), | |
73 | ||
74 | PIIX_80C_PRI = (1 << 5) | (1 << 4), | |
75 | PIIX_80C_SEC = (1 << 7) | (1 << 6), | |
76 | ||
77 | ich5_pata = 0, | |
78 | ich5_sata = 1, | |
79 | piix4_pata = 2, | |
80 | ich6_sata = 3, | |
81 | ich6_sata_rm = 4, | |
82 | ich7_sata = 5, | |
c368ca4e | 83 | esb2_sata = 6, |
7b6dbd68 GF |
84 | |
85 | PIIX_AHCI_DEVICE = 6, | |
1da177e4 LT |
86 | }; |
87 | ||
88 | static int piix_init_one (struct pci_dev *pdev, | |
89 | const struct pci_device_id *ent); | |
90 | ||
91 | static void piix_pata_phy_reset(struct ata_port *ap); | |
92 | static void piix_sata_phy_reset(struct ata_port *ap); | |
93 | static void piix_set_piomode (struct ata_port *ap, struct ata_device *adev); | |
94 | static void piix_set_dmamode (struct ata_port *ap, struct ata_device *adev); | |
95 | ||
96 | static unsigned int in_module_init = 1; | |
97 | ||
98 | static struct pci_device_id piix_pci_tbl[] = { | |
99 | #ifdef ATA_ENABLE_PATA | |
100 | { 0x8086, 0x7111, PCI_ANY_ID, PCI_ANY_ID, 0, 0, piix4_pata }, | |
101 | { 0x8086, 0x24db, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_pata }, | |
102 | { 0x8086, 0x25a2, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_pata }, | |
103 | #endif | |
104 | ||
105 | /* NOTE: The following PCI ids must be kept in sync with the | |
106 | * list in drivers/pci/quirks.c. | |
107 | */ | |
108 | ||
109 | { 0x8086, 0x24d1, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata }, | |
110 | { 0x8086, 0x24df, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata }, | |
111 | { 0x8086, 0x25a3, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata }, | |
112 | { 0x8086, 0x25b0, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich5_sata }, | |
113 | { 0x8086, 0x2651, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata }, | |
114 | { 0x8086, 0x2652, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata_rm }, | |
115 | { 0x8086, 0x2653, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich6_sata_rm }, | |
116 | { 0x8086, 0x27c0, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich7_sata }, | |
117 | { 0x8086, 0x27c4, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ich7_sata }, | |
c368ca4e | 118 | { 0x8086, 0x2680, PCI_ANY_ID, PCI_ANY_ID, 0, 0, esb2_sata }, |
1da177e4 LT |
119 | |
120 | { } /* terminate list */ | |
121 | }; | |
122 | ||
123 | static struct pci_driver piix_pci_driver = { | |
124 | .name = DRV_NAME, | |
125 | .id_table = piix_pci_tbl, | |
126 | .probe = piix_init_one, | |
127 | .remove = ata_pci_remove_one, | |
128 | }; | |
129 | ||
130 | static Scsi_Host_Template piix_sht = { | |
131 | .module = THIS_MODULE, | |
132 | .name = DRV_NAME, | |
133 | .ioctl = ata_scsi_ioctl, | |
134 | .queuecommand = ata_scsi_queuecmd, | |
135 | .eh_strategy_handler = ata_scsi_error, | |
136 | .can_queue = ATA_DEF_QUEUE, | |
137 | .this_id = ATA_SHT_THIS_ID, | |
138 | .sg_tablesize = LIBATA_MAX_PRD, | |
139 | .max_sectors = ATA_MAX_SECTORS, | |
140 | .cmd_per_lun = ATA_SHT_CMD_PER_LUN, | |
141 | .emulated = ATA_SHT_EMULATED, | |
142 | .use_clustering = ATA_SHT_USE_CLUSTERING, | |
143 | .proc_name = DRV_NAME, | |
144 | .dma_boundary = ATA_DMA_BOUNDARY, | |
145 | .slave_configure = ata_scsi_slave_config, | |
146 | .bios_param = ata_std_bios_param, | |
147 | .ordered_flush = 1, | |
148 | }; | |
149 | ||
150 | static struct ata_port_operations piix_pata_ops = { | |
151 | .port_disable = ata_port_disable, | |
152 | .set_piomode = piix_set_piomode, | |
153 | .set_dmamode = piix_set_dmamode, | |
154 | ||
155 | .tf_load = ata_tf_load, | |
156 | .tf_read = ata_tf_read, | |
157 | .check_status = ata_check_status, | |
158 | .exec_command = ata_exec_command, | |
159 | .dev_select = ata_std_dev_select, | |
160 | ||
161 | .phy_reset = piix_pata_phy_reset, | |
162 | ||
163 | .bmdma_setup = ata_bmdma_setup, | |
164 | .bmdma_start = ata_bmdma_start, | |
165 | .bmdma_stop = ata_bmdma_stop, | |
166 | .bmdma_status = ata_bmdma_status, | |
167 | .qc_prep = ata_qc_prep, | |
168 | .qc_issue = ata_qc_issue_prot, | |
169 | ||
170 | .eng_timeout = ata_eng_timeout, | |
171 | ||
172 | .irq_handler = ata_interrupt, | |
173 | .irq_clear = ata_bmdma_irq_clear, | |
174 | ||
175 | .port_start = ata_port_start, | |
176 | .port_stop = ata_port_stop, | |
aa8f0dc6 | 177 | .host_stop = ata_host_stop, |
1da177e4 LT |
178 | }; |
179 | ||
180 | static struct ata_port_operations piix_sata_ops = { | |
181 | .port_disable = ata_port_disable, | |
182 | ||
183 | .tf_load = ata_tf_load, | |
184 | .tf_read = ata_tf_read, | |
185 | .check_status = ata_check_status, | |
186 | .exec_command = ata_exec_command, | |
187 | .dev_select = ata_std_dev_select, | |
188 | ||
189 | .phy_reset = piix_sata_phy_reset, | |
190 | ||
191 | .bmdma_setup = ata_bmdma_setup, | |
192 | .bmdma_start = ata_bmdma_start, | |
193 | .bmdma_stop = ata_bmdma_stop, | |
194 | .bmdma_status = ata_bmdma_status, | |
195 | .qc_prep = ata_qc_prep, | |
196 | .qc_issue = ata_qc_issue_prot, | |
197 | ||
198 | .eng_timeout = ata_eng_timeout, | |
199 | ||
200 | .irq_handler = ata_interrupt, | |
201 | .irq_clear = ata_bmdma_irq_clear, | |
202 | ||
203 | .port_start = ata_port_start, | |
204 | .port_stop = ata_port_stop, | |
aa8f0dc6 | 205 | .host_stop = ata_host_stop, |
1da177e4 LT |
206 | }; |
207 | ||
208 | static struct ata_port_info piix_port_info[] = { | |
209 | /* ich5_pata */ | |
210 | { | |
211 | .sht = &piix_sht, | |
212 | .host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST | | |
213 | PIIX_FLAG_CHECKINTR, | |
214 | .pio_mask = 0x1f, /* pio0-4 */ | |
215 | #if 0 | |
216 | .mwdma_mask = 0x06, /* mwdma1-2 */ | |
217 | #else | |
218 | .mwdma_mask = 0x00, /* mwdma broken */ | |
219 | #endif | |
220 | .udma_mask = 0x3f, /* udma0-5 */ | |
221 | .port_ops = &piix_pata_ops, | |
222 | }, | |
223 | ||
224 | /* ich5_sata */ | |
225 | { | |
226 | .sht = &piix_sht, | |
227 | .host_flags = ATA_FLAG_SATA | ATA_FLAG_SRST | | |
228 | PIIX_FLAG_COMBINED | PIIX_FLAG_CHECKINTR, | |
229 | .pio_mask = 0x1f, /* pio0-4 */ | |
230 | .mwdma_mask = 0x07, /* mwdma0-2 */ | |
231 | .udma_mask = 0x7f, /* udma0-6 */ | |
232 | .port_ops = &piix_sata_ops, | |
233 | }, | |
234 | ||
235 | /* piix4_pata */ | |
236 | { | |
237 | .sht = &piix_sht, | |
238 | .host_flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST, | |
239 | .pio_mask = 0x1f, /* pio0-4 */ | |
240 | #if 0 | |
241 | .mwdma_mask = 0x06, /* mwdma1-2 */ | |
242 | #else | |
243 | .mwdma_mask = 0x00, /* mwdma broken */ | |
244 | #endif | |
245 | .udma_mask = ATA_UDMA_MASK_40C, | |
246 | .port_ops = &piix_pata_ops, | |
247 | }, | |
248 | ||
249 | /* ich6_sata */ | |
250 | { | |
251 | .sht = &piix_sht, | |
252 | .host_flags = ATA_FLAG_SATA | ATA_FLAG_SRST | | |
253 | PIIX_FLAG_COMBINED | PIIX_FLAG_CHECKINTR | | |
254 | ATA_FLAG_SLAVE_POSS, | |
255 | .pio_mask = 0x1f, /* pio0-4 */ | |
256 | .mwdma_mask = 0x07, /* mwdma0-2 */ | |
257 | .udma_mask = 0x7f, /* udma0-6 */ | |
258 | .port_ops = &piix_sata_ops, | |
259 | }, | |
260 | ||
261 | /* ich6_sata_rm */ | |
262 | { | |
263 | .sht = &piix_sht, | |
264 | .host_flags = ATA_FLAG_SATA | ATA_FLAG_SRST | | |
265 | PIIX_FLAG_COMBINED | PIIX_FLAG_CHECKINTR | | |
266 | ATA_FLAG_SLAVE_POSS | PIIX_FLAG_AHCI, | |
267 | .pio_mask = 0x1f, /* pio0-4 */ | |
268 | .mwdma_mask = 0x07, /* mwdma0-2 */ | |
269 | .udma_mask = 0x7f, /* udma0-6 */ | |
270 | .port_ops = &piix_sata_ops, | |
271 | }, | |
272 | ||
273 | /* ich7_sata */ | |
274 | { | |
275 | .sht = &piix_sht, | |
276 | .host_flags = ATA_FLAG_SATA | ATA_FLAG_SRST | | |
277 | PIIX_FLAG_COMBINED | PIIX_FLAG_CHECKINTR | | |
278 | ATA_FLAG_SLAVE_POSS | PIIX_FLAG_AHCI, | |
279 | .pio_mask = 0x1f, /* pio0-4 */ | |
280 | .mwdma_mask = 0x07, /* mwdma0-2 */ | |
281 | .udma_mask = 0x7f, /* udma0-6 */ | |
282 | .port_ops = &piix_sata_ops, | |
283 | }, | |
c368ca4e JG |
284 | |
285 | /* esb2_sata */ | |
286 | { | |
287 | .sht = &piix_sht, | |
288 | .host_flags = ATA_FLAG_SATA | ATA_FLAG_SRST | | |
289 | PIIX_FLAG_COMBINED | PIIX_FLAG_CHECKINTR | | |
290 | ATA_FLAG_SLAVE_POSS | PIIX_FLAG_AHCI, | |
291 | .pio_mask = 0x1f, /* pio0-4 */ | |
292 | .mwdma_mask = 0x07, /* mwdma0-2 */ | |
293 | .udma_mask = 0x7f, /* udma0-6 */ | |
294 | .port_ops = &piix_sata_ops, | |
295 | }, | |
1da177e4 LT |
296 | }; |
297 | ||
298 | static struct pci_bits piix_enable_bits[] = { | |
299 | { 0x41U, 1U, 0x80UL, 0x80UL }, /* port 0 */ | |
300 | { 0x43U, 1U, 0x80UL, 0x80UL }, /* port 1 */ | |
301 | }; | |
302 | ||
303 | MODULE_AUTHOR("Andre Hedrick, Alan Cox, Andrzej Krzysztofowicz, Jeff Garzik"); | |
304 | MODULE_DESCRIPTION("SCSI low-level driver for Intel PIIX/ICH ATA controllers"); | |
305 | MODULE_LICENSE("GPL"); | |
306 | MODULE_DEVICE_TABLE(pci, piix_pci_tbl); | |
307 | MODULE_VERSION(DRV_VERSION); | |
308 | ||
309 | /** | |
310 | * piix_pata_cbl_detect - Probe host controller cable detect info | |
311 | * @ap: Port for which cable detect info is desired | |
312 | * | |
313 | * Read 80c cable indicator from ATA PCI device's PCI config | |
314 | * register. This register is normally set by firmware (BIOS). | |
315 | * | |
316 | * LOCKING: | |
317 | * None (inherited from caller). | |
318 | */ | |
319 | static void piix_pata_cbl_detect(struct ata_port *ap) | |
320 | { | |
321 | struct pci_dev *pdev = to_pci_dev(ap->host_set->dev); | |
322 | u8 tmp, mask; | |
323 | ||
324 | /* no 80c support in host controller? */ | |
325 | if ((ap->udma_mask & ~ATA_UDMA_MASK_40C) == 0) | |
326 | goto cbl40; | |
327 | ||
328 | /* check BIOS cable detect results */ | |
329 | mask = ap->hard_port_no == 0 ? PIIX_80C_PRI : PIIX_80C_SEC; | |
330 | pci_read_config_byte(pdev, PIIX_IOCFG, &tmp); | |
331 | if ((tmp & mask) == 0) | |
332 | goto cbl40; | |
333 | ||
334 | ap->cbl = ATA_CBL_PATA80; | |
335 | return; | |
336 | ||
337 | cbl40: | |
338 | ap->cbl = ATA_CBL_PATA40; | |
339 | ap->udma_mask &= ATA_UDMA_MASK_40C; | |
340 | } | |
341 | ||
342 | /** | |
343 | * piix_pata_phy_reset - Probe specified port on PATA host controller | |
344 | * @ap: Port to probe | |
345 | * | |
346 | * Probe PATA phy. | |
347 | * | |
348 | * LOCKING: | |
349 | * None (inherited from caller). | |
350 | */ | |
351 | ||
352 | static void piix_pata_phy_reset(struct ata_port *ap) | |
353 | { | |
354 | struct pci_dev *pdev = to_pci_dev(ap->host_set->dev); | |
355 | ||
356 | if (!pci_test_config_bits(pdev, &piix_enable_bits[ap->hard_port_no])) { | |
357 | ata_port_disable(ap); | |
358 | printk(KERN_INFO "ata%u: port disabled. ignoring.\n", ap->id); | |
359 | return; | |
360 | } | |
361 | ||
362 | piix_pata_cbl_detect(ap); | |
363 | ||
364 | ata_port_probe(ap); | |
365 | ||
366 | ata_bus_reset(ap); | |
367 | } | |
368 | ||
369 | /** | |
370 | * piix_sata_probe - Probe PCI device for present SATA devices | |
371 | * @ap: Port associated with the PCI device we wish to probe | |
372 | * | |
373 | * Reads SATA PCI device's PCI config register Port Configuration | |
374 | * and Status (PCS) to determine port and device availability. | |
375 | * | |
376 | * LOCKING: | |
377 | * None (inherited from caller). | |
378 | * | |
379 | * RETURNS: | |
380 | * Non-zero if device detected, zero otherwise. | |
381 | */ | |
382 | static int piix_sata_probe (struct ata_port *ap) | |
383 | { | |
384 | struct pci_dev *pdev = to_pci_dev(ap->host_set->dev); | |
385 | int combined = (ap->flags & ATA_FLAG_SLAVE_POSS); | |
386 | int orig_mask, mask, i; | |
387 | u8 pcs; | |
388 | ||
389 | mask = (PIIX_PORT_PRESENT << ap->hard_port_no) | | |
390 | (PIIX_PORT_ENABLED << ap->hard_port_no); | |
391 | ||
392 | pci_read_config_byte(pdev, ICH5_PCS, &pcs); | |
393 | orig_mask = (int) pcs & 0xff; | |
394 | ||
395 | /* TODO: this is vaguely wrong for ICH6 combined mode, | |
396 | * where only two of the four SATA ports are mapped | |
397 | * onto a single ATA channel. It is also vaguely inaccurate | |
398 | * for ICH5, which has only two ports. However, this is ok, | |
399 | * as further device presence detection code will handle | |
400 | * any false positives produced here. | |
401 | */ | |
402 | ||
403 | for (i = 0; i < 4; i++) { | |
404 | mask = (PIIX_PORT_PRESENT << i) | (PIIX_PORT_ENABLED << i); | |
405 | ||
406 | if ((orig_mask & mask) == mask) | |
407 | if (combined || (i == ap->hard_port_no)) | |
408 | return 1; | |
409 | } | |
410 | ||
411 | return 0; | |
412 | } | |
413 | ||
414 | /** | |
415 | * piix_sata_phy_reset - Probe specified port on SATA host controller | |
416 | * @ap: Port to probe | |
417 | * | |
418 | * Probe SATA phy. | |
419 | * | |
420 | * LOCKING: | |
421 | * None (inherited from caller). | |
422 | */ | |
423 | ||
424 | static void piix_sata_phy_reset(struct ata_port *ap) | |
425 | { | |
426 | if (!piix_sata_probe(ap)) { | |
427 | ata_port_disable(ap); | |
428 | printk(KERN_INFO "ata%u: SATA port has no device.\n", ap->id); | |
429 | return; | |
430 | } | |
431 | ||
432 | ap->cbl = ATA_CBL_SATA; | |
433 | ||
434 | ata_port_probe(ap); | |
435 | ||
436 | ata_bus_reset(ap); | |
437 | } | |
438 | ||
439 | /** | |
440 | * piix_set_piomode - Initialize host controller PATA PIO timings | |
441 | * @ap: Port whose timings we are configuring | |
442 | * @adev: um | |
443 | * @pio: PIO mode, 0 - 4 | |
444 | * | |
445 | * Set PIO mode for device, in host controller PCI config space. | |
446 | * | |
447 | * LOCKING: | |
448 | * None (inherited from caller). | |
449 | */ | |
450 | ||
451 | static void piix_set_piomode (struct ata_port *ap, struct ata_device *adev) | |
452 | { | |
453 | unsigned int pio = adev->pio_mode - XFER_PIO_0; | |
454 | struct pci_dev *dev = to_pci_dev(ap->host_set->dev); | |
455 | unsigned int is_slave = (adev->devno != 0); | |
456 | unsigned int master_port= ap->hard_port_no ? 0x42 : 0x40; | |
457 | unsigned int slave_port = 0x44; | |
458 | u16 master_data; | |
459 | u8 slave_data; | |
460 | ||
461 | static const /* ISP RTC */ | |
462 | u8 timings[][2] = { { 0, 0 }, | |
463 | { 0, 0 }, | |
464 | { 1, 0 }, | |
465 | { 2, 1 }, | |
466 | { 2, 3 }, }; | |
467 | ||
468 | pci_read_config_word(dev, master_port, &master_data); | |
469 | if (is_slave) { | |
470 | master_data |= 0x4000; | |
471 | /* enable PPE, IE and TIME */ | |
472 | master_data |= 0x0070; | |
473 | pci_read_config_byte(dev, slave_port, &slave_data); | |
474 | slave_data &= (ap->hard_port_no ? 0x0f : 0xf0); | |
475 | slave_data |= | |
476 | (timings[pio][0] << 2) | | |
477 | (timings[pio][1] << (ap->hard_port_no ? 4 : 0)); | |
478 | } else { | |
479 | master_data &= 0xccf8; | |
480 | /* enable PPE, IE and TIME */ | |
481 | master_data |= 0x0007; | |
482 | master_data |= | |
483 | (timings[pio][0] << 12) | | |
484 | (timings[pio][1] << 8); | |
485 | } | |
486 | pci_write_config_word(dev, master_port, master_data); | |
487 | if (is_slave) | |
488 | pci_write_config_byte(dev, slave_port, slave_data); | |
489 | } | |
490 | ||
491 | /** | |
492 | * piix_set_dmamode - Initialize host controller PATA PIO timings | |
493 | * @ap: Port whose timings we are configuring | |
494 | * @adev: um | |
495 | * @udma: udma mode, 0 - 6 | |
496 | * | |
497 | * Set UDMA mode for device, in host controller PCI config space. | |
498 | * | |
499 | * LOCKING: | |
500 | * None (inherited from caller). | |
501 | */ | |
502 | ||
503 | static void piix_set_dmamode (struct ata_port *ap, struct ata_device *adev) | |
504 | { | |
505 | unsigned int udma = adev->dma_mode; /* FIXME: MWDMA too */ | |
506 | struct pci_dev *dev = to_pci_dev(ap->host_set->dev); | |
507 | u8 maslave = ap->hard_port_no ? 0x42 : 0x40; | |
508 | u8 speed = udma; | |
509 | unsigned int drive_dn = (ap->hard_port_no ? 2 : 0) + adev->devno; | |
510 | int a_speed = 3 << (drive_dn * 4); | |
511 | int u_flag = 1 << drive_dn; | |
512 | int v_flag = 0x01 << drive_dn; | |
513 | int w_flag = 0x10 << drive_dn; | |
514 | int u_speed = 0; | |
515 | int sitre; | |
516 | u16 reg4042, reg4a; | |
517 | u8 reg48, reg54, reg55; | |
518 | ||
519 | pci_read_config_word(dev, maslave, ®4042); | |
520 | DPRINTK("reg4042 = 0x%04x\n", reg4042); | |
521 | sitre = (reg4042 & 0x4000) ? 1 : 0; | |
522 | pci_read_config_byte(dev, 0x48, ®48); | |
523 | pci_read_config_word(dev, 0x4a, ®4a); | |
524 | pci_read_config_byte(dev, 0x54, ®54); | |
525 | pci_read_config_byte(dev, 0x55, ®55); | |
526 | ||
527 | switch(speed) { | |
528 | case XFER_UDMA_4: | |
529 | case XFER_UDMA_2: u_speed = 2 << (drive_dn * 4); break; | |
530 | case XFER_UDMA_6: | |
531 | case XFER_UDMA_5: | |
532 | case XFER_UDMA_3: | |
533 | case XFER_UDMA_1: u_speed = 1 << (drive_dn * 4); break; | |
534 | case XFER_UDMA_0: u_speed = 0 << (drive_dn * 4); break; | |
535 | case XFER_MW_DMA_2: | |
536 | case XFER_MW_DMA_1: break; | |
537 | default: | |
538 | BUG(); | |
539 | return; | |
540 | } | |
541 | ||
542 | if (speed >= XFER_UDMA_0) { | |
543 | if (!(reg48 & u_flag)) | |
544 | pci_write_config_byte(dev, 0x48, reg48 | u_flag); | |
545 | if (speed == XFER_UDMA_5) { | |
546 | pci_write_config_byte(dev, 0x55, (u8) reg55|w_flag); | |
547 | } else { | |
548 | pci_write_config_byte(dev, 0x55, (u8) reg55 & ~w_flag); | |
549 | } | |
550 | if ((reg4a & a_speed) != u_speed) | |
551 | pci_write_config_word(dev, 0x4a, (reg4a & ~a_speed) | u_speed); | |
552 | if (speed > XFER_UDMA_2) { | |
553 | if (!(reg54 & v_flag)) | |
554 | pci_write_config_byte(dev, 0x54, reg54 | v_flag); | |
555 | } else | |
556 | pci_write_config_byte(dev, 0x54, reg54 & ~v_flag); | |
557 | } else { | |
558 | if (reg48 & u_flag) | |
559 | pci_write_config_byte(dev, 0x48, reg48 & ~u_flag); | |
560 | if (reg4a & a_speed) | |
561 | pci_write_config_word(dev, 0x4a, reg4a & ~a_speed); | |
562 | if (reg54 & v_flag) | |
563 | pci_write_config_byte(dev, 0x54, reg54 & ~v_flag); | |
564 | if (reg55 & w_flag) | |
565 | pci_write_config_byte(dev, 0x55, (u8) reg55 & ~w_flag); | |
566 | } | |
567 | } | |
568 | ||
569 | /* move to PCI layer, integrate w/ MSI stuff */ | |
570 | static void pci_enable_intx(struct pci_dev *pdev) | |
571 | { | |
572 | u16 pci_command; | |
573 | ||
574 | pci_read_config_word(pdev, PCI_COMMAND, &pci_command); | |
575 | if (pci_command & PCI_COMMAND_INTX_DISABLE) { | |
576 | pci_command &= ~PCI_COMMAND_INTX_DISABLE; | |
577 | pci_write_config_word(pdev, PCI_COMMAND, pci_command); | |
578 | } | |
579 | } | |
580 | ||
581 | #define AHCI_PCI_BAR 5 | |
582 | #define AHCI_GLOBAL_CTL 0x04 | |
583 | #define AHCI_ENABLE (1 << 31) | |
584 | static int piix_disable_ahci(struct pci_dev *pdev) | |
585 | { | |
586 | void *mmio; | |
587 | unsigned long addr; | |
588 | u32 tmp; | |
589 | int rc = 0; | |
590 | ||
591 | /* BUG: pci_enable_device has not yet been called. This | |
592 | * works because this device is usually set up by BIOS. | |
593 | */ | |
594 | ||
595 | addr = pci_resource_start(pdev, AHCI_PCI_BAR); | |
596 | if (!addr || !pci_resource_len(pdev, AHCI_PCI_BAR)) | |
597 | return 0; | |
7b6dbd68 | 598 | |
1da177e4 LT |
599 | mmio = ioremap(addr, 64); |
600 | if (!mmio) | |
601 | return -ENOMEM; | |
7b6dbd68 | 602 | |
1da177e4 LT |
603 | tmp = readl(mmio + AHCI_GLOBAL_CTL); |
604 | if (tmp & AHCI_ENABLE) { | |
605 | tmp &= ~AHCI_ENABLE; | |
606 | writel(tmp, mmio + AHCI_GLOBAL_CTL); | |
607 | ||
608 | tmp = readl(mmio + AHCI_GLOBAL_CTL); | |
609 | if (tmp & AHCI_ENABLE) | |
610 | rc = -EIO; | |
611 | } | |
7b6dbd68 | 612 | |
1da177e4 LT |
613 | iounmap(mmio); |
614 | return rc; | |
615 | } | |
616 | ||
617 | /** | |
618 | * piix_init_one - Register PIIX ATA PCI device with kernel services | |
619 | * @pdev: PCI device to register | |
620 | * @ent: Entry in piix_pci_tbl matching with @pdev | |
621 | * | |
622 | * Called from kernel PCI layer. We probe for combined mode (sigh), | |
623 | * and then hand over control to libata, for it to do the rest. | |
624 | * | |
625 | * LOCKING: | |
626 | * Inherited from PCI layer (may sleep). | |
627 | * | |
628 | * RETURNS: | |
629 | * Zero on success, or -ERRNO value. | |
630 | */ | |
631 | ||
632 | static int piix_init_one (struct pci_dev *pdev, const struct pci_device_id *ent) | |
633 | { | |
634 | static int printed_version; | |
635 | struct ata_port_info *port_info[2]; | |
636 | unsigned int combined = 0, n_ports = 1; | |
637 | unsigned int pata_chan = 0, sata_chan = 0; | |
638 | ||
639 | if (!printed_version++) | |
640 | printk(KERN_DEBUG DRV_NAME " version " DRV_VERSION "\n"); | |
641 | ||
642 | /* no hotplugging support (FIXME) */ | |
643 | if (!in_module_init) | |
644 | return -ENODEV; | |
645 | ||
646 | port_info[0] = &piix_port_info[ent->driver_data]; | |
647 | port_info[1] = NULL; | |
648 | ||
649 | if (port_info[0]->host_flags & PIIX_FLAG_AHCI) { | |
8a60a071 JG |
650 | u8 tmp; |
651 | pci_read_config_byte(pdev, PIIX_SCC, &tmp); | |
652 | if (tmp == PIIX_AHCI_DEVICE) { | |
653 | int rc = piix_disable_ahci(pdev); | |
654 | if (rc) | |
655 | return rc; | |
656 | } | |
1da177e4 LT |
657 | } |
658 | ||
659 | if (port_info[0]->host_flags & PIIX_FLAG_COMBINED) { | |
660 | u8 tmp; | |
661 | pci_read_config_byte(pdev, ICH5_PMR, &tmp); | |
662 | ||
663 | if (tmp & PIIX_COMB) { | |
664 | combined = 1; | |
665 | if (tmp & PIIX_COMB_PATA_P0) | |
666 | sata_chan = 1; | |
667 | else | |
668 | pata_chan = 1; | |
669 | } | |
670 | } | |
671 | ||
672 | /* On ICH5, some BIOSen disable the interrupt using the | |
673 | * PCI_COMMAND_INTX_DISABLE bit added in PCI 2.3. | |
674 | * On ICH6, this bit has the same effect, but only when | |
675 | * MSI is disabled (and it is disabled, as we don't use | |
676 | * message-signalled interrupts currently). | |
677 | */ | |
678 | if (port_info[0]->host_flags & PIIX_FLAG_CHECKINTR) | |
679 | pci_enable_intx(pdev); | |
680 | ||
681 | if (combined) { | |
682 | port_info[sata_chan] = &piix_port_info[ent->driver_data]; | |
683 | port_info[sata_chan]->host_flags |= ATA_FLAG_SLAVE_POSS; | |
684 | port_info[pata_chan] = &piix_port_info[ich5_pata]; | |
685 | n_ports++; | |
686 | ||
687 | printk(KERN_WARNING DRV_NAME ": combined mode detected\n"); | |
688 | } | |
689 | ||
690 | return ata_pci_init_one(pdev, port_info, n_ports); | |
691 | } | |
692 | ||
1da177e4 LT |
693 | static int __init piix_init(void) |
694 | { | |
695 | int rc; | |
696 | ||
697 | DPRINTK("pci_module_init\n"); | |
698 | rc = pci_module_init(&piix_pci_driver); | |
699 | if (rc) | |
700 | return rc; | |
701 | ||
702 | in_module_init = 0; | |
703 | ||
704 | DPRINTK("done\n"); | |
705 | return 0; | |
706 | } | |
707 | ||
1da177e4 LT |
708 | static void __exit piix_exit(void) |
709 | { | |
710 | pci_unregister_driver(&piix_pci_driver); | |
711 | } | |
712 | ||
713 | module_init(piix_init); | |
714 | module_exit(piix_exit); | |
715 |