1
2
3
4
5
6
7#include <linux/kernel.h>
8#include <linux/module.h>
9#include <linux/pci.h>
10#include <linux/init.h>
11#include <linux/blkdev.h>
12#include <linux/delay.h>
13#include <linux/device.h>
14#include <linux/gfp.h>
15#include <scsi/scsi_host.h>
16#include <acpi/acpi_bus.h>
17
18#include <linux/libata.h>
19#include <linux/ata.h>
20
21#define DRV_NAME "pata_acpi"
22#define DRV_VERSION "0.2.3"
23
24struct pata_acpi {
25 struct ata_acpi_gtm gtm;
26 void *last;
27 unsigned long mask[2];
28};
29
30
31
32
33
34
35
36
37
38static int pacpi_pre_reset(struct ata_link *link, unsigned long deadline)
39{
40 struct ata_port *ap = link->ap;
41 struct pata_acpi *acpi = ap->private_data;
42 if (ap->acpi_handle == NULL || ata_acpi_gtm(ap, &acpi->gtm) < 0)
43 return -ENODEV;
44
45 return ata_sff_prereset(link, deadline);
46}
47
48
49
50
51
52
53
54
55static int pacpi_cable_detect(struct ata_port *ap)
56{
57 struct pata_acpi *acpi = ap->private_data;
58
59 if ((acpi->mask[0] | acpi->mask[1]) & (0xF8 << ATA_SHIFT_UDMA))
60 return ATA_CBL_PATA80;
61 else
62 return ATA_CBL_PATA40;
63}
64
65
66
67
68
69
70
71
72
73
74static unsigned long pacpi_discover_modes(struct ata_port *ap, struct ata_device *adev)
75{
76 struct pata_acpi *acpi = ap->private_data;
77 struct ata_acpi_gtm probe;
78 unsigned int xfer_mask;
79
80 probe = acpi->gtm;
81
82 ata_acpi_gtm(ap, &probe);
83
84 xfer_mask = ata_acpi_gtm_xfermask(adev, &probe);
85
86 if (xfer_mask & (0xF8 << ATA_SHIFT_UDMA))
87 ap->cbl = ATA_CBL_PATA80;
88
89 return xfer_mask;
90}
91
92
93
94
95
96
97
98
99
100
101static unsigned long pacpi_mode_filter(struct ata_device *adev, unsigned long mask)
102{
103 struct pata_acpi *acpi = adev->link->ap->private_data;
104 return mask & acpi->mask[adev->devno];
105}
106
107
108
109
110
111
112
113static void pacpi_set_piomode(struct ata_port *ap, struct ata_device *adev)
114{
115 int unit = adev->devno;
116 struct pata_acpi *acpi = ap->private_data;
117 const struct ata_timing *t;
118
119 if (!(acpi->gtm.flags & 0x10))
120 unit = 0;
121
122
123 t = ata_timing_find_mode(adev->pio_mode);
124 acpi->gtm.drive[unit].pio = t->cycle;
125 ata_acpi_stm(ap, &acpi->gtm);
126
127 ata_acpi_gtm(ap, &acpi->gtm);
128}
129
130
131
132
133
134
135
136static void pacpi_set_dmamode(struct ata_port *ap, struct ata_device *adev)
137{
138 int unit = adev->devno;
139 struct pata_acpi *acpi = ap->private_data;
140 const struct ata_timing *t;
141
142 if (!(acpi->gtm.flags & 0x10))
143 unit = 0;
144
145
146 t = ata_timing_find_mode(adev->dma_mode);
147 if (adev->dma_mode >= XFER_UDMA_0) {
148 acpi->gtm.drive[unit].dma = t->udma;
149 acpi->gtm.flags |= (1 << (2 * unit));
150 } else {
151 acpi->gtm.drive[unit].dma = t->cycle;
152 acpi->gtm.flags &= ~(1 << (2 * unit));
153 }
154 ata_acpi_stm(ap, &acpi->gtm);
155
156 ata_acpi_gtm(ap, &acpi->gtm);
157}
158
159
160
161
162
163
164
165
166
167
168static unsigned int pacpi_qc_issue(struct ata_queued_cmd *qc)
169{
170 struct ata_port *ap = qc->ap;
171 struct ata_device *adev = qc->dev;
172 struct pata_acpi *acpi = ap->private_data;
173
174 if (acpi->gtm.flags & 0x10)
175 return ata_bmdma_qc_issue(qc);
176
177 if (adev != acpi->last) {
178 pacpi_set_piomode(ap, adev);
179 if (ata_dma_enabled(adev))
180 pacpi_set_dmamode(ap, adev);
181 acpi->last = adev;
182 }
183 return ata_bmdma_qc_issue(qc);
184}
185
186
187
188
189
190
191
192
193static int pacpi_port_start(struct ata_port *ap)
194{
195 struct pci_dev *pdev = to_pci_dev(ap->host->dev);
196 struct pata_acpi *acpi;
197
198 int ret;
199
200 if (ap->acpi_handle == NULL)
201 return -ENODEV;
202
203 acpi = ap->private_data = devm_kzalloc(&pdev->dev, sizeof(struct pata_acpi), GFP_KERNEL);
204 if (ap->private_data == NULL)
205 return -ENOMEM;
206 acpi->mask[0] = pacpi_discover_modes(ap, &ap->link.device[0]);
207 acpi->mask[1] = pacpi_discover_modes(ap, &ap->link.device[1]);
208 ret = ata_bmdma_port_start(ap);
209 if (ret < 0)
210 return ret;
211
212 return ret;
213}
214
215static struct scsi_host_template pacpi_sht = {
216 ATA_BMDMA_SHT(DRV_NAME),
217};
218
219static struct ata_port_operations pacpi_ops = {
220 .inherits = &ata_bmdma_port_ops,
221 .qc_issue = pacpi_qc_issue,
222 .cable_detect = pacpi_cable_detect,
223 .mode_filter = pacpi_mode_filter,
224 .set_piomode = pacpi_set_piomode,
225 .set_dmamode = pacpi_set_dmamode,
226 .prereset = pacpi_pre_reset,
227 .port_start = pacpi_port_start,
228};
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245static int pacpi_init_one (struct pci_dev *pdev, const struct pci_device_id *id)
246{
247 static const struct ata_port_info info = {
248 .flags = ATA_FLAG_SLAVE_POSS | ATA_FLAG_SRST,
249
250 .pio_mask = ATA_PIO4,
251 .mwdma_mask = ATA_MWDMA2,
252 .udma_mask = ATA_UDMA6,
253
254 .port_ops = &pacpi_ops,
255 };
256 const struct ata_port_info *ppi[] = { &info, NULL };
257 if (pdev->vendor == PCI_VENDOR_ID_ATI) {
258 int rc = pcim_enable_device(pdev);
259 if (rc < 0)
260 return rc;
261 pcim_pin_device(pdev);
262 }
263 return ata_pci_bmdma_init_one(pdev, ppi, &pacpi_sht, NULL, 0);
264}
265
266static const struct pci_device_id pacpi_pci_tbl[] = {
267 { PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_STORAGE_IDE << 8, 0xFFFFFF00UL, 1},
268 { }
269};
270
271static struct pci_driver pacpi_pci_driver = {
272 .name = DRV_NAME,
273 .id_table = pacpi_pci_tbl,
274 .probe = pacpi_init_one,
275 .remove = ata_pci_remove_one,
276#ifdef CONFIG_PM
277 .suspend = ata_pci_device_suspend,
278 .resume = ata_pci_device_resume,
279#endif
280};
281
282static int __init pacpi_init(void)
283{
284 return pci_register_driver(&pacpi_pci_driver);
285}
286
287static void __exit pacpi_exit(void)
288{
289 pci_unregister_driver(&pacpi_pci_driver);
290}
291
292module_init(pacpi_init);
293module_exit(pacpi_exit);
294
295MODULE_AUTHOR("Alan Cox");
296MODULE_DESCRIPTION("SCSI low-level driver for ATA in ACPI mode");
297MODULE_LICENSE("GPL");
298MODULE_DEVICE_TABLE(pci, pacpi_pci_tbl);
299MODULE_VERSION(DRV_VERSION);
300
301