]>
Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
1da177e4 LT |
2 | * VIA IDE driver for Linux. Supported southbridges: |
3 | * | |
4 | * vt82c576, vt82c586, vt82c586a, vt82c586b, vt82c596a, vt82c596b, | |
5 | * vt82c686, vt82c686a, vt82c686b, vt8231, vt8233, vt8233c, vt8233a, | |
a7dec1e0 | 6 | * vt8235, vt8237, vt8237a |
1da177e4 LT |
7 | * |
8 | * Copyright (c) 2000-2002 Vojtech Pavlik | |
75b1d975 | 9 | * Copyright (c) 2007 Bartlomiej Zolnierkiewicz |
1da177e4 LT |
10 | * |
11 | * Based on the work of: | |
12 | * Michel Aubry | |
13 | * Jeff Garzik | |
14 | * Andre Hedrick | |
15 | * | |
16 | * Documentation: | |
17 | * Obsolete device documentation publically available from via.com.tw | |
18 | * Current device documentation available under NDA only | |
19 | */ | |
20 | ||
21 | /* | |
22 | * This program is free software; you can redistribute it and/or modify it | |
23 | * under the terms of the GNU General Public License version 2 as published by | |
24 | * the Free Software Foundation. | |
25 | */ | |
26 | ||
1da177e4 LT |
27 | #include <linux/module.h> |
28 | #include <linux/kernel.h> | |
1da177e4 LT |
29 | #include <linux/pci.h> |
30 | #include <linux/init.h> | |
31 | #include <linux/ide.h> | |
bdab00b7 BZ |
32 | #include <linux/dmi.h> |
33 | ||
74a9d5f1 | 34 | #ifdef CONFIG_PPC_CHRP |
1da177e4 LT |
35 | #include <asm/processor.h> |
36 | #endif | |
37 | ||
ced3ec8a BZ |
38 | #define DRV_NAME "via82cxxx" |
39 | ||
1da177e4 LT |
40 | #define VIA_IDE_ENABLE 0x40 |
41 | #define VIA_IDE_CONFIG 0x41 | |
42 | #define VIA_FIFO_CONFIG 0x43 | |
43 | #define VIA_MISC_1 0x44 | |
44 | #define VIA_MISC_2 0x45 | |
45 | #define VIA_MISC_3 0x46 | |
46 | #define VIA_DRIVE_TIMING 0x48 | |
47 | #define VIA_8BIT_TIMING 0x4e | |
48 | #define VIA_ADDRESS_SETUP 0x4c | |
49 | #define VIA_UDMA_TIMING 0x50 | |
50 | ||
75b1d975 BZ |
51 | #define VIA_BAD_PREQ 0x01 /* Crashes if PREQ# till DDACK# set */ |
52 | #define VIA_BAD_CLK66 0x02 /* 66 MHz clock doesn't work correctly */ | |
53 | #define VIA_SET_FIFO 0x04 /* Needs to have FIFO split set */ | |
54 | #define VIA_NO_UNMASK 0x08 /* Doesn't work with IRQ unmasking on */ | |
55 | #define VIA_BAD_ID 0x10 /* Has wrong vendor ID (0x1107) */ | |
56 | #define VIA_BAD_AST 0x20 /* Don't touch Address Setup Timing */ | |
1da177e4 LT |
57 | |
58 | /* | |
59 | * VIA SouthBridge chips. | |
60 | */ | |
61 | ||
62 | static struct via_isa_bridge { | |
63 | char *name; | |
64 | u16 id; | |
65 | u8 rev_min; | |
66 | u8 rev_max; | |
75b1d975 BZ |
67 | u8 udma_mask; |
68 | u8 flags; | |
1da177e4 | 69 | } via_isa_bridges[] = { |
b311ec4a | 70 | { "vx800", PCI_DEVICE_ID_VIA_VX800, 0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST }, |
75b1d975 BZ |
71 | { "cx700", PCI_DEVICE_ID_VIA_CX700, 0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST }, |
72 | { "vt8237s", PCI_DEVICE_ID_VIA_8237S, 0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST }, | |
73 | { "vt6410", PCI_DEVICE_ID_VIA_6410, 0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST }, | |
74 | { "vt8251", PCI_DEVICE_ID_VIA_8251, 0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST }, | |
75 | { "vt8237", PCI_DEVICE_ID_VIA_8237, 0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST }, | |
76 | { "vt8237a", PCI_DEVICE_ID_VIA_8237A, 0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST }, | |
77 | { "vt8235", PCI_DEVICE_ID_VIA_8235, 0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST }, | |
78 | { "vt8233a", PCI_DEVICE_ID_VIA_8233A, 0x00, 0x2f, ATA_UDMA6, VIA_BAD_AST }, | |
79 | { "vt8233c", PCI_DEVICE_ID_VIA_8233C_0, 0x00, 0x2f, ATA_UDMA5, }, | |
80 | { "vt8233", PCI_DEVICE_ID_VIA_8233_0, 0x00, 0x2f, ATA_UDMA5, }, | |
81 | { "vt8231", PCI_DEVICE_ID_VIA_8231, 0x00, 0x2f, ATA_UDMA5, }, | |
82 | { "vt82c686b", PCI_DEVICE_ID_VIA_82C686, 0x40, 0x4f, ATA_UDMA5, }, | |
83 | { "vt82c686a", PCI_DEVICE_ID_VIA_82C686, 0x10, 0x2f, ATA_UDMA4, }, | |
84 | { "vt82c686", PCI_DEVICE_ID_VIA_82C686, 0x00, 0x0f, ATA_UDMA2, VIA_BAD_CLK66 }, | |
85 | { "vt82c596b", PCI_DEVICE_ID_VIA_82C596, 0x10, 0x2f, ATA_UDMA4, }, | |
86 | { "vt82c596a", PCI_DEVICE_ID_VIA_82C596, 0x00, 0x0f, ATA_UDMA2, VIA_BAD_CLK66 }, | |
87 | { "vt82c586b", PCI_DEVICE_ID_VIA_82C586_0, 0x47, 0x4f, ATA_UDMA2, VIA_SET_FIFO }, | |
88 | { "vt82c586b", PCI_DEVICE_ID_VIA_82C586_0, 0x40, 0x46, ATA_UDMA2, VIA_SET_FIFO | VIA_BAD_PREQ }, | |
89 | { "vt82c586b", PCI_DEVICE_ID_VIA_82C586_0, 0x30, 0x3f, ATA_UDMA2, VIA_SET_FIFO }, | |
90 | { "vt82c586a", PCI_DEVICE_ID_VIA_82C586_0, 0x20, 0x2f, ATA_UDMA2, VIA_SET_FIFO }, | |
91 | { "vt82c586", PCI_DEVICE_ID_VIA_82C586_0, 0x00, 0x0f, 0x00, VIA_SET_FIFO }, | |
92 | { "vt82c576", PCI_DEVICE_ID_VIA_82C576, 0x00, 0x2f, 0x00, VIA_SET_FIFO | VIA_NO_UNMASK }, | |
93 | { "vt82c576", PCI_DEVICE_ID_VIA_82C576, 0x00, 0x2f, 0x00, VIA_SET_FIFO | VIA_NO_UNMASK | VIA_BAD_ID }, | |
1da177e4 LT |
94 | { NULL } |
95 | }; | |
96 | ||
1da177e4 | 97 | static unsigned int via_clock; |
75b1d975 | 98 | static char *via_dma[] = { "16", "25", "33", "44", "66", "100", "133" }; |
1da177e4 | 99 | |
7462cbff DD |
100 | struct via82cxxx_dev |
101 | { | |
102 | struct via_isa_bridge *via_config; | |
103 | unsigned int via_80w; | |
104 | }; | |
105 | ||
1da177e4 LT |
106 | /** |
107 | * via_set_speed - write timing registers | |
108 | * @dev: PCI device | |
109 | * @dn: device | |
110 | * @timing: IDE timing data to use | |
111 | * | |
112 | * via_set_speed writes timing values to the chipset registers | |
113 | */ | |
114 | ||
7462cbff | 115 | static void via_set_speed(ide_hwif_t *hwif, u8 dn, struct ide_timing *timing) |
1da177e4 | 116 | { |
36501650 | 117 | struct pci_dev *dev = to_pci_dev(hwif->dev); |
ee77325b BZ |
118 | struct ide_host *host = pci_get_drvdata(dev); |
119 | struct via82cxxx_dev *vdev = host->host_priv; | |
1da177e4 LT |
120 | u8 t; |
121 | ||
7462cbff | 122 | if (~vdev->via_config->flags & VIA_BAD_AST) { |
1da177e4 | 123 | pci_read_config_byte(dev, VIA_ADDRESS_SETUP, &t); |
d6cddd3c | 124 | t = (t & ~(3 << ((3 - dn) << 1))) | ((clamp_val(timing->setup, 1, 4) - 1) << ((3 - dn) << 1)); |
1da177e4 LT |
125 | pci_write_config_byte(dev, VIA_ADDRESS_SETUP, t); |
126 | } | |
127 | ||
128 | pci_write_config_byte(dev, VIA_8BIT_TIMING + (1 - (dn >> 1)), | |
d6cddd3c | 129 | ((clamp_val(timing->act8b, 1, 16) - 1) << 4) | (clamp_val(timing->rec8b, 1, 16) - 1)); |
1da177e4 LT |
130 | |
131 | pci_write_config_byte(dev, VIA_DRIVE_TIMING + (3 - dn), | |
d6cddd3c | 132 | ((clamp_val(timing->active, 1, 16) - 1) << 4) | (clamp_val(timing->recover, 1, 16) - 1)); |
1da177e4 | 133 | |
75b1d975 | 134 | switch (vdev->via_config->udma_mask) { |
d6cddd3c HH |
135 | case ATA_UDMA2: t = timing->udma ? (0xe0 | (clamp_val(timing->udma, 2, 5) - 2)) : 0x03; break; |
136 | case ATA_UDMA4: t = timing->udma ? (0xe8 | (clamp_val(timing->udma, 2, 9) - 2)) : 0x0f; break; | |
137 | case ATA_UDMA5: t = timing->udma ? (0xe0 | (clamp_val(timing->udma, 2, 9) - 2)) : 0x07; break; | |
138 | case ATA_UDMA6: t = timing->udma ? (0xe0 | (clamp_val(timing->udma, 2, 9) - 2)) : 0x07; break; | |
75b1d975 | 139 | default: return; |
1da177e4 LT |
140 | } |
141 | ||
142 | pci_write_config_byte(dev, VIA_UDMA_TIMING + (3 - dn), t); | |
143 | } | |
144 | ||
145 | /** | |
146 | * via_set_drive - configure transfer mode | |
147 | * @drive: Drive to set up | |
148 | * @speed: desired speed | |
149 | * | |
88b2b32b BZ |
150 | * via_set_drive() computes timing values configures the chipset to |
151 | * a desired transfer mode. It also can be called by upper layers. | |
1da177e4 LT |
152 | */ |
153 | ||
88b2b32b | 154 | static void via_set_drive(ide_drive_t *drive, const u8 speed) |
1da177e4 | 155 | { |
36501650 | 156 | ide_hwif_t *hwif = drive->hwif; |
7e59ea21 | 157 | ide_drive_t *peer = ide_get_pair_dev(drive); |
36501650 | 158 | struct pci_dev *dev = to_pci_dev(hwif->dev); |
ee77325b BZ |
159 | struct ide_host *host = pci_get_drvdata(dev); |
160 | struct via82cxxx_dev *vdev = host->host_priv; | |
1da177e4 LT |
161 | struct ide_timing t, p; |
162 | unsigned int T, UT; | |
163 | ||
1da177e4 LT |
164 | T = 1000000000 / via_clock; |
165 | ||
75b1d975 BZ |
166 | switch (vdev->via_config->udma_mask) { |
167 | case ATA_UDMA2: UT = T; break; | |
168 | case ATA_UDMA4: UT = T/2; break; | |
169 | case ATA_UDMA5: UT = T/3; break; | |
170 | case ATA_UDMA6: UT = T/4; break; | |
171 | default: UT = T; | |
1da177e4 LT |
172 | } |
173 | ||
174 | ide_timing_compute(drive, speed, &t, T, UT); | |
175 | ||
7e59ea21 | 176 | if (peer) { |
1da177e4 LT |
177 | ide_timing_compute(peer, peer->current_speed, &p, T, UT); |
178 | ide_timing_merge(&p, &t, &t, IDE_TIMING_8BIT); | |
179 | } | |
180 | ||
898ec223 | 181 | via_set_speed(hwif, drive->dn, &t); |
1da177e4 LT |
182 | } |
183 | ||
184 | /** | |
88b2b32b | 185 | * via_set_pio_mode - set host controller for PIO mode |
26bcb879 BZ |
186 | * @drive: drive |
187 | * @pio: PIO mode number | |
1da177e4 LT |
188 | * |
189 | * A callback from the upper layers for PIO-only tuning. | |
190 | */ | |
191 | ||
26bcb879 | 192 | static void via_set_pio_mode(ide_drive_t *drive, const u8 pio) |
1da177e4 | 193 | { |
26bcb879 | 194 | via_set_drive(drive, XFER_PIO_0 + pio); |
1da177e4 LT |
195 | } |
196 | ||
7462cbff DD |
197 | static struct via_isa_bridge *via_config_find(struct pci_dev **isa) |
198 | { | |
199 | struct via_isa_bridge *via_config; | |
7462cbff DD |
200 | |
201 | for (via_config = via_isa_bridges; via_config->id; via_config++) | |
652aa162 | 202 | if ((*isa = pci_get_device(PCI_VENDOR_ID_VIA + |
7462cbff DD |
203 | !!(via_config->flags & VIA_BAD_ID), |
204 | via_config->id, NULL))) { | |
205 | ||
44c10138 AK |
206 | if ((*isa)->revision >= via_config->rev_min && |
207 | (*isa)->revision <= via_config->rev_max) | |
7462cbff | 208 | break; |
652aa162 | 209 | pci_dev_put(*isa); |
7462cbff DD |
210 | } |
211 | ||
212 | return via_config; | |
1da177e4 LT |
213 | } |
214 | ||
cd36beec BZ |
215 | /* |
216 | * Check and handle 80-wire cable presence | |
217 | */ | |
feb22b7f | 218 | static void via_cable_detect(struct via82cxxx_dev *vdev, u32 u) |
cd36beec BZ |
219 | { |
220 | int i; | |
221 | ||
75b1d975 BZ |
222 | switch (vdev->via_config->udma_mask) { |
223 | case ATA_UDMA4: | |
cd36beec BZ |
224 | for (i = 24; i >= 0; i -= 8) |
225 | if (((u >> (i & 16)) & 8) && | |
226 | ((u >> i) & 0x20) && | |
227 | (((u >> i) & 7) < 2)) { | |
228 | /* | |
229 | * 2x PCI clock and | |
230 | * UDMA w/ < 3T/cycle | |
231 | */ | |
232 | vdev->via_80w |= (1 << (1 - (i >> 4))); | |
233 | } | |
234 | break; | |
235 | ||
75b1d975 | 236 | case ATA_UDMA5: |
cd36beec BZ |
237 | for (i = 24; i >= 0; i -= 8) |
238 | if (((u >> i) & 0x10) || | |
239 | (((u >> i) & 0x20) && | |
240 | (((u >> i) & 7) < 4))) { | |
241 | /* BIOS 80-wire bit or | |
242 | * UDMA w/ < 60ns/cycle | |
243 | */ | |
244 | vdev->via_80w |= (1 << (1 - (i >> 4))); | |
245 | } | |
246 | break; | |
247 | ||
75b1d975 | 248 | case ATA_UDMA6: |
cd36beec BZ |
249 | for (i = 24; i >= 0; i -= 8) |
250 | if (((u >> i) & 0x10) || | |
251 | (((u >> i) & 0x20) && | |
252 | (((u >> i) & 7) < 6))) { | |
253 | /* BIOS 80-wire bit or | |
254 | * UDMA w/ < 60ns/cycle | |
255 | */ | |
256 | vdev->via_80w |= (1 << (1 - (i >> 4))); | |
257 | } | |
258 | break; | |
259 | } | |
260 | } | |
261 | ||
1da177e4 LT |
262 | /** |
263 | * init_chipset_via82cxxx - initialization handler | |
264 | * @dev: PCI device | |
1da177e4 LT |
265 | * |
266 | * The initialization callback. Here we determine the IDE chip type | |
267 | * and initialize its drive independent registers. | |
268 | */ | |
269 | ||
2ed0ef54 | 270 | static int init_chipset_via82cxxx(struct pci_dev *dev) |
1da177e4 | 271 | { |
ee77325b BZ |
272 | struct ide_host *host = pci_get_drvdata(dev); |
273 | struct via82cxxx_dev *vdev = host->host_priv; | |
37525beb | 274 | struct via_isa_bridge *via_config = vdev->via_config; |
1da177e4 | 275 | u8 t, v; |
cd36beec BZ |
276 | u32 u; |
277 | ||
1da177e4 | 278 | /* |
cd36beec | 279 | * Detect cable and configure Clk66 |
1da177e4 | 280 | */ |
cd36beec BZ |
281 | pci_read_config_dword(dev, VIA_UDMA_TIMING, &u); |
282 | ||
283 | via_cable_detect(vdev, u); | |
1da177e4 | 284 | |
75b1d975 | 285 | if (via_config->udma_mask == ATA_UDMA4) { |
7462cbff | 286 | /* Enable Clk66 */ |
7462cbff DD |
287 | pci_write_config_dword(dev, VIA_UDMA_TIMING, u|0x80008); |
288 | } else if (via_config->flags & VIA_BAD_CLK66) { | |
1da177e4 | 289 | /* Would cause trouble on 596a and 686 */ |
1da177e4 LT |
290 | pci_write_config_dword(dev, VIA_UDMA_TIMING, u & ~0x80008); |
291 | } | |
292 | ||
293 | /* | |
294 | * Check whether interfaces are enabled. | |
295 | */ | |
296 | ||
297 | pci_read_config_byte(dev, VIA_IDE_ENABLE, &v); | |
298 | ||
299 | /* | |
300 | * Set up FIFO sizes and thresholds. | |
301 | */ | |
302 | ||
303 | pci_read_config_byte(dev, VIA_FIFO_CONFIG, &t); | |
304 | ||
305 | /* Disable PREQ# till DDACK# */ | |
306 | if (via_config->flags & VIA_BAD_PREQ) { | |
307 | /* Would crash on 586b rev 41 */ | |
308 | t &= 0x7f; | |
309 | } | |
310 | ||
311 | /* Fix FIFO split between channels */ | |
312 | if (via_config->flags & VIA_SET_FIFO) { | |
313 | t &= (t & 0x9f); | |
314 | switch (v & 3) { | |
315 | case 2: t |= 0x00; break; /* 16 on primary */ | |
316 | case 1: t |= 0x60; break; /* 16 on secondary */ | |
317 | case 3: t |= 0x20; break; /* 8 pri 8 sec */ | |
318 | } | |
319 | } | |
320 | ||
321 | pci_write_config_byte(dev, VIA_FIFO_CONFIG, t); | |
322 | ||
1da177e4 LT |
323 | return 0; |
324 | } | |
325 | ||
bdab00b7 BZ |
326 | /* |
327 | * Cable special cases | |
328 | */ | |
329 | ||
1855256c | 330 | static const struct dmi_system_id cable_dmi_table[] = { |
bdab00b7 BZ |
331 | { |
332 | .ident = "Acer Ferrari 3400", | |
333 | .matches = { | |
334 | DMI_MATCH(DMI_BOARD_VENDOR, "Acer,Inc."), | |
335 | DMI_MATCH(DMI_BOARD_NAME, "Ferrari 3400"), | |
336 | }, | |
337 | }, | |
338 | { } | |
339 | }; | |
340 | ||
58e47bb1 | 341 | static int via_cable_override(struct pci_dev *pdev) |
bdab00b7 BZ |
342 | { |
343 | /* Systems by DMI */ | |
344 | if (dmi_check_system(cable_dmi_table)) | |
345 | return 1; | |
58e47bb1 BZ |
346 | |
347 | /* Arima W730-K8/Targa Visionary 811/... */ | |
348 | if (pdev->subsystem_vendor == 0x161F && | |
349 | pdev->subsystem_device == 0x2032) | |
350 | return 1; | |
351 | ||
bdab00b7 BZ |
352 | return 0; |
353 | } | |
354 | ||
f454cbe8 | 355 | static u8 via82cxxx_cable_detect(ide_hwif_t *hwif) |
bdab00b7 | 356 | { |
36501650 | 357 | struct pci_dev *pdev = to_pci_dev(hwif->dev); |
ee77325b BZ |
358 | struct ide_host *host = pci_get_drvdata(pdev); |
359 | struct via82cxxx_dev *vdev = host->host_priv; | |
bdab00b7 | 360 | |
58e47bb1 | 361 | if (via_cable_override(pdev)) |
bdab00b7 BZ |
362 | return ATA_CBL_PATA40_SHORT; |
363 | ||
364 | if ((vdev->via_80w >> hwif->channel) & 1) | |
365 | return ATA_CBL_PATA80; | |
366 | else | |
367 | return ATA_CBL_PATA40; | |
368 | } | |
369 | ||
ac95beed BZ |
370 | static const struct ide_port_ops via_port_ops = { |
371 | .set_pio_mode = via_set_pio_mode, | |
372 | .set_dma_mode = via_set_drive, | |
373 | .cable_detect = via82cxxx_cable_detect, | |
374 | }; | |
1da177e4 | 375 | |
85620436 | 376 | static const struct ide_port_info via82cxxx_chipset __devinitdata = { |
ced3ec8a | 377 | .name = DRV_NAME, |
6157332e | 378 | .init_chipset = init_chipset_via82cxxx, |
6157332e | 379 | .enablebits = { { 0x40, 0x02, 0x02 }, { 0x40, 0x01, 0x01 } }, |
ac95beed | 380 | .port_ops = &via_port_ops, |
6157332e | 381 | .host_flags = IDE_HFLAG_PIO_NO_BLACKLIST | |
6157332e | 382 | IDE_HFLAG_POST_SET_MODE | |
5e71d9c5 | 383 | IDE_HFLAG_IO_32BIT, |
6157332e BZ |
384 | .pio_mask = ATA_PIO5, |
385 | .swdma_mask = ATA_SWDMA2, | |
386 | .mwdma_mask = ATA_MWDMA2, | |
1da177e4 LT |
387 | }; |
388 | ||
389 | static int __devinit via_init_one(struct pci_dev *dev, const struct pci_device_id *id) | |
390 | { | |
23a1b2a7 AC |
391 | struct pci_dev *isa = NULL; |
392 | struct via_isa_bridge *via_config; | |
ee77325b BZ |
393 | struct via82cxxx_dev *vdev; |
394 | int rc; | |
6157332e | 395 | u8 idx = id->driver_data; |
039788e1 | 396 | struct ide_port_info d; |
6157332e BZ |
397 | |
398 | d = via82cxxx_chipset; | |
8acf28c0 | 399 | |
23a1b2a7 AC |
400 | /* |
401 | * Find the ISA bridge and check we know what it is. | |
402 | */ | |
403 | via_config = via_config_find(&isa); | |
23a1b2a7 | 404 | if (!via_config->id) { |
ced3ec8a | 405 | printk(KERN_WARNING DRV_NAME " %s: unknown chipset, skipping\n", |
28cfd8af | 406 | pci_name(dev)); |
23a1b2a7 AC |
407 | return -ENODEV; |
408 | } | |
8acf28c0 | 409 | |
37525beb BZ |
410 | /* |
411 | * Print the boot message. | |
412 | */ | |
ced3ec8a | 413 | printk(KERN_INFO DRV_NAME " %s: VIA %s (rev %02x) IDE %sDMA%s\n", |
28cfd8af | 414 | pci_name(dev), via_config->name, isa->revision, |
37525beb BZ |
415 | via_config->udma_mask ? "U" : "MW", |
416 | via_dma[via_config->udma_mask ? | |
28cfd8af | 417 | (fls(via_config->udma_mask) - 1) : 0]); |
37525beb BZ |
418 | |
419 | pci_dev_put(isa); | |
420 | ||
421 | /* | |
422 | * Determine system bus clock. | |
423 | */ | |
424 | via_clock = (ide_pci_clk ? ide_pci_clk : 33) * 1000; | |
425 | ||
426 | switch (via_clock) { | |
427 | case 33000: via_clock = 33333; break; | |
428 | case 37000: via_clock = 37500; break; | |
429 | case 41000: via_clock = 41666; break; | |
430 | } | |
431 | ||
432 | if (via_clock < 20000 || via_clock > 50000) { | |
ced3ec8a | 433 | printk(KERN_WARNING DRV_NAME ": User given PCI clock speed " |
37525beb | 434 | "impossible (%d), using 33 MHz instead.\n", via_clock); |
37525beb BZ |
435 | via_clock = 33333; |
436 | } | |
437 | ||
6157332e BZ |
438 | if (idx == 0) |
439 | d.host_flags |= IDE_HFLAG_NO_AUTODMA; | |
caea7602 | 440 | else |
6157332e BZ |
441 | d.enablebits[1].reg = d.enablebits[0].reg = 0; |
442 | ||
443 | if ((via_config->flags & VIA_NO_UNMASK) == 0) | |
444 | d.host_flags |= IDE_HFLAG_UNMASK_IRQS; | |
caea7602 | 445 | |
6157332e | 446 | d.udma_mask = via_config->udma_mask; |
8acf28c0 | 447 | |
ee77325b BZ |
448 | vdev = kzalloc(sizeof(*vdev), GFP_KERNEL); |
449 | if (!vdev) { | |
ced3ec8a BZ |
450 | printk(KERN_ERR DRV_NAME " %s: out of memory :(\n", |
451 | pci_name(dev)); | |
ee77325b BZ |
452 | return -ENOMEM; |
453 | } | |
454 | ||
37525beb BZ |
455 | vdev->via_config = via_config; |
456 | ||
ee77325b BZ |
457 | rc = ide_pci_init_one(dev, &d, vdev); |
458 | if (rc) | |
459 | kfree(vdev); | |
460 | ||
461 | return rc; | |
1da177e4 LT |
462 | } |
463 | ||
585f67e7 BZ |
464 | static void __devexit via_remove(struct pci_dev *dev) |
465 | { | |
466 | struct ide_host *host = pci_get_drvdata(dev); | |
467 | struct via82cxxx_dev *vdev = host->host_priv; | |
468 | ||
469 | ide_pci_remove(dev); | |
470 | kfree(vdev); | |
471 | } | |
472 | ||
9cbcc5e3 BZ |
473 | static const struct pci_device_id via_pci_tbl[] = { |
474 | { PCI_VDEVICE(VIA, PCI_DEVICE_ID_VIA_82C576_1), 0 }, | |
475 | { PCI_VDEVICE(VIA, PCI_DEVICE_ID_VIA_82C586_1), 0 }, | |
84f7e451 | 476 | { PCI_VDEVICE(VIA, PCI_DEVICE_ID_VIA_CX700_IDE), 0 }, |
9cbcc5e3 BZ |
477 | { PCI_VDEVICE(VIA, PCI_DEVICE_ID_VIA_6410), 1 }, |
478 | { PCI_VDEVICE(VIA, PCI_DEVICE_ID_VIA_SATA_EIDE), 1 }, | |
1da177e4 LT |
479 | { 0, }, |
480 | }; | |
481 | MODULE_DEVICE_TABLE(pci, via_pci_tbl); | |
482 | ||
a9ab09e2 | 483 | static struct pci_driver via_pci_driver = { |
1da177e4 LT |
484 | .name = "VIA_IDE", |
485 | .id_table = via_pci_tbl, | |
486 | .probe = via_init_one, | |
a69999e2 | 487 | .remove = __devexit_p(via_remove), |
feb22b7f BZ |
488 | .suspend = ide_pci_suspend, |
489 | .resume = ide_pci_resume, | |
1da177e4 LT |
490 | }; |
491 | ||
82ab1eec | 492 | static int __init via_ide_init(void) |
1da177e4 | 493 | { |
a9ab09e2 | 494 | return ide_pci_register_driver(&via_pci_driver); |
1da177e4 LT |
495 | } |
496 | ||
585f67e7 BZ |
497 | static void __exit via_ide_exit(void) |
498 | { | |
a9ab09e2 | 499 | pci_unregister_driver(&via_pci_driver); |
585f67e7 BZ |
500 | } |
501 | ||
1da177e4 | 502 | module_init(via_ide_init); |
585f67e7 | 503 | module_exit(via_ide_exit); |
1da177e4 LT |
504 | |
505 | MODULE_AUTHOR("Vojtech Pavlik, Michel Aubry, Jeff Garzik, Andre Hedrick"); | |
506 | MODULE_DESCRIPTION("PCI driver module for VIA IDE"); | |
507 | MODULE_LICENSE("GPL"); |