1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34#include <linux/kernel.h>
35#include <linux/module.h>
36#include <linux/pci.h>
37#include <linux/blkdev.h>
38#include <linux/delay.h>
39#include <scsi/scsi_host.h>
40#include <linux/libata.h>
41
42#define DRV_NAME "pata_cs5520"
43#define DRV_VERSION "0.6.6"
44
45struct pio_clocks
46{
47 int address;
48 int assert;
49 int recovery;
50};
51
52static const struct pio_clocks cs5520_pio_clocks[]={
53 {3, 6, 11},
54 {2, 5, 6},
55 {1, 4, 3},
56 {1, 3, 2},
57 {1, 2, 1}
58};
59
60
61
62
63
64
65
66
67
68
69static void cs5520_set_timings(struct ata_port *ap, struct ata_device *adev, int pio)
70{
71 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
72 int slave = adev->devno;
73
74 pio -= XFER_PIO_0;
75
76
77 pci_write_config_byte(pdev, 0x62 + ap->port_no,
78 (cs5520_pio_clocks[pio].recovery << 4) |
79 (cs5520_pio_clocks[pio].assert));
80
81
82 pci_write_config_byte(pdev, 0x64 + 4*ap->port_no + slave,
83 (cs5520_pio_clocks[pio].recovery << 4) |
84 (cs5520_pio_clocks[pio].assert));
85
86 pci_write_config_byte(pdev, 0x66 + 4*ap->port_no + slave,
87 (cs5520_pio_clocks[pio].recovery << 4) |
88 (cs5520_pio_clocks[pio].assert));
89}
90
91
92
93
94
95
96
97
98
99
100static void cs5520_set_piomode(struct ata_port *ap, struct ata_device *adev)
101{
102 cs5520_set_timings(ap, adev, adev->pio_mode);
103}
104
105static struct scsi_host_template cs5520_sht = {
106 ATA_BMDMA_SHT(DRV_NAME),
107 .sg_tablesize = LIBATA_DUMB_MAX_PRD,
108};
109
110static struct ata_port_operations cs5520_port_ops = {
111 .inherits = &ata_bmdma_port_ops,
112 .qc_prep = ata_bmdma_dumb_qc_prep,
113 .cable_detect = ata_cable_40wire,
114 .set_piomode = cs5520_set_piomode,
115};
116
117static int cs5520_init_one(struct pci_dev *pdev, const struct pci_device_id *id)
118{
119 static const unsigned int cmd_port[] = { 0x1F0, 0x170 };
120 static const unsigned int ctl_port[] = { 0x3F6, 0x376 };
121 struct ata_port_info pi = {
122 .flags = ATA_FLAG_SLAVE_POSS,
123 .pio_mask = ATA_PIO4,
124 .port_ops = &cs5520_port_ops,
125 };
126 const struct ata_port_info *ppi[2];
127 u8 pcicfg;
128 void __iomem *iomap[5];
129 struct ata_host *host;
130 struct ata_ioports *ioaddr;
131 int i, rc;
132
133 rc = pcim_enable_device(pdev);
134 if (rc)
135 return rc;
136
137
138 pci_read_config_byte(pdev, 0x60, &pcicfg);
139
140
141 if ((pcicfg & 3) == 0)
142 return -ENODEV;
143
144 ppi[0] = ppi[1] = &ata_dummy_port_info;
145 if (pcicfg & 1)
146 ppi[0] = π
147 if (pcicfg & 2)
148 ppi[1] = π
149
150 if ((pcicfg & 0x40) == 0) {
151 dev_warn(&pdev->dev, "DMA mode disabled. Enabling.\n");
152 pci_write_config_byte(pdev, 0x60, pcicfg | 0x40);
153 }
154
155 pi.mwdma_mask = id->driver_data;
156
157 host = ata_host_alloc_pinfo(&pdev->dev, ppi, 2);
158 if (!host)
159 return -ENOMEM;
160
161
162 if (pci_enable_device_io(pdev)) {
163 printk(KERN_ERR DRV_NAME ": unable to configure BAR2.\n");
164 return -ENODEV;
165 }
166
167 if (pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) {
168 printk(KERN_ERR DRV_NAME ": unable to configure DMA mask.\n");
169 return -ENODEV;
170 }
171 if (pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32))) {
172 printk(KERN_ERR DRV_NAME ": unable to configure consistent DMA mask.\n");
173 return -ENODEV;
174 }
175
176
177 iomap[0] = devm_ioport_map(&pdev->dev, cmd_port[0], 8);
178 iomap[1] = devm_ioport_map(&pdev->dev, ctl_port[0], 1);
179 iomap[2] = devm_ioport_map(&pdev->dev, cmd_port[1], 8);
180 iomap[3] = devm_ioport_map(&pdev->dev, ctl_port[1], 1);
181 iomap[4] = pcim_iomap(pdev, 2, 0);
182
183 if (!iomap[0] || !iomap[1] || !iomap[2] || !iomap[3] || !iomap[4])
184 return -ENOMEM;
185
186 ioaddr = &host->ports[0]->ioaddr;
187 ioaddr->cmd_addr = iomap[0];
188 ioaddr->ctl_addr = iomap[1];
189 ioaddr->altstatus_addr = iomap[1];
190 ioaddr->bmdma_addr = iomap[4];
191 ata_sff_std_ports(ioaddr);
192
193 ata_port_desc(host->ports[0],
194 "cmd 0x%x ctl 0x%x", cmd_port[0], ctl_port[0]);
195 ata_port_pbar_desc(host->ports[0], 4, 0, "bmdma");
196
197 ioaddr = &host->ports[1]->ioaddr;
198 ioaddr->cmd_addr = iomap[2];
199 ioaddr->ctl_addr = iomap[3];
200 ioaddr->altstatus_addr = iomap[3];
201 ioaddr->bmdma_addr = iomap[4] + 8;
202 ata_sff_std_ports(ioaddr);
203
204 ata_port_desc(host->ports[1],
205 "cmd 0x%x ctl 0x%x", cmd_port[1], ctl_port[1]);
206 ata_port_pbar_desc(host->ports[1], 4, 8, "bmdma");
207
208
209 pci_set_master(pdev);
210 rc = ata_host_start(host);
211 if (rc)
212 return rc;
213
214 for (i = 0; i < 2; i++) {
215 static const int irq[] = { 14, 15 };
216 struct ata_port *ap = host->ports[i];
217
218 if (ata_port_is_dummy(ap))
219 continue;
220
221 rc = devm_request_irq(&pdev->dev, irq[ap->port_no],
222 ata_bmdma_interrupt, 0, DRV_NAME, host);
223 if (rc)
224 return rc;
225
226 ata_port_desc(ap, "irq %d", irq[i]);
227 }
228
229 return ata_host_register(host, &cs5520_sht);
230}
231
232#ifdef CONFIG_PM_SLEEP
233
234
235
236
237
238
239
240
241static int cs5520_reinit_one(struct pci_dev *pdev)
242{
243 struct ata_host *host = pci_get_drvdata(pdev);
244 u8 pcicfg;
245 int rc;
246
247 rc = ata_pci_device_do_resume(pdev);
248 if (rc)
249 return rc;
250
251 pci_read_config_byte(pdev, 0x60, &pcicfg);
252 if ((pcicfg & 0x40) == 0)
253 pci_write_config_byte(pdev, 0x60, pcicfg | 0x40);
254
255 ata_host_resume(host);
256 return 0;
257}
258
259
260
261
262
263
264
265
266
267
268
269static int cs5520_pci_device_suspend(struct pci_dev *pdev, pm_message_t mesg)
270{
271 struct ata_host *host = pci_get_drvdata(pdev);
272 int rc = 0;
273
274 rc = ata_host_suspend(host, mesg);
275 if (rc)
276 return rc;
277
278 pci_save_state(pdev);
279 return 0;
280}
281#endif
282
283
284
285
286static const struct pci_device_id pata_cs5520[] = {
287 { PCI_VDEVICE(CYRIX, PCI_DEVICE_ID_CYRIX_5510), },
288 { PCI_VDEVICE(CYRIX, PCI_DEVICE_ID_CYRIX_5520), },
289
290 { },
291};
292
293static struct pci_driver cs5520_pci_driver = {
294 .name = DRV_NAME,
295 .id_table = pata_cs5520,
296 .probe = cs5520_init_one,
297 .remove = ata_pci_remove_one,
298#ifdef CONFIG_PM_SLEEP
299 .suspend = cs5520_pci_device_suspend,
300 .resume = cs5520_reinit_one,
301#endif
302};
303
304module_pci_driver(cs5520_pci_driver);
305
306MODULE_AUTHOR("Alan Cox");
307MODULE_DESCRIPTION("low-level driver for Cyrix CS5510/5520");
308MODULE_LICENSE("GPL");
309MODULE_DEVICE_TABLE(pci, pata_cs5520);
310MODULE_VERSION(DRV_VERSION);
311