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 (ata_ap_acpi_handle(ap) == 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 if (ata_ap_acpi_handle(ap) == NULL)
199 return -ENODEV;
200
201 acpi = ap->private_data = devm_kzalloc(&pdev->dev, sizeof(struct pata_acpi), GFP_KERNEL);
202 if (ap->private_data == NULL)
203 return -ENOMEM;
204 acpi->mask[0] = pacpi_discover_modes(ap, &ap->link.device[0]);
205 acpi->mask[1] = pacpi_discover_modes(ap, &ap->link.device[1]);
206 return ata_bmdma_port_start(ap);
207}
208
209static struct scsi_host_template pacpi_sht = {
210 ATA_BMDMA_SHT(DRV_NAME),
211};
212
213static struct ata_port_operations pacpi_ops = {
214 .inherits = &ata_bmdma_port_ops,
215 .qc_issue = pacpi_qc_issue,
216 .cable_detect = pacpi_cable_detect,
217 .mode_filter = pacpi_mode_filter,
218 .set_piomode = pacpi_set_piomode,
219 .set_dmamode = pacpi_set_dmamode,
220 .prereset = pacpi_pre_reset,
221 .port_start = pacpi_port_start,
222};
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239static int pacpi_init_one (struct pci_dev *pdev, const struct pci_device_id *id)
240{
241 static const struct ata_port_info info = {
242 .flags = ATA_FLAG_SLAVE_POSS,
243
244 .pio_mask = ATA_PIO4,
245 .mwdma_mask = ATA_MWDMA2,
246 .udma_mask = ATA_UDMA6,
247
248 .port_ops = &pacpi_ops,
249 };
250 const struct ata_port_info *ppi[] = { &info, NULL };
251 if (pdev->vendor == PCI_VENDOR_ID_ATI) {
252 int rc = pcim_enable_device(pdev);
253 if (rc < 0)
254 return rc;
255 pcim_pin_device(pdev);
256 }
257 return ata_pci_bmdma_init_one(pdev, ppi, &pacpi_sht, NULL, 0);
258}
259
260static const struct pci_device_id pacpi_pci_tbl[] = {
261 { PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_STORAGE_IDE << 8, 0xFFFFFF00UL, 1},
262 { }
263};
264
265static struct pci_driver pacpi_pci_driver = {
266 .name = DRV_NAME,
267 .id_table = pacpi_pci_tbl,
268 .probe = pacpi_init_one,
269 .remove = ata_pci_remove_one,
270#ifdef CONFIG_PM
271 .suspend = ata_pci_device_suspend,
272 .resume = ata_pci_device_resume,
273#endif
274};
275
276module_pci_driver(pacpi_pci_driver);
277
278MODULE_AUTHOR("Alan Cox");
279MODULE_DESCRIPTION("SCSI low-level driver for ATA in ACPI mode");
280MODULE_LICENSE("GPL");
281MODULE_DEVICE_TABLE(pci, pacpi_pci_tbl);
282MODULE_VERSION(DRV_VERSION);
283