]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * pnpacpi -- PnP ACPI driver | |
3 | * | |
4 | * Copyright (c) 2004 Matthieu Castet <castet.matthieu@free.fr> | |
5 | * Copyright (c) 2004 Li Shaohua <shaohua.li@intel.com> | |
50eca3eb | 6 | * |
1da177e4 LT |
7 | * This program is free software; you can redistribute it and/or modify it |
8 | * under the terms of the GNU General Public License as published by the | |
9 | * Free Software Foundation; either version 2, or (at your option) any | |
10 | * later version. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, but | |
13 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
15 | * General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License | |
18 | * along with this program; if not, write to the Free Software | |
19 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
20 | */ | |
21 | #include <linux/kernel.h> | |
22 | #include <linux/acpi.h> | |
23 | #include <linux/pci.h> | |
24 | #include "pnpacpi.h" | |
25 | ||
26 | #ifdef CONFIG_IA64 | |
27 | #define valid_IRQ(i) (1) | |
28 | #else | |
29 | #define valid_IRQ(i) (((i) != 0) && ((i) != 2)) | |
30 | #endif | |
31 | ||
32 | /* | |
33 | * Allocated Resources | |
34 | */ | |
cd7ec927 | 35 | static int irq_flags(int triggering, int polarity, int shareable) |
1da177e4 | 36 | { |
cd7ec927 BH |
37 | int flags; |
38 | ||
50eca3eb | 39 | if (triggering == ACPI_LEVEL_SENSITIVE) { |
1c6e7d0a | 40 | if (polarity == ACPI_ACTIVE_LOW) |
cd7ec927 | 41 | flags = IORESOURCE_IRQ_LOWLEVEL; |
1da177e4 | 42 | else |
cd7ec927 | 43 | flags = IORESOURCE_IRQ_HIGHLEVEL; |
9dd78466 | 44 | } else { |
1c6e7d0a | 45 | if (polarity == ACPI_ACTIVE_LOW) |
cd7ec927 | 46 | flags = IORESOURCE_IRQ_LOWEDGE; |
1da177e4 | 47 | else |
cd7ec927 | 48 | flags = IORESOURCE_IRQ_HIGHEDGE; |
1da177e4 | 49 | } |
cd7ec927 BH |
50 | |
51 | if (shareable) | |
52 | flags |= IORESOURCE_IRQ_SHAREABLE; | |
53 | ||
54 | return flags; | |
1da177e4 LT |
55 | } |
56 | ||
50eca3eb | 57 | static void decode_irq_flags(int flag, int *triggering, int *polarity) |
1da177e4 LT |
58 | { |
59 | switch (flag) { | |
60 | case IORESOURCE_IRQ_LOWLEVEL: | |
50eca3eb BM |
61 | *triggering = ACPI_LEVEL_SENSITIVE; |
62 | *polarity = ACPI_ACTIVE_LOW; | |
1da177e4 | 63 | break; |
1c6e7d0a | 64 | case IORESOURCE_IRQ_HIGHLEVEL: |
50eca3eb BM |
65 | *triggering = ACPI_LEVEL_SENSITIVE; |
66 | *polarity = ACPI_ACTIVE_HIGH; | |
1da177e4 LT |
67 | break; |
68 | case IORESOURCE_IRQ_LOWEDGE: | |
50eca3eb BM |
69 | *triggering = ACPI_EDGE_SENSITIVE; |
70 | *polarity = ACPI_ACTIVE_LOW; | |
1da177e4 LT |
71 | break; |
72 | case IORESOURCE_IRQ_HIGHEDGE: | |
50eca3eb BM |
73 | *triggering = ACPI_EDGE_SENSITIVE; |
74 | *polarity = ACPI_ACTIVE_HIGH; | |
1da177e4 LT |
75 | break; |
76 | } | |
77 | } | |
78 | ||
4ab55d8d | 79 | static void pnpacpi_parse_allocated_irqresource(struct pnp_dev *dev, |
07d4e9af BH |
80 | u32 gsi, int triggering, |
81 | int polarity, int shareable) | |
1da177e4 | 82 | { |
4ab55d8d | 83 | struct pnp_resource_table *res = &dev->res; |
1da177e4 | 84 | int i = 0; |
dbed12da | 85 | int irq; |
61fd47e0 | 86 | int p, t; |
66a21736 | 87 | static unsigned char warned; |
dbed12da BH |
88 | |
89 | if (!valid_IRQ(gsi)) | |
90 | return; | |
91 | ||
1da177e4 | 92 | while (!(res->irq_resource[i].flags & IORESOURCE_UNSET) && |
9dd78466 | 93 | i < PNP_MAX_IRQ) |
1da177e4 | 94 | i++; |
0093cb11 LB |
95 | if (i >= PNP_MAX_IRQ) { |
96 | if (!warned) { | |
97 | printk(KERN_WARNING "pnpacpi: exceeded the max number" | |
98 | " of IRQ resources: %d\n", PNP_MAX_IRQ); | |
99 | warned = 1; | |
100 | } | |
dbed12da | 101 | return; |
a7839e96 | 102 | } |
61fd47e0 SL |
103 | /* |
104 | * in IO-APIC mode, use overrided attribute. Two reasons: | |
105 | * 1. BIOS bug in DSDT | |
106 | * 2. BIOS uses IO-APIC mode Interrupt Source Override | |
107 | */ | |
108 | if (!acpi_get_override_irq(gsi, &t, &p)) { | |
109 | t = t ? ACPI_LEVEL_SENSITIVE : ACPI_EDGE_SENSITIVE; | |
110 | p = p ? ACPI_ACTIVE_LOW : ACPI_ACTIVE_HIGH; | |
111 | ||
112 | if (triggering != t || polarity != p) { | |
113 | pnp_warn("IRQ %d override to %s, %s", | |
114 | gsi, t ? "edge":"level", p ? "low":"high"); | |
115 | triggering = t; | |
116 | polarity = p; | |
117 | } | |
118 | } | |
119 | ||
9dd78466 | 120 | res->irq_resource[i].flags = IORESOURCE_IRQ; // Also clears _UNSET flag |
cd7ec927 | 121 | res->irq_resource[i].flags |= irq_flags(triggering, polarity, shareable); |
50eca3eb | 122 | irq = acpi_register_gsi(gsi, triggering, polarity); |
dbed12da BH |
123 | if (irq < 0) { |
124 | res->irq_resource[i].flags |= IORESOURCE_DISABLED; | |
125 | return; | |
1da177e4 | 126 | } |
dbed12da BH |
127 | |
128 | res->irq_resource[i].start = irq; | |
129 | res->irq_resource[i].end = irq; | |
130 | pcibios_penalize_isa_irq(irq, 1); | |
1da177e4 LT |
131 | } |
132 | ||
362ea087 MK |
133 | static int dma_flags(int type, int bus_master, int transfer) |
134 | { | |
135 | int flags = 0; | |
136 | ||
137 | if (bus_master) | |
138 | flags |= IORESOURCE_DMA_MASTER; | |
139 | switch (type) { | |
140 | case ACPI_COMPATIBILITY: | |
141 | flags |= IORESOURCE_DMA_COMPATIBLE; | |
142 | break; | |
143 | case ACPI_TYPE_A: | |
144 | flags |= IORESOURCE_DMA_TYPEA; | |
145 | break; | |
146 | case ACPI_TYPE_B: | |
147 | flags |= IORESOURCE_DMA_TYPEB; | |
148 | break; | |
149 | case ACPI_TYPE_F: | |
150 | flags |= IORESOURCE_DMA_TYPEF; | |
151 | break; | |
152 | default: | |
153 | /* Set a default value ? */ | |
154 | flags |= IORESOURCE_DMA_COMPATIBLE; | |
155 | pnp_err("Invalid DMA type"); | |
156 | } | |
157 | switch (transfer) { | |
158 | case ACPI_TRANSFER_8: | |
159 | flags |= IORESOURCE_DMA_8BIT; | |
160 | break; | |
161 | case ACPI_TRANSFER_8_16: | |
162 | flags |= IORESOURCE_DMA_8AND16BIT; | |
163 | break; | |
164 | case ACPI_TRANSFER_16: | |
165 | flags |= IORESOURCE_DMA_16BIT; | |
166 | break; | |
167 | default: | |
168 | /* Set a default value ? */ | |
169 | flags |= IORESOURCE_DMA_8AND16BIT; | |
170 | pnp_err("Invalid DMA transfer type"); | |
171 | } | |
172 | ||
173 | return flags; | |
174 | } | |
175 | ||
4ab55d8d | 176 | static void pnpacpi_parse_allocated_dmaresource(struct pnp_dev *dev, |
bb84b41d | 177 | u32 dma, int flags) |
1da177e4 | 178 | { |
4ab55d8d | 179 | struct pnp_resource_table *res = &dev->res; |
1da177e4 | 180 | int i = 0; |
66a21736 | 181 | static unsigned char warned; |
07d4e9af | 182 | |
0dec63ba | 183 | while (i < PNP_MAX_DMA && |
9dd78466 | 184 | !(res->dma_resource[i].flags & IORESOURCE_UNSET)) |
1da177e4 LT |
185 | i++; |
186 | if (i < PNP_MAX_DMA) { | |
9dd78466 | 187 | res->dma_resource[i].flags = IORESOURCE_DMA; // Also clears _UNSET flag |
bb84b41d | 188 | res->dma_resource[i].flags |= flags; |
1da177e4 LT |
189 | if (dma == -1) { |
190 | res->dma_resource[i].flags |= IORESOURCE_DISABLED; | |
191 | return; | |
192 | } | |
dbed12da BH |
193 | res->dma_resource[i].start = dma; |
194 | res->dma_resource[i].end = dma; | |
66a21736 | 195 | } else if (!warned) { |
33fd7afd | 196 | printk(KERN_WARNING "pnpacpi: exceeded the max number of DMA " |
a7839e96 | 197 | "resources: %d \n", PNP_MAX_DMA); |
66a21736 | 198 | warned = 1; |
1da177e4 LT |
199 | } |
200 | } | |
201 | ||
4ab55d8d | 202 | static void pnpacpi_parse_allocated_ioresource(struct pnp_dev *dev, |
07d4e9af | 203 | u64 io, u64 len, int io_decode) |
1da177e4 | 204 | { |
4ab55d8d | 205 | struct pnp_resource_table *res = &dev->res; |
1da177e4 | 206 | int i = 0; |
66a21736 | 207 | static unsigned char warned; |
07d4e9af | 208 | |
1da177e4 | 209 | while (!(res->port_resource[i].flags & IORESOURCE_UNSET) && |
9dd78466 | 210 | i < PNP_MAX_PORT) |
1da177e4 LT |
211 | i++; |
212 | if (i < PNP_MAX_PORT) { | |
9dd78466 | 213 | res->port_resource[i].flags = IORESOURCE_IO; // Also clears _UNSET flag |
362ea087 MK |
214 | if (io_decode == ACPI_DECODE_16) |
215 | res->port_resource[i].flags |= PNP_PORT_FLAG_16BITADDR; | |
9dd78466 | 216 | if (len <= 0 || (io + len - 1) >= 0x10003) { |
1da177e4 LT |
217 | res->port_resource[i].flags |= IORESOURCE_DISABLED; |
218 | return; | |
219 | } | |
dbed12da BH |
220 | res->port_resource[i].start = io; |
221 | res->port_resource[i].end = io + len - 1; | |
66a21736 | 222 | } else if (!warned) { |
33fd7afd | 223 | printk(KERN_WARNING "pnpacpi: exceeded the max number of IO " |
a7839e96 | 224 | "resources: %d \n", PNP_MAX_PORT); |
efe7cf2d | 225 | warned = 1; |
1da177e4 LT |
226 | } |
227 | } | |
228 | ||
4ab55d8d | 229 | static void pnpacpi_parse_allocated_memresource(struct pnp_dev *dev, |
07d4e9af BH |
230 | u64 mem, u64 len, |
231 | int write_protect) | |
1da177e4 | 232 | { |
4ab55d8d | 233 | struct pnp_resource_table *res = &dev->res; |
1da177e4 | 234 | int i = 0; |
66a21736 | 235 | static unsigned char warned; |
07d4e9af | 236 | |
1da177e4 | 237 | while (!(res->mem_resource[i].flags & IORESOURCE_UNSET) && |
9dd78466 | 238 | (i < PNP_MAX_MEM)) |
1da177e4 LT |
239 | i++; |
240 | if (i < PNP_MAX_MEM) { | |
9dd78466 | 241 | res->mem_resource[i].flags = IORESOURCE_MEM; // Also clears _UNSET flag |
1da177e4 LT |
242 | if (len <= 0) { |
243 | res->mem_resource[i].flags |= IORESOURCE_DISABLED; | |
244 | return; | |
245 | } | |
9dd78466 | 246 | if (write_protect == ACPI_READ_WRITE_MEMORY) |
362ea087 MK |
247 | res->mem_resource[i].flags |= IORESOURCE_MEM_WRITEABLE; |
248 | ||
dbed12da BH |
249 | res->mem_resource[i].start = mem; |
250 | res->mem_resource[i].end = mem + len - 1; | |
66a21736 | 251 | } else if (!warned) { |
33fd7afd | 252 | printk(KERN_WARNING "pnpacpi: exceeded the max number of mem " |
a7839e96 | 253 | "resources: %d\n", PNP_MAX_MEM); |
efe7cf2d | 254 | warned = 1; |
1da177e4 LT |
255 | } |
256 | } | |
257 | ||
4ab55d8d | 258 | static void pnpacpi_parse_allocated_address_space(struct pnp_dev *dev, |
07d4e9af | 259 | struct acpi_resource *res) |
1acfb7f2 BH |
260 | { |
261 | struct acpi_resource_address64 addr, *p = &addr; | |
262 | acpi_status status; | |
263 | ||
264 | status = acpi_resource_to_address64(res, p); | |
265 | if (!ACPI_SUCCESS(status)) { | |
266 | pnp_warn("PnPACPI: failed to convert resource type %d", | |
9dd78466 | 267 | res->type); |
1acfb7f2 BH |
268 | return; |
269 | } | |
270 | ||
2b8de5f5 MC |
271 | if (p->producer_consumer == ACPI_PRODUCER) |
272 | return; | |
273 | ||
1acfb7f2 | 274 | if (p->resource_type == ACPI_MEMORY_RANGE) |
4ab55d8d | 275 | pnpacpi_parse_allocated_memresource(dev, |
07d4e9af BH |
276 | p->minimum, p->address_length, |
277 | p->info.mem.write_protect); | |
1acfb7f2 | 278 | else if (p->resource_type == ACPI_IO_RANGE) |
4ab55d8d | 279 | pnpacpi_parse_allocated_ioresource(dev, |
07d4e9af BH |
280 | p->minimum, p->address_length, |
281 | p->granularity == 0xfff ? ACPI_DECODE_10 : | |
282 | ACPI_DECODE_16); | |
1acfb7f2 | 283 | } |
1da177e4 LT |
284 | |
285 | static acpi_status pnpacpi_allocated_resource(struct acpi_resource *res, | |
9dd78466 | 286 | void *data) |
1da177e4 | 287 | { |
4ab55d8d | 288 | struct pnp_dev *dev = data; |
9570a20e BH |
289 | struct acpi_resource_irq *irq; |
290 | struct acpi_resource_dma *dma; | |
291 | struct acpi_resource_io *io; | |
292 | struct acpi_resource_fixed_io *fixed_io; | |
293 | struct acpi_resource_memory24 *memory24; | |
294 | struct acpi_resource_memory32 *memory32; | |
295 | struct acpi_resource_fixed_memory32 *fixed_memory32; | |
296 | struct acpi_resource_extended_irq *extended_irq; | |
dbed12da | 297 | int i; |
1da177e4 | 298 | |
eca008c8 | 299 | switch (res->type) { |
50eca3eb | 300 | case ACPI_RESOURCE_TYPE_IRQ: |
dbed12da BH |
301 | /* |
302 | * Per spec, only one interrupt per descriptor is allowed in | |
303 | * _CRS, but some firmware violates this, so parse them all. | |
304 | */ | |
9570a20e BH |
305 | irq = &res->data.irq; |
306 | for (i = 0; i < irq->interrupt_count; i++) { | |
4ab55d8d | 307 | pnpacpi_parse_allocated_irqresource(dev, |
9570a20e BH |
308 | irq->interrupts[i], |
309 | irq->triggering, | |
310 | irq->polarity, | |
311 | irq->sharable); | |
1da177e4 LT |
312 | } |
313 | break; | |
314 | ||
50eca3eb | 315 | case ACPI_RESOURCE_TYPE_DMA: |
9570a20e BH |
316 | dma = &res->data.dma; |
317 | if (dma->channel_count > 0) | |
4ab55d8d | 318 | pnpacpi_parse_allocated_dmaresource(dev, |
9570a20e | 319 | dma->channels[0], |
bb84b41d BH |
320 | dma_flags(dma->type, dma->bus_master, |
321 | dma->transfer)); | |
1da177e4 | 322 | break; |
0af5853b | 323 | |
50eca3eb | 324 | case ACPI_RESOURCE_TYPE_IO: |
9570a20e | 325 | io = &res->data.io; |
4ab55d8d | 326 | pnpacpi_parse_allocated_ioresource(dev, |
9570a20e BH |
327 | io->minimum, |
328 | io->address_length, | |
329 | io->io_decode); | |
1da177e4 | 330 | break; |
0af5853b LB |
331 | |
332 | case ACPI_RESOURCE_TYPE_START_DEPENDENT: | |
333 | case ACPI_RESOURCE_TYPE_END_DEPENDENT: | |
334 | break; | |
335 | ||
50eca3eb | 336 | case ACPI_RESOURCE_TYPE_FIXED_IO: |
9570a20e | 337 | fixed_io = &res->data.fixed_io; |
4ab55d8d | 338 | pnpacpi_parse_allocated_ioresource(dev, |
9570a20e BH |
339 | fixed_io->address, |
340 | fixed_io->address_length, | |
07d4e9af | 341 | ACPI_DECODE_10); |
1da177e4 | 342 | break; |
0af5853b LB |
343 | |
344 | case ACPI_RESOURCE_TYPE_VENDOR: | |
345 | break; | |
346 | ||
347 | case ACPI_RESOURCE_TYPE_END_TAG: | |
348 | break; | |
349 | ||
50eca3eb | 350 | case ACPI_RESOURCE_TYPE_MEMORY24: |
9570a20e | 351 | memory24 = &res->data.memory24; |
4ab55d8d | 352 | pnpacpi_parse_allocated_memresource(dev, |
9570a20e BH |
353 | memory24->minimum, |
354 | memory24->address_length, | |
355 | memory24->write_protect); | |
1da177e4 | 356 | break; |
50eca3eb | 357 | case ACPI_RESOURCE_TYPE_MEMORY32: |
9570a20e | 358 | memory32 = &res->data.memory32; |
4ab55d8d | 359 | pnpacpi_parse_allocated_memresource(dev, |
9570a20e BH |
360 | memory32->minimum, |
361 | memory32->address_length, | |
362 | memory32->write_protect); | |
1da177e4 | 363 | break; |
50eca3eb | 364 | case ACPI_RESOURCE_TYPE_FIXED_MEMORY32: |
9570a20e | 365 | fixed_memory32 = &res->data.fixed_memory32; |
4ab55d8d | 366 | pnpacpi_parse_allocated_memresource(dev, |
9570a20e BH |
367 | fixed_memory32->address, |
368 | fixed_memory32->address_length, | |
369 | fixed_memory32->write_protect); | |
1da177e4 | 370 | break; |
50eca3eb | 371 | case ACPI_RESOURCE_TYPE_ADDRESS16: |
50eca3eb | 372 | case ACPI_RESOURCE_TYPE_ADDRESS32: |
50eca3eb | 373 | case ACPI_RESOURCE_TYPE_ADDRESS64: |
4ab55d8d | 374 | pnpacpi_parse_allocated_address_space(dev, res); |
1da177e4 | 375 | break; |
0af5853b LB |
376 | |
377 | case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64: | |
2b8de5f5 MC |
378 | if (res->data.ext_address64.producer_consumer == ACPI_PRODUCER) |
379 | return AE_OK; | |
0af5853b LB |
380 | break; |
381 | ||
382 | case ACPI_RESOURCE_TYPE_EXTENDED_IRQ: | |
9570a20e BH |
383 | extended_irq = &res->data.extended_irq; |
384 | if (extended_irq->producer_consumer == ACPI_PRODUCER) | |
2b8de5f5 MC |
385 | return AE_OK; |
386 | ||
9570a20e | 387 | for (i = 0; i < extended_irq->interrupt_count; i++) { |
4ab55d8d | 388 | pnpacpi_parse_allocated_irqresource(dev, |
9570a20e BH |
389 | extended_irq->interrupts[i], |
390 | extended_irq->triggering, | |
391 | extended_irq->polarity, | |
392 | extended_irq->sharable); | |
0af5853b LB |
393 | } |
394 | break; | |
395 | ||
396 | case ACPI_RESOURCE_TYPE_GENERIC_REGISTER: | |
1da177e4 | 397 | break; |
0af5853b | 398 | |
1da177e4 | 399 | default: |
eca008c8 | 400 | pnp_warn("PnPACPI: unknown resource type %d", res->type); |
1da177e4 LT |
401 | return AE_ERROR; |
402 | } | |
1c6e7d0a | 403 | |
1da177e4 LT |
404 | return AE_OK; |
405 | } | |
406 | ||
4ab55d8d | 407 | acpi_status pnpacpi_parse_allocated_resource(struct pnp_dev *dev) |
1da177e4 | 408 | { |
4ab55d8d BH |
409 | acpi_handle handle = dev->data; |
410 | ||
1da177e4 | 411 | /* Blank the resource table values */ |
4ab55d8d | 412 | pnp_init_resource_table(&dev->res); |
1da177e4 | 413 | |
9dd78466 | 414 | return acpi_walk_resources(handle, METHOD_NAME__CRS, |
4ab55d8d | 415 | pnpacpi_allocated_resource, dev); |
1da177e4 LT |
416 | } |
417 | ||
c1caf06c BH |
418 | static __init void pnpacpi_parse_dma_option(struct pnp_dev *dev, |
419 | struct pnp_option *option, | |
2bb9a6b3 | 420 | struct acpi_resource_dma *p) |
1da177e4 LT |
421 | { |
422 | int i; | |
9dd78466 | 423 | struct pnp_dma *dma; |
1da177e4 | 424 | |
50eca3eb | 425 | if (p->channel_count == 0) |
1da177e4 | 426 | return; |
cd861280 | 427 | dma = kzalloc(sizeof(struct pnp_dma), GFP_KERNEL); |
1da177e4 LT |
428 | if (!dma) |
429 | return; | |
430 | ||
9dd78466 | 431 | for (i = 0; i < p->channel_count; i++) |
1da177e4 | 432 | dma->map |= 1 << p->channels[i]; |
362ea087 MK |
433 | |
434 | dma->flags = dma_flags(p->type, p->bus_master, p->transfer); | |
1da177e4 | 435 | |
c1caf06c | 436 | pnp_register_dma_resource(dev, option, dma); |
1da177e4 LT |
437 | } |
438 | ||
c1caf06c BH |
439 | static __init void pnpacpi_parse_irq_option(struct pnp_dev *dev, |
440 | struct pnp_option *option, | |
2bb9a6b3 | 441 | struct acpi_resource_irq *p) |
1da177e4 LT |
442 | { |
443 | int i; | |
1c6e7d0a BH |
444 | struct pnp_irq *irq; |
445 | ||
50eca3eb | 446 | if (p->interrupt_count == 0) |
1da177e4 | 447 | return; |
cd861280 | 448 | irq = kzalloc(sizeof(struct pnp_irq), GFP_KERNEL); |
1da177e4 LT |
449 | if (!irq) |
450 | return; | |
451 | ||
9dd78466 | 452 | for (i = 0; i < p->interrupt_count; i++) |
1da177e4 LT |
453 | if (p->interrupts[i]) |
454 | __set_bit(p->interrupts[i], irq->map); | |
cd7ec927 | 455 | irq->flags = irq_flags(p->triggering, p->polarity, p->sharable); |
1da177e4 | 456 | |
c1caf06c | 457 | pnp_register_irq_resource(dev, option, irq); |
1da177e4 LT |
458 | } |
459 | ||
c1caf06c BH |
460 | static __init void pnpacpi_parse_ext_irq_option(struct pnp_dev *dev, |
461 | struct pnp_option *option, | |
2bb9a6b3 | 462 | struct acpi_resource_extended_irq *p) |
1da177e4 LT |
463 | { |
464 | int i; | |
1c6e7d0a | 465 | struct pnp_irq *irq; |
1da177e4 | 466 | |
50eca3eb | 467 | if (p->interrupt_count == 0) |
1da177e4 | 468 | return; |
cd861280 | 469 | irq = kzalloc(sizeof(struct pnp_irq), GFP_KERNEL); |
1da177e4 LT |
470 | if (!irq) |
471 | return; | |
472 | ||
9dd78466 | 473 | for (i = 0; i < p->interrupt_count; i++) |
1da177e4 LT |
474 | if (p->interrupts[i]) |
475 | __set_bit(p->interrupts[i], irq->map); | |
cd7ec927 | 476 | irq->flags = irq_flags(p->triggering, p->polarity, p->sharable); |
1da177e4 | 477 | |
c1caf06c | 478 | pnp_register_irq_resource(dev, option, irq); |
1da177e4 LT |
479 | } |
480 | ||
c1caf06c BH |
481 | static __init void pnpacpi_parse_port_option(struct pnp_dev *dev, |
482 | struct pnp_option *option, | |
2bb9a6b3 | 483 | struct acpi_resource_io *io) |
1da177e4 | 484 | { |
1c6e7d0a | 485 | struct pnp_port *port; |
1da177e4 | 486 | |
50eca3eb | 487 | if (io->address_length == 0) |
1da177e4 | 488 | return; |
cd861280 | 489 | port = kzalloc(sizeof(struct pnp_port), GFP_KERNEL); |
1da177e4 LT |
490 | if (!port) |
491 | return; | |
50eca3eb BM |
492 | port->min = io->minimum; |
493 | port->max = io->maximum; | |
1da177e4 | 494 | port->align = io->alignment; |
50eca3eb BM |
495 | port->size = io->address_length; |
496 | port->flags = ACPI_DECODE_16 == io->io_decode ? | |
9dd78466 | 497 | PNP_PORT_FLAG_16BITADDR : 0; |
c1caf06c | 498 | pnp_register_port_resource(dev, option, port); |
1da177e4 LT |
499 | } |
500 | ||
c1caf06c BH |
501 | static __init void pnpacpi_parse_fixed_port_option(struct pnp_dev *dev, |
502 | struct pnp_option *option, | |
2bb9a6b3 | 503 | struct acpi_resource_fixed_io *io) |
1da177e4 | 504 | { |
1c6e7d0a | 505 | struct pnp_port *port; |
1da177e4 | 506 | |
50eca3eb | 507 | if (io->address_length == 0) |
1da177e4 | 508 | return; |
cd861280 | 509 | port = kzalloc(sizeof(struct pnp_port), GFP_KERNEL); |
1da177e4 LT |
510 | if (!port) |
511 | return; | |
50eca3eb BM |
512 | port->min = port->max = io->address; |
513 | port->size = io->address_length; | |
1da177e4 LT |
514 | port->align = 0; |
515 | port->flags = PNP_PORT_FLAG_FIXED; | |
c1caf06c | 516 | pnp_register_port_resource(dev, option, port); |
1da177e4 LT |
517 | } |
518 | ||
c1caf06c BH |
519 | static __init void pnpacpi_parse_mem24_option(struct pnp_dev *dev, |
520 | struct pnp_option *option, | |
2bb9a6b3 | 521 | struct acpi_resource_memory24 *p) |
1da177e4 | 522 | { |
1c6e7d0a | 523 | struct pnp_mem *mem; |
1da177e4 | 524 | |
50eca3eb | 525 | if (p->address_length == 0) |
1da177e4 | 526 | return; |
cd861280 | 527 | mem = kzalloc(sizeof(struct pnp_mem), GFP_KERNEL); |
1da177e4 LT |
528 | if (!mem) |
529 | return; | |
50eca3eb BM |
530 | mem->min = p->minimum; |
531 | mem->max = p->maximum; | |
1da177e4 | 532 | mem->align = p->alignment; |
50eca3eb | 533 | mem->size = p->address_length; |
1da177e4 | 534 | |
0897831b | 535 | mem->flags = (ACPI_READ_WRITE_MEMORY == p->write_protect) ? |
9dd78466 | 536 | IORESOURCE_MEM_WRITEABLE : 0; |
1da177e4 | 537 | |
c1caf06c | 538 | pnp_register_mem_resource(dev, option, mem); |
1da177e4 LT |
539 | } |
540 | ||
c1caf06c BH |
541 | static __init void pnpacpi_parse_mem32_option(struct pnp_dev *dev, |
542 | struct pnp_option *option, | |
2bb9a6b3 | 543 | struct acpi_resource_memory32 *p) |
1da177e4 | 544 | { |
1c6e7d0a | 545 | struct pnp_mem *mem; |
1da177e4 | 546 | |
50eca3eb | 547 | if (p->address_length == 0) |
1da177e4 | 548 | return; |
cd861280 | 549 | mem = kzalloc(sizeof(struct pnp_mem), GFP_KERNEL); |
1da177e4 LT |
550 | if (!mem) |
551 | return; | |
50eca3eb BM |
552 | mem->min = p->minimum; |
553 | mem->max = p->maximum; | |
1da177e4 | 554 | mem->align = p->alignment; |
50eca3eb | 555 | mem->size = p->address_length; |
1da177e4 | 556 | |
0897831b | 557 | mem->flags = (ACPI_READ_WRITE_MEMORY == p->write_protect) ? |
9dd78466 | 558 | IORESOURCE_MEM_WRITEABLE : 0; |
1da177e4 | 559 | |
c1caf06c | 560 | pnp_register_mem_resource(dev, option, mem); |
1da177e4 LT |
561 | } |
562 | ||
c1caf06c BH |
563 | static __init void pnpacpi_parse_fixed_mem32_option(struct pnp_dev *dev, |
564 | struct pnp_option *option, | |
2bb9a6b3 | 565 | struct acpi_resource_fixed_memory32 *p) |
1da177e4 | 566 | { |
1c6e7d0a | 567 | struct pnp_mem *mem; |
1da177e4 | 568 | |
50eca3eb | 569 | if (p->address_length == 0) |
1da177e4 | 570 | return; |
cd861280 | 571 | mem = kzalloc(sizeof(struct pnp_mem), GFP_KERNEL); |
1da177e4 LT |
572 | if (!mem) |
573 | return; | |
50eca3eb BM |
574 | mem->min = mem->max = p->address; |
575 | mem->size = p->address_length; | |
1da177e4 LT |
576 | mem->align = 0; |
577 | ||
0897831b | 578 | mem->flags = (ACPI_READ_WRITE_MEMORY == p->write_protect) ? |
9dd78466 | 579 | IORESOURCE_MEM_WRITEABLE : 0; |
1da177e4 | 580 | |
c1caf06c | 581 | pnp_register_mem_resource(dev, option, mem); |
1da177e4 LT |
582 | } |
583 | ||
c1caf06c BH |
584 | static __init void pnpacpi_parse_address_option(struct pnp_dev *dev, |
585 | struct pnp_option *option, | |
2bb9a6b3 | 586 | struct acpi_resource *r) |
6f957eaf BH |
587 | { |
588 | struct acpi_resource_address64 addr, *p = &addr; | |
589 | acpi_status status; | |
1c6e7d0a BH |
590 | struct pnp_mem *mem; |
591 | struct pnp_port *port; | |
6f957eaf BH |
592 | |
593 | status = acpi_resource_to_address64(r, p); | |
594 | if (!ACPI_SUCCESS(status)) { | |
9dd78466 BH |
595 | pnp_warn("PnPACPI: failed to convert resource type %d", |
596 | r->type); | |
6f957eaf BH |
597 | return; |
598 | } | |
599 | ||
600 | if (p->address_length == 0) | |
601 | return; | |
602 | ||
603 | if (p->resource_type == ACPI_MEMORY_RANGE) { | |
cd861280 | 604 | mem = kzalloc(sizeof(struct pnp_mem), GFP_KERNEL); |
6f957eaf BH |
605 | if (!mem) |
606 | return; | |
ed03f430 | 607 | mem->min = mem->max = p->minimum; |
6f957eaf BH |
608 | mem->size = p->address_length; |
609 | mem->align = 0; | |
ed03f430 | 610 | mem->flags = (p->info.mem.write_protect == |
9dd78466 BH |
611 | ACPI_READ_WRITE_MEMORY) ? IORESOURCE_MEM_WRITEABLE |
612 | : 0; | |
c1caf06c | 613 | pnp_register_mem_resource(dev, option, mem); |
6f957eaf | 614 | } else if (p->resource_type == ACPI_IO_RANGE) { |
cd861280 | 615 | port = kzalloc(sizeof(struct pnp_port), GFP_KERNEL); |
6f957eaf BH |
616 | if (!port) |
617 | return; | |
ed03f430 | 618 | port->min = port->max = p->minimum; |
6f957eaf BH |
619 | port->size = p->address_length; |
620 | port->align = 0; | |
621 | port->flags = PNP_PORT_FLAG_FIXED; | |
c1caf06c | 622 | pnp_register_port_resource(dev, option, port); |
6f957eaf BH |
623 | } |
624 | } | |
625 | ||
1da177e4 LT |
626 | struct acpipnp_parse_option_s { |
627 | struct pnp_option *option; | |
b008b8d7 | 628 | struct pnp_option *option_independent; |
1da177e4 LT |
629 | struct pnp_dev *dev; |
630 | }; | |
631 | ||
2bb9a6b3 TR |
632 | static __init acpi_status pnpacpi_option_resource(struct acpi_resource *res, |
633 | void *data) | |
1da177e4 LT |
634 | { |
635 | int priority = 0; | |
4721a4cc | 636 | struct acpipnp_parse_option_s *parse_data = data; |
1da177e4 LT |
637 | struct pnp_dev *dev = parse_data->dev; |
638 | struct pnp_option *option = parse_data->option; | |
639 | ||
eca008c8 | 640 | switch (res->type) { |
9dd78466 | 641 | case ACPI_RESOURCE_TYPE_IRQ: |
c1caf06c | 642 | pnpacpi_parse_irq_option(dev, option, &res->data.irq); |
9dd78466 | 643 | break; |
0af5853b | 644 | |
9dd78466 | 645 | case ACPI_RESOURCE_TYPE_DMA: |
c1caf06c | 646 | pnpacpi_parse_dma_option(dev, option, &res->data.dma); |
9dd78466 | 647 | break; |
0af5853b | 648 | |
9dd78466 BH |
649 | case ACPI_RESOURCE_TYPE_START_DEPENDENT: |
650 | switch (res->data.start_dpf.compatibility_priority) { | |
651 | case ACPI_GOOD_CONFIGURATION: | |
652 | priority = PNP_RES_PRIORITY_PREFERRED; | |
1da177e4 | 653 | break; |
0af5853b | 654 | |
9dd78466 BH |
655 | case ACPI_ACCEPTABLE_CONFIGURATION: |
656 | priority = PNP_RES_PRIORITY_ACCEPTABLE; | |
b008b8d7 | 657 | break; |
0af5853b | 658 | |
9dd78466 BH |
659 | case ACPI_SUB_OPTIMAL_CONFIGURATION: |
660 | priority = PNP_RES_PRIORITY_FUNCTIONAL; | |
0af5853b | 661 | break; |
9dd78466 BH |
662 | default: |
663 | priority = PNP_RES_PRIORITY_INVALID; | |
0af5853b | 664 | break; |
9dd78466 | 665 | } |
07d4e9af | 666 | /* TBD: Consider performance/robustness bits */ |
9dd78466 BH |
667 | option = pnp_register_dependent_option(dev, priority); |
668 | if (!option) | |
669 | return AE_ERROR; | |
670 | parse_data->option = option; | |
671 | break; | |
0af5853b | 672 | |
9dd78466 BH |
673 | case ACPI_RESOURCE_TYPE_END_DEPENDENT: |
674 | /*only one EndDependentFn is allowed */ | |
675 | if (!parse_data->option_independent) { | |
676 | pnp_warn("PnPACPI: more than one EndDependentFn"); | |
677 | return AE_ERROR; | |
678 | } | |
679 | parse_data->option = parse_data->option_independent; | |
680 | parse_data->option_independent = NULL; | |
c1caf06c | 681 | dev_dbg(&dev->dev, "end dependent options\n"); |
9dd78466 | 682 | break; |
0af5853b | 683 | |
9dd78466 | 684 | case ACPI_RESOURCE_TYPE_IO: |
c1caf06c | 685 | pnpacpi_parse_port_option(dev, option, &res->data.io); |
9dd78466 | 686 | break; |
0af5853b | 687 | |
9dd78466 | 688 | case ACPI_RESOURCE_TYPE_FIXED_IO: |
c1caf06c BH |
689 | pnpacpi_parse_fixed_port_option(dev, option, |
690 | &res->data.fixed_io); | |
9dd78466 | 691 | break; |
0af5853b | 692 | |
9dd78466 BH |
693 | case ACPI_RESOURCE_TYPE_VENDOR: |
694 | case ACPI_RESOURCE_TYPE_END_TAG: | |
695 | break; | |
0af5853b | 696 | |
9dd78466 | 697 | case ACPI_RESOURCE_TYPE_MEMORY24: |
c1caf06c | 698 | pnpacpi_parse_mem24_option(dev, option, &res->data.memory24); |
9dd78466 | 699 | break; |
0af5853b | 700 | |
9dd78466 | 701 | case ACPI_RESOURCE_TYPE_MEMORY32: |
c1caf06c | 702 | pnpacpi_parse_mem32_option(dev, option, &res->data.memory32); |
9dd78466 | 703 | break; |
0af5853b | 704 | |
9dd78466 | 705 | case ACPI_RESOURCE_TYPE_FIXED_MEMORY32: |
c1caf06c | 706 | pnpacpi_parse_fixed_mem32_option(dev, option, |
9dd78466 BH |
707 | &res->data.fixed_memory32); |
708 | break; | |
0af5853b | 709 | |
9dd78466 BH |
710 | case ACPI_RESOURCE_TYPE_ADDRESS16: |
711 | case ACPI_RESOURCE_TYPE_ADDRESS32: | |
712 | case ACPI_RESOURCE_TYPE_ADDRESS64: | |
c1caf06c | 713 | pnpacpi_parse_address_option(dev, option, res); |
9dd78466 | 714 | break; |
0af5853b | 715 | |
9dd78466 BH |
716 | case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64: |
717 | break; | |
718 | ||
719 | case ACPI_RESOURCE_TYPE_EXTENDED_IRQ: | |
c1caf06c BH |
720 | pnpacpi_parse_ext_irq_option(dev, option, |
721 | &res->data.extended_irq); | |
9dd78466 BH |
722 | break; |
723 | ||
724 | case ACPI_RESOURCE_TYPE_GENERIC_REGISTER: | |
725 | break; | |
726 | ||
727 | default: | |
728 | pnp_warn("PnPACPI: unknown resource type %d", res->type); | |
729 | return AE_ERROR; | |
1da177e4 | 730 | } |
1c6e7d0a | 731 | |
1da177e4 LT |
732 | return AE_OK; |
733 | } | |
734 | ||
4ab55d8d | 735 | acpi_status __init pnpacpi_parse_resource_option_data(struct pnp_dev *dev) |
1da177e4 | 736 | { |
4ab55d8d | 737 | acpi_handle handle = dev->data; |
1da177e4 LT |
738 | acpi_status status; |
739 | struct acpipnp_parse_option_s parse_data; | |
740 | ||
741 | parse_data.option = pnp_register_independent_option(dev); | |
742 | if (!parse_data.option) | |
743 | return AE_ERROR; | |
b008b8d7 | 744 | parse_data.option_independent = parse_data.option; |
1da177e4 | 745 | parse_data.dev = dev; |
50eca3eb | 746 | status = acpi_walk_resources(handle, METHOD_NAME__PRS, |
9dd78466 | 747 | pnpacpi_option_resource, &parse_data); |
1da177e4 LT |
748 | |
749 | return status; | |
750 | } | |
751 | ||
b5f2490b | 752 | static int pnpacpi_supported_resource(struct acpi_resource *res) |
1da177e4 | 753 | { |
eca008c8 | 754 | switch (res->type) { |
50eca3eb | 755 | case ACPI_RESOURCE_TYPE_IRQ: |
50eca3eb BM |
756 | case ACPI_RESOURCE_TYPE_DMA: |
757 | case ACPI_RESOURCE_TYPE_IO: | |
758 | case ACPI_RESOURCE_TYPE_FIXED_IO: | |
759 | case ACPI_RESOURCE_TYPE_MEMORY24: | |
760 | case ACPI_RESOURCE_TYPE_MEMORY32: | |
761 | case ACPI_RESOURCE_TYPE_FIXED_MEMORY32: | |
50eca3eb BM |
762 | case ACPI_RESOURCE_TYPE_ADDRESS16: |
763 | case ACPI_RESOURCE_TYPE_ADDRESS32: | |
764 | case ACPI_RESOURCE_TYPE_ADDRESS64: | |
0af5853b | 765 | case ACPI_RESOURCE_TYPE_EXTENDED_IRQ: |
b5f2490b | 766 | return 1; |
1da177e4 | 767 | } |
b5f2490b BH |
768 | return 0; |
769 | } | |
770 | ||
771 | /* | |
772 | * Set resource | |
773 | */ | |
774 | static acpi_status pnpacpi_count_resources(struct acpi_resource *res, | |
9dd78466 | 775 | void *data) |
b5f2490b | 776 | { |
4721a4cc | 777 | int *res_cnt = data; |
b5f2490b BH |
778 | |
779 | if (pnpacpi_supported_resource(res)) | |
780 | (*res_cnt)++; | |
1da177e4 LT |
781 | return AE_OK; |
782 | } | |
783 | ||
1c6e7d0a | 784 | static acpi_status pnpacpi_type_resources(struct acpi_resource *res, void *data) |
1da177e4 | 785 | { |
4721a4cc | 786 | struct acpi_resource **resource = data; |
b5f2490b BH |
787 | |
788 | if (pnpacpi_supported_resource(res)) { | |
eca008c8 | 789 | (*resource)->type = res->type; |
b5f2490b | 790 | (*resource)->length = sizeof(struct acpi_resource); |
1da177e4 | 791 | (*resource)++; |
1da177e4 LT |
792 | } |
793 | ||
794 | return AE_OK; | |
795 | } | |
796 | ||
cdef6254 | 797 | int pnpacpi_build_resource_template(struct pnp_dev *dev, |
9dd78466 | 798 | struct acpi_buffer *buffer) |
1da177e4 | 799 | { |
cdef6254 | 800 | acpi_handle handle = dev->data; |
1da177e4 LT |
801 | struct acpi_resource *resource; |
802 | int res_cnt = 0; | |
803 | acpi_status status; | |
804 | ||
50eca3eb | 805 | status = acpi_walk_resources(handle, METHOD_NAME__CRS, |
9dd78466 | 806 | pnpacpi_count_resources, &res_cnt); |
1da177e4 LT |
807 | if (ACPI_FAILURE(status)) { |
808 | pnp_err("Evaluate _CRS failed"); | |
809 | return -EINVAL; | |
810 | } | |
811 | if (!res_cnt) | |
812 | return -EINVAL; | |
813 | buffer->length = sizeof(struct acpi_resource) * (res_cnt + 1) + 1; | |
cd861280 | 814 | buffer->pointer = kzalloc(buffer->length - 1, GFP_KERNEL); |
1da177e4 LT |
815 | if (!buffer->pointer) |
816 | return -ENOMEM; | |
817 | pnp_dbg("Res cnt %d", res_cnt); | |
818 | resource = (struct acpi_resource *)buffer->pointer; | |
50eca3eb | 819 | status = acpi_walk_resources(handle, METHOD_NAME__CRS, |
9dd78466 | 820 | pnpacpi_type_resources, &resource); |
1da177e4 LT |
821 | if (ACPI_FAILURE(status)) { |
822 | kfree(buffer->pointer); | |
823 | pnp_err("Evaluate _CRS failed"); | |
824 | return -EINVAL; | |
825 | } | |
826 | /* resource will pointer the end resource now */ | |
50eca3eb | 827 | resource->type = ACPI_RESOURCE_TYPE_END_TAG; |
1da177e4 LT |
828 | |
829 | return 0; | |
830 | } | |
831 | ||
50eca3eb | 832 | static void pnpacpi_encode_irq(struct acpi_resource *resource, |
9dd78466 | 833 | struct resource *p) |
1da177e4 | 834 | { |
9570a20e | 835 | struct acpi_resource_irq *irq = &resource->data.irq; |
50eca3eb | 836 | int triggering, polarity; |
1c6e7d0a BH |
837 | |
838 | decode_irq_flags(p->flags & IORESOURCE_BITS, &triggering, &polarity); | |
9570a20e BH |
839 | irq->triggering = triggering; |
840 | irq->polarity = polarity; | |
50eca3eb | 841 | if (triggering == ACPI_EDGE_SENSITIVE) |
9570a20e | 842 | irq->sharable = ACPI_EXCLUSIVE; |
1da177e4 | 843 | else |
9570a20e BH |
844 | irq->sharable = ACPI_SHARED; |
845 | irq->interrupt_count = 1; | |
846 | irq->interrupts[0] = p->start; | |
1da177e4 LT |
847 | } |
848 | ||
849 | static void pnpacpi_encode_ext_irq(struct acpi_resource *resource, | |
9dd78466 | 850 | struct resource *p) |
1da177e4 | 851 | { |
9570a20e | 852 | struct acpi_resource_extended_irq *extended_irq = &resource->data.extended_irq; |
50eca3eb | 853 | int triggering, polarity; |
1c6e7d0a BH |
854 | |
855 | decode_irq_flags(p->flags & IORESOURCE_BITS, &triggering, &polarity); | |
9570a20e BH |
856 | extended_irq->producer_consumer = ACPI_CONSUMER; |
857 | extended_irq->triggering = triggering; | |
858 | extended_irq->polarity = polarity; | |
50eca3eb | 859 | if (triggering == ACPI_EDGE_SENSITIVE) |
9570a20e | 860 | extended_irq->sharable = ACPI_EXCLUSIVE; |
1da177e4 | 861 | else |
9570a20e BH |
862 | extended_irq->sharable = ACPI_SHARED; |
863 | extended_irq->interrupt_count = 1; | |
864 | extended_irq->interrupts[0] = p->start; | |
1da177e4 LT |
865 | } |
866 | ||
867 | static void pnpacpi_encode_dma(struct acpi_resource *resource, | |
9dd78466 | 868 | struct resource *p) |
1da177e4 | 869 | { |
9570a20e BH |
870 | struct acpi_resource_dma *dma = &resource->data.dma; |
871 | ||
1da177e4 | 872 | /* Note: pnp_assign_dma will copy pnp_dma->flags into p->flags */ |
ccc4c7bb | 873 | switch (p->flags & IORESOURCE_DMA_SPEED_MASK) { |
9dd78466 | 874 | case IORESOURCE_DMA_TYPEA: |
9570a20e | 875 | dma->type = ACPI_TYPE_A; |
9dd78466 BH |
876 | break; |
877 | case IORESOURCE_DMA_TYPEB: | |
9570a20e | 878 | dma->type = ACPI_TYPE_B; |
9dd78466 BH |
879 | break; |
880 | case IORESOURCE_DMA_TYPEF: | |
9570a20e | 881 | dma->type = ACPI_TYPE_F; |
9dd78466 BH |
882 | break; |
883 | default: | |
9570a20e | 884 | dma->type = ACPI_COMPATIBILITY; |
ccc4c7bb VP |
885 | } |
886 | ||
887 | switch (p->flags & IORESOURCE_DMA_TYPE_MASK) { | |
9dd78466 | 888 | case IORESOURCE_DMA_8BIT: |
9570a20e | 889 | dma->transfer = ACPI_TRANSFER_8; |
9dd78466 BH |
890 | break; |
891 | case IORESOURCE_DMA_8AND16BIT: | |
9570a20e | 892 | dma->transfer = ACPI_TRANSFER_8_16; |
9dd78466 BH |
893 | break; |
894 | default: | |
9570a20e | 895 | dma->transfer = ACPI_TRANSFER_16; |
ccc4c7bb VP |
896 | } |
897 | ||
9570a20e BH |
898 | dma->bus_master = !!(p->flags & IORESOURCE_DMA_MASTER); |
899 | dma->channel_count = 1; | |
900 | dma->channels[0] = p->start; | |
1da177e4 LT |
901 | } |
902 | ||
903 | static void pnpacpi_encode_io(struct acpi_resource *resource, | |
9dd78466 | 904 | struct resource *p) |
1da177e4 | 905 | { |
9570a20e BH |
906 | struct acpi_resource_io *io = &resource->data.io; |
907 | ||
1da177e4 | 908 | /* Note: pnp_assign_port will copy pnp_port->flags into p->flags */ |
9570a20e | 909 | io->io_decode = (p->flags & PNP_PORT_FLAG_16BITADDR) ? |
9dd78466 | 910 | ACPI_DECODE_16 : ACPI_DECODE_10; |
9570a20e BH |
911 | io->minimum = p->start; |
912 | io->maximum = p->end; | |
913 | io->alignment = 0; /* Correct? */ | |
914 | io->address_length = p->end - p->start + 1; | |
1da177e4 LT |
915 | } |
916 | ||
917 | static void pnpacpi_encode_fixed_io(struct acpi_resource *resource, | |
9dd78466 | 918 | struct resource *p) |
1da177e4 | 919 | { |
9570a20e BH |
920 | struct acpi_resource_fixed_io *fixed_io = &resource->data.fixed_io; |
921 | ||
922 | fixed_io->address = p->start; | |
923 | fixed_io->address_length = p->end - p->start + 1; | |
1da177e4 LT |
924 | } |
925 | ||
926 | static void pnpacpi_encode_mem24(struct acpi_resource *resource, | |
9dd78466 | 927 | struct resource *p) |
1da177e4 | 928 | { |
9570a20e BH |
929 | struct acpi_resource_memory24 *memory24 = &resource->data.memory24; |
930 | ||
1da177e4 | 931 | /* Note: pnp_assign_mem will copy pnp_mem->flags into p->flags */ |
9570a20e | 932 | memory24->write_protect = |
9dd78466 BH |
933 | (p->flags & IORESOURCE_MEM_WRITEABLE) ? |
934 | ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY; | |
9570a20e BH |
935 | memory24->minimum = p->start; |
936 | memory24->maximum = p->end; | |
937 | memory24->alignment = 0; | |
938 | memory24->address_length = p->end - p->start + 1; | |
1da177e4 LT |
939 | } |
940 | ||
941 | static void pnpacpi_encode_mem32(struct acpi_resource *resource, | |
9dd78466 | 942 | struct resource *p) |
1da177e4 | 943 | { |
9570a20e BH |
944 | struct acpi_resource_memory32 *memory32 = &resource->data.memory32; |
945 | ||
946 | memory32->write_protect = | |
9dd78466 BH |
947 | (p->flags & IORESOURCE_MEM_WRITEABLE) ? |
948 | ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY; | |
9570a20e BH |
949 | memory32->minimum = p->start; |
950 | memory32->maximum = p->end; | |
951 | memory32->alignment = 0; | |
952 | memory32->address_length = p->end - p->start + 1; | |
1da177e4 LT |
953 | } |
954 | ||
955 | static void pnpacpi_encode_fixed_mem32(struct acpi_resource *resource, | |
9dd78466 | 956 | struct resource *p) |
1da177e4 | 957 | { |
9570a20e BH |
958 | struct acpi_resource_fixed_memory32 *fixed_memory32 = &resource->data.fixed_memory32; |
959 | ||
960 | fixed_memory32->write_protect = | |
9dd78466 BH |
961 | (p->flags & IORESOURCE_MEM_WRITEABLE) ? |
962 | ACPI_READ_WRITE_MEMORY : ACPI_READ_ONLY_MEMORY; | |
9570a20e BH |
963 | fixed_memory32->address = p->start; |
964 | fixed_memory32->address_length = p->end - p->start + 1; | |
1da177e4 LT |
965 | } |
966 | ||
4ab55d8d | 967 | int pnpacpi_encode_resources(struct pnp_dev *dev, struct acpi_buffer *buffer) |
1da177e4 | 968 | { |
4ab55d8d | 969 | struct pnp_resource_table *res_table = &dev->res; |
1da177e4 LT |
970 | int i = 0; |
971 | /* pnpacpi_build_resource_template allocates extra mem */ | |
9dd78466 | 972 | int res_cnt = (buffer->length - 1) / sizeof(struct acpi_resource) - 1; |
4721a4cc | 973 | struct acpi_resource *resource = buffer->pointer; |
1da177e4 LT |
974 | int port = 0, irq = 0, dma = 0, mem = 0; |
975 | ||
976 | pnp_dbg("res cnt %d", res_cnt); | |
977 | while (i < res_cnt) { | |
9dd78466 | 978 | switch (resource->type) { |
50eca3eb | 979 | case ACPI_RESOURCE_TYPE_IRQ: |
1da177e4 | 980 | pnp_dbg("Encode irq"); |
50eca3eb | 981 | pnpacpi_encode_irq(resource, |
9dd78466 | 982 | &res_table->irq_resource[irq]); |
1da177e4 LT |
983 | irq++; |
984 | break; | |
985 | ||
50eca3eb | 986 | case ACPI_RESOURCE_TYPE_DMA: |
1da177e4 | 987 | pnp_dbg("Encode dma"); |
50eca3eb | 988 | pnpacpi_encode_dma(resource, |
9dd78466 | 989 | &res_table->dma_resource[dma]); |
1c6e7d0a | 990 | dma++; |
1da177e4 | 991 | break; |
50eca3eb | 992 | case ACPI_RESOURCE_TYPE_IO: |
1da177e4 | 993 | pnp_dbg("Encode io"); |
50eca3eb | 994 | pnpacpi_encode_io(resource, |
9dd78466 | 995 | &res_table->port_resource[port]); |
1c6e7d0a | 996 | port++; |
1da177e4 | 997 | break; |
50eca3eb | 998 | case ACPI_RESOURCE_TYPE_FIXED_IO: |
1da177e4 LT |
999 | pnp_dbg("Encode fixed io"); |
1000 | pnpacpi_encode_fixed_io(resource, | |
9dd78466 BH |
1001 | &res_table-> |
1002 | port_resource[port]); | |
1c6e7d0a | 1003 | port++; |
1da177e4 | 1004 | break; |
50eca3eb | 1005 | case ACPI_RESOURCE_TYPE_MEMORY24: |
1da177e4 LT |
1006 | pnp_dbg("Encode mem24"); |
1007 | pnpacpi_encode_mem24(resource, | |
9dd78466 | 1008 | &res_table->mem_resource[mem]); |
1c6e7d0a | 1009 | mem++; |
1da177e4 | 1010 | break; |
50eca3eb | 1011 | case ACPI_RESOURCE_TYPE_MEMORY32: |
1da177e4 LT |
1012 | pnp_dbg("Encode mem32"); |
1013 | pnpacpi_encode_mem32(resource, | |
9dd78466 | 1014 | &res_table->mem_resource[mem]); |
1c6e7d0a | 1015 | mem++; |
1da177e4 | 1016 | break; |
50eca3eb | 1017 | case ACPI_RESOURCE_TYPE_FIXED_MEMORY32: |
1da177e4 LT |
1018 | pnp_dbg("Encode fixed mem32"); |
1019 | pnpacpi_encode_fixed_mem32(resource, | |
9dd78466 BH |
1020 | &res_table-> |
1021 | mem_resource[mem]); | |
1c6e7d0a | 1022 | mem++; |
1da177e4 | 1023 | break; |
0af5853b LB |
1024 | case ACPI_RESOURCE_TYPE_EXTENDED_IRQ: |
1025 | pnp_dbg("Encode ext irq"); | |
1026 | pnpacpi_encode_ext_irq(resource, | |
9dd78466 | 1027 | &res_table->irq_resource[irq]); |
0af5853b LB |
1028 | irq++; |
1029 | break; | |
1030 | case ACPI_RESOURCE_TYPE_START_DEPENDENT: | |
1031 | case ACPI_RESOURCE_TYPE_END_DEPENDENT: | |
1032 | case ACPI_RESOURCE_TYPE_VENDOR: | |
1033 | case ACPI_RESOURCE_TYPE_END_TAG: | |
1034 | case ACPI_RESOURCE_TYPE_ADDRESS16: | |
1035 | case ACPI_RESOURCE_TYPE_ADDRESS32: | |
1036 | case ACPI_RESOURCE_TYPE_ADDRESS64: | |
1037 | case ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64: | |
1038 | case ACPI_RESOURCE_TYPE_GENERIC_REGISTER: | |
9dd78466 | 1039 | default: /* other type */ |
eca008c8 | 1040 | pnp_warn("unknown resource type %d", resource->type); |
1da177e4 LT |
1041 | return -EINVAL; |
1042 | } | |
1c6e7d0a BH |
1043 | resource++; |
1044 | i++; | |
1da177e4 LT |
1045 | } |
1046 | return 0; | |
1047 | } |