This source file includes following definitions.
- cs5530_port_base
- cs5530_set_piomode
- cs5530_set_dmamode
- cs5530_qc_issue
- cs5530_is_palmax
- cs5530_init_chip
- cs5530_init_one
- cs5530_reinit_one
1
2
3
4
5
6
7
8
9
10
11
12
13
14 #include <linux/kernel.h>
15 #include <linux/module.h>
16 #include <linux/pci.h>
17 #include <linux/blkdev.h>
18 #include <linux/delay.h>
19 #include <scsi/scsi_host.h>
20 #include <linux/libata.h>
21 #include <linux/dmi.h>
22
23 #define DRV_NAME "pata_cs5530"
24 #define DRV_VERSION "0.7.4"
25
26 static void __iomem *cs5530_port_base(struct ata_port *ap)
27 {
28 unsigned long bmdma = (unsigned long)ap->ioaddr.bmdma_addr;
29
30 return (void __iomem *)((bmdma & ~0x0F) + 0x20 + 0x10 * ap->port_no);
31 }
32
33
34
35
36
37
38
39
40
41
42 static void cs5530_set_piomode(struct ata_port *ap, struct ata_device *adev)
43 {
44 static const unsigned int cs5530_pio_timings[2][5] = {
45 {0x00009172, 0x00012171, 0x00020080, 0x00032010, 0x00040010},
46 {0xd1329172, 0x71212171, 0x30200080, 0x20102010, 0x00100010}
47 };
48 void __iomem *base = cs5530_port_base(ap);
49 u32 tuning;
50 int format;
51
52
53 tuning = ioread32(base + 0x04);
54 format = (tuning & 0x80000000UL) ? 1 : 0;
55
56
57 if (adev->devno)
58 base += 0x08;
59
60 iowrite32(cs5530_pio_timings[format][adev->pio_mode - XFER_PIO_0], base);
61 }
62
63
64
65
66
67
68
69
70
71
72
73 static void cs5530_set_dmamode(struct ata_port *ap, struct ata_device *adev)
74 {
75 void __iomem *base = cs5530_port_base(ap);
76 u32 tuning, timing = 0;
77 u8 reg;
78
79
80 tuning = ioread32(base + 0x04);
81
82 switch(adev->dma_mode) {
83 case XFER_UDMA_0:
84 timing = 0x00921250;break;
85 case XFER_UDMA_1:
86 timing = 0x00911140;break;
87 case XFER_UDMA_2:
88 timing = 0x00911030;break;
89 case XFER_MW_DMA_0:
90 timing = 0x00077771;break;
91 case XFER_MW_DMA_1:
92 timing = 0x00012121;break;
93 case XFER_MW_DMA_2:
94 timing = 0x00002020;break;
95 default:
96 BUG();
97 }
98
99 timing |= (tuning & 0x80000000UL);
100 if (adev->devno == 0)
101 iowrite32(timing, base + 0x04);
102 else {
103 if (timing & 0x00100000)
104 tuning |= 0x00100000;
105 else
106 tuning &= ~0x00100000;
107 iowrite32(tuning, base + 0x04);
108 iowrite32(timing, base + 0x0C);
109 }
110
111
112 reg = ioread8(ap->ioaddr.bmdma_addr + ATA_DMA_STATUS);
113 reg |= (1 << (5 + adev->devno));
114 iowrite8(reg, ap->ioaddr.bmdma_addr + ATA_DMA_STATUS);
115
116
117
118 ap->private_data = adev;
119 }
120
121
122
123
124
125
126
127
128
129
130
131 static unsigned int cs5530_qc_issue(struct ata_queued_cmd *qc)
132 {
133 struct ata_port *ap = qc->ap;
134 struct ata_device *adev = qc->dev;
135 struct ata_device *prev = ap->private_data;
136
137
138 if (ata_dma_enabled(adev) && adev != prev && prev != NULL) {
139
140 if ((ata_using_udma(adev) && !ata_using_udma(prev)) ||
141 (ata_using_udma(prev) && !ata_using_udma(adev)))
142
143 cs5530_set_dmamode(ap, adev);
144 }
145
146 return ata_bmdma_qc_issue(qc);
147 }
148
149 static struct scsi_host_template cs5530_sht = {
150 ATA_BMDMA_SHT(DRV_NAME),
151 .sg_tablesize = LIBATA_DUMB_MAX_PRD,
152 };
153
154 static struct ata_port_operations cs5530_port_ops = {
155 .inherits = &ata_bmdma_port_ops,
156
157 .qc_prep = ata_bmdma_dumb_qc_prep,
158 .qc_issue = cs5530_qc_issue,
159
160 .cable_detect = ata_cable_40wire,
161 .set_piomode = cs5530_set_piomode,
162 .set_dmamode = cs5530_set_dmamode,
163 };
164
165 static const struct dmi_system_id palmax_dmi_table[] = {
166 {
167 .ident = "Palmax PD1100",
168 .matches = {
169 DMI_MATCH(DMI_SYS_VENDOR, "Cyrix"),
170 DMI_MATCH(DMI_PRODUCT_NAME, "Caddis"),
171 },
172 },
173 { }
174 };
175
176 static int cs5530_is_palmax(void)
177 {
178 if (dmi_check_system(palmax_dmi_table)) {
179 printk(KERN_INFO "Palmax PD1100: Disabling DMA on docking port.\n");
180 return 1;
181 }
182 return 0;
183 }
184
185
186
187
188
189
190
191
192
193 static int cs5530_init_chip(void)
194 {
195 struct pci_dev *master_0 = NULL, *cs5530_0 = NULL, *dev = NULL;
196
197 while ((dev = pci_get_device(PCI_VENDOR_ID_CYRIX, PCI_ANY_ID, dev)) != NULL) {
198 switch (dev->device) {
199 case PCI_DEVICE_ID_CYRIX_PCI_MASTER:
200 master_0 = pci_dev_get(dev);
201 break;
202 case PCI_DEVICE_ID_CYRIX_5530_LEGACY:
203 cs5530_0 = pci_dev_get(dev);
204 break;
205 }
206 }
207 if (!master_0) {
208 printk(KERN_ERR DRV_NAME ": unable to locate PCI MASTER function\n");
209 goto fail_put;
210 }
211 if (!cs5530_0) {
212 printk(KERN_ERR DRV_NAME ": unable to locate CS5530 LEGACY function\n");
213 goto fail_put;
214 }
215
216 pci_set_master(cs5530_0);
217 pci_try_set_mwi(cs5530_0);
218
219
220
221
222
223
224
225
226 pci_write_config_byte(cs5530_0, PCI_CACHE_LINE_SIZE, 0x04);
227
228
229
230
231
232
233 pci_write_config_word(cs5530_0, 0xd0, 0x5006);
234
235
236
237
238
239
240
241 pci_write_config_byte(master_0, 0x40, 0x1e);
242
243
244
245
246
247
248
249
250
251
252
253 pci_write_config_byte(master_0, 0x41, 0x14);
254
255
256
257
258
259
260 pci_write_config_byte(master_0, 0x42, 0x00);
261 pci_write_config_byte(master_0, 0x43, 0xc1);
262
263 pci_dev_put(master_0);
264 pci_dev_put(cs5530_0);
265 return 0;
266 fail_put:
267 pci_dev_put(master_0);
268 pci_dev_put(cs5530_0);
269 return -ENODEV;
270 }
271
272
273
274
275
276
277
278
279
280
281
282 static int cs5530_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
283 {
284 static const struct ata_port_info info = {
285 .flags = ATA_FLAG_SLAVE_POSS,
286 .pio_mask = ATA_PIO4,
287 .mwdma_mask = ATA_MWDMA2,
288 .udma_mask = ATA_UDMA2,
289 .port_ops = &cs5530_port_ops
290 };
291
292 static const struct ata_port_info info_palmax_secondary = {
293 .flags = ATA_FLAG_SLAVE_POSS,
294 .pio_mask = ATA_PIO4,
295 .port_ops = &cs5530_port_ops
296 };
297 const struct ata_port_info *ppi[] = { &info, NULL };
298 int rc;
299
300 rc = pcim_enable_device(pdev);
301 if (rc)
302 return rc;
303
304
305 if (cs5530_init_chip())
306 return -ENODEV;
307
308 if (cs5530_is_palmax())
309 ppi[1] = &info_palmax_secondary;
310
311
312 return ata_pci_bmdma_init_one(pdev, ppi, &cs5530_sht, NULL, 0);
313 }
314
315 #ifdef CONFIG_PM_SLEEP
316 static int cs5530_reinit_one(struct pci_dev *pdev)
317 {
318 struct ata_host *host = pci_get_drvdata(pdev);
319 int rc;
320
321 rc = ata_pci_device_do_resume(pdev);
322 if (rc)
323 return rc;
324
325
326 if (cs5530_init_chip())
327 return -EIO;
328
329 ata_host_resume(host);
330 return 0;
331 }
332 #endif
333
334 static const struct pci_device_id cs5530[] = {
335 { PCI_VDEVICE(CYRIX, PCI_DEVICE_ID_CYRIX_5530_IDE), },
336
337 { },
338 };
339
340 static struct pci_driver cs5530_pci_driver = {
341 .name = DRV_NAME,
342 .id_table = cs5530,
343 .probe = cs5530_init_one,
344 .remove = ata_pci_remove_one,
345 #ifdef CONFIG_PM_SLEEP
346 .suspend = ata_pci_device_suspend,
347 .resume = cs5530_reinit_one,
348 #endif
349 };
350
351 module_pci_driver(cs5530_pci_driver);
352
353 MODULE_AUTHOR("Alan Cox");
354 MODULE_DESCRIPTION("low-level driver for the Cyrix/NS/AMD 5530");
355 MODULE_LICENSE("GPL");
356 MODULE_DEVICE_TABLE(pci, cs5530);
357 MODULE_VERSION(DRV_VERSION);