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