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