7d6481d9fbecded65bbeb2137bf718cd6ea18c64
[sfrench/cifs-2.6.git] / drivers / acpi / resources / rscalc.c
1 /*******************************************************************************
2  *
3  * Module Name: rscalc - Calculate stream and list lengths
4  *
5  ******************************************************************************/
6
7 /*
8  * Copyright (C) 2000 - 2006, R. Byron Moore
9  * All rights reserved.
10  *
11  * Redistribution and use in source and binary forms, with or without
12  * modification, are permitted provided that the following conditions
13  * are met:
14  * 1. Redistributions of source code must retain the above copyright
15  *    notice, this list of conditions, and the following disclaimer,
16  *    without modification.
17  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
18  *    substantially similar to the "NO WARRANTY" disclaimer below
19  *    ("Disclaimer") and any redistribution must be conditioned upon
20  *    including a substantially similar Disclaimer requirement for further
21  *    binary redistribution.
22  * 3. Neither the names of the above-listed copyright holders nor the names
23  *    of any contributors may be used to endorse or promote products derived
24  *    from this software without specific prior written permission.
25  *
26  * Alternatively, this software may be distributed under the terms of the
27  * GNU General Public License ("GPL") version 2 as published by the Free
28  * Software Foundation.
29  *
30  * NO WARRANTY
31  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
32  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
33  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
34  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
35  * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
36  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
37  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
38  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
39  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
40  * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
41  * POSSIBILITY OF SUCH DAMAGES.
42  */
43
44 #include <acpi/acpi.h>
45 #include <acpi/acresrc.h>
46 #include <acpi/amlcode.h>
47 #include <acpi/acnamesp.h>
48
49 #define _COMPONENT          ACPI_RESOURCES
50 ACPI_MODULE_NAME("rscalc")
51
52 /* Local prototypes */
53 static u8 acpi_rs_count_set_bits(u16 bit_field);
54
55 static acpi_rs_length
56 acpi_rs_struct_option_length(struct acpi_resource_source *resource_source);
57
58 static u32
59 acpi_rs_stream_option_length(u32 resource_length, u32 minimum_total_length);
60
61 /*******************************************************************************
62  *
63  * FUNCTION:    acpi_rs_count_set_bits
64  *
65  * PARAMETERS:  bit_field       - Field in which to count bits
66  *
67  * RETURN:      Number of bits set within the field
68  *
69  * DESCRIPTION: Count the number of bits set in a resource field. Used for
70  *              (Short descriptor) interrupt and DMA lists.
71  *
72  ******************************************************************************/
73
74 static u8 acpi_rs_count_set_bits(u16 bit_field)
75 {
76         u8 bits_set;
77
78         ACPI_FUNCTION_ENTRY();
79
80         for (bits_set = 0; bit_field; bits_set++) {
81                 /* Zero the least significant bit that is set */
82
83                 bit_field &= (bit_field - 1);
84         }
85
86         return (bits_set);
87 }
88
89 /*******************************************************************************
90  *
91  * FUNCTION:    acpi_rs_struct_option_length
92  *
93  * PARAMETERS:  resource_source     - Pointer to optional descriptor field
94  *
95  * RETURN:      Status
96  *
97  * DESCRIPTION: Common code to handle optional resource_source_index and
98  *              resource_source fields in some Large descriptors. Used during
99  *              list-to-stream conversion
100  *
101  ******************************************************************************/
102
103 static acpi_rs_length
104 acpi_rs_struct_option_length(struct acpi_resource_source *resource_source)
105 {
106         ACPI_FUNCTION_ENTRY();
107
108         /*
109          * If the resource_source string is valid, return the size of the string
110          * (string_length includes the NULL terminator) plus the size of the
111          * resource_source_index (1).
112          */
113         if (resource_source->string_ptr) {
114                 return ((acpi_rs_length) (resource_source->string_length + 1));
115         }
116
117         return (0);
118 }
119
120 /*******************************************************************************
121  *
122  * FUNCTION:    acpi_rs_stream_option_length
123  *
124  * PARAMETERS:  resource_length     - Length from the resource header
125  *              minimum_total_length - Minimum length of this resource, before
126  *                                    any optional fields. Includes header size
127  *
128  * RETURN:      Length of optional string (0 if no string present)
129  *
130  * DESCRIPTION: Common code to handle optional resource_source_index and
131  *              resource_source fields in some Large descriptors. Used during
132  *              stream-to-list conversion
133  *
134  ******************************************************************************/
135
136 static u32
137 acpi_rs_stream_option_length(u32 resource_length,
138                              u32 minimum_aml_resource_length)
139 {
140         u32 string_length = 0;
141
142         ACPI_FUNCTION_ENTRY();
143
144         /*
145          * The resource_source_index and resource_source are optional elements of some
146          * Large-type resource descriptors.
147          */
148
149         /*
150          * If the length of the actual resource descriptor is greater than the ACPI
151          * spec-defined minimum length, it means that a resource_source_index exists
152          * and is followed by a (required) null terminated string. The string length
153          * (including the null terminator) is the resource length minus the minimum
154          * length, minus one byte for the resource_source_index itself.
155          */
156         if (resource_length > minimum_aml_resource_length) {
157                 /* Compute the length of the optional string */
158
159                 string_length =
160                     resource_length - minimum_aml_resource_length - 1;
161         }
162
163         /* Round up length to 32 bits for internal structure alignment */
164
165         return (ACPI_ROUND_UP_to_32_bITS(string_length));
166 }
167
168 /*******************************************************************************
169  *
170  * FUNCTION:    acpi_rs_get_aml_length
171  *
172  * PARAMETERS:  Resource            - Pointer to the resource linked list
173  *              size_needed         - Where the required size is returned
174  *
175  * RETURN:      Status
176  *
177  * DESCRIPTION: Takes a linked list of internal resource descriptors and
178  *              calculates the size buffer needed to hold the corresponding
179  *              external resource byte stream.
180  *
181  ******************************************************************************/
182
183 acpi_status
184 acpi_rs_get_aml_length(struct acpi_resource * resource, acpi_size * size_needed)
185 {
186         acpi_size aml_size_needed = 0;
187         acpi_rs_length total_size;
188
189         ACPI_FUNCTION_TRACE("rs_get_aml_length");
190
191         /* Traverse entire list of internal resource descriptors */
192
193         while (resource) {
194                 /* Validate the descriptor type */
195
196                 if (resource->type > ACPI_RESOURCE_TYPE_MAX) {
197                         return_ACPI_STATUS(AE_AML_INVALID_RESOURCE_TYPE);
198                 }
199
200                 /* Get the base size of the (external stream) resource descriptor */
201
202                 total_size = acpi_gbl_aml_resource_sizes[resource->type];
203
204                 /*
205                  * Augment the base size for descriptors with optional and/or
206                  * variable-length fields
207                  */
208                 switch (resource->type) {
209                 case ACPI_RESOURCE_TYPE_VENDOR:
210                         /*
211                          * Vendor Defined Resource:
212                          * For a Vendor Specific resource, if the Length is between 1 and 7
213                          * it will be created as a Small Resource data type, otherwise it
214                          * is a Large Resource data type.
215                          */
216                         if (resource->data.vendor.byte_length > 7) {
217                                 /* Base size of a Large resource descriptor */
218
219                                 total_size =
220                                     sizeof(struct aml_resource_large_header);
221                         }
222
223                         /* Add the size of the vendor-specific data */
224
225                         total_size = (acpi_rs_length)
226                             (total_size + resource->data.vendor.byte_length);
227                         break;
228
229                 case ACPI_RESOURCE_TYPE_END_TAG:
230                         /*
231                          * End Tag:
232                          * We are done -- return the accumulated total size.
233                          */
234                         *size_needed = aml_size_needed + total_size;
235
236                         /* Normal exit */
237
238                         return_ACPI_STATUS(AE_OK);
239
240                 case ACPI_RESOURCE_TYPE_ADDRESS16:
241                         /*
242                          * 16-Bit Address Resource:
243                          * Add the size of the optional resource_source info
244                          */
245                         total_size = (acpi_rs_length)
246                             (total_size +
247                              acpi_rs_struct_option_length(&resource->data.
248                                                           address16.
249                                                           resource_source));
250                         break;
251
252                 case ACPI_RESOURCE_TYPE_ADDRESS32:
253                         /*
254                          * 32-Bit Address Resource:
255                          * Add the size of the optional resource_source info
256                          */
257                         total_size = (acpi_rs_length)
258                             (total_size +
259                              acpi_rs_struct_option_length(&resource->data.
260                                                           address32.
261                                                           resource_source));
262                         break;
263
264                 case ACPI_RESOURCE_TYPE_ADDRESS64:
265                         /*
266                          * 64-Bit Address Resource:
267                          * Add the size of the optional resource_source info
268                          */
269                         total_size = (acpi_rs_length)
270                             (total_size +
271                              acpi_rs_struct_option_length(&resource->data.
272                                                           address64.
273                                                           resource_source));
274                         break;
275
276                 case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
277                         /*
278                          * Extended IRQ Resource:
279                          * Add the size of each additional optional interrupt beyond the
280                          * required 1 (4 bytes for each u32 interrupt number)
281                          */
282                         total_size = (acpi_rs_length)
283                             (total_size +
284                              ((resource->data.extended_irq.interrupt_count -
285                                1) * 4) +
286                              /* Add the size of the optional resource_source info */
287                              acpi_rs_struct_option_length(&resource->data.
288                                                           extended_irq.
289                                                           resource_source));
290                         break;
291
292                 default:
293                         break;
294                 }
295
296                 /* Update the total */
297
298                 aml_size_needed += total_size;
299
300                 /* Point to the next object */
301
302                 resource =
303                     ACPI_ADD_PTR(struct acpi_resource, resource,
304                                  resource->length);
305         }
306
307         /* Did not find an end_tag resource descriptor */
308
309         return_ACPI_STATUS(AE_AML_NO_RESOURCE_END_TAG);
310 }
311
312 /*******************************************************************************
313  *
314  * FUNCTION:    acpi_rs_get_list_length
315  *
316  * PARAMETERS:  aml_buffer          - Pointer to the resource byte stream
317  *              aml_buffer_length   - Size of aml_buffer
318  *              size_needed         - Where the size needed is returned
319  *
320  * RETURN:      Status
321  *
322  * DESCRIPTION: Takes an external resource byte stream and calculates the size
323  *              buffer needed to hold the corresponding internal resource
324  *              descriptor linked list.
325  *
326  ******************************************************************************/
327
328 acpi_status
329 acpi_rs_get_list_length(u8 * aml_buffer,
330                         u32 aml_buffer_length, acpi_size * size_needed)
331 {
332         acpi_status status;
333         u8 *end_aml;
334         u8 *buffer;
335         u32 buffer_size = 0;
336         u16 temp16;
337         u16 resource_length;
338         u32 extra_struct_bytes;
339         u8 resource_index;
340         u8 minimum_aml_resource_length;
341
342         ACPI_FUNCTION_TRACE("rs_get_list_length");
343
344         end_aml = aml_buffer + aml_buffer_length;
345
346         /* Walk the list of AML resource descriptors */
347
348         while (aml_buffer < end_aml) {
349                 /* Validate the Resource Type and Resource Length */
350
351                 status = acpi_ut_validate_resource(aml_buffer, &resource_index);
352                 if (ACPI_FAILURE(status)) {
353                         return_ACPI_STATUS(status);
354                 }
355
356                 /* Get the resource length and base (minimum) AML size */
357
358                 resource_length = acpi_ut_get_resource_length(aml_buffer);
359                 minimum_aml_resource_length =
360                     acpi_gbl_resource_aml_sizes[resource_index];
361
362                 /*
363                  * Augment the size for descriptors with optional
364                  * and/or variable length fields
365                  */
366                 extra_struct_bytes = 0;
367                 buffer =
368                     aml_buffer + acpi_ut_get_resource_header_length(aml_buffer);
369
370                 switch (acpi_ut_get_resource_type(aml_buffer)) {
371                 case ACPI_RESOURCE_NAME_IRQ:
372                         /*
373                          * IRQ Resource:
374                          * Get the number of bits set in the 16-bit IRQ mask
375                          */
376                         ACPI_MOVE_16_TO_16(&temp16, buffer);
377                         extra_struct_bytes = acpi_rs_count_set_bits(temp16);
378                         break;
379
380                 case ACPI_RESOURCE_NAME_DMA:
381                         /*
382                          * DMA Resource:
383                          * Get the number of bits set in the 8-bit DMA mask
384                          */
385                         extra_struct_bytes = acpi_rs_count_set_bits(*buffer);
386                         break;
387
388                 case ACPI_RESOURCE_NAME_VENDOR_SMALL:
389                         /*
390                          * Vendor Resource:
391                          * Ensure a 32-bit boundary for the structure
392                          */
393                         extra_struct_bytes =
394                             ACPI_ROUND_UP_to_32_bITS(resource_length) -
395                             resource_length;
396                         break;
397
398                 case ACPI_RESOURCE_NAME_END_TAG:
399                         /*
400                          * End Tag: This is the normal exit, add size of end_tag
401                          */
402                         *size_needed = buffer_size + ACPI_RS_SIZE_MIN;
403                         return_ACPI_STATUS(AE_OK);
404
405                 case ACPI_RESOURCE_NAME_VENDOR_LARGE:
406                         /*
407                          * Vendor Resource:
408                          * Add vendor data and ensure a 32-bit boundary for the structure
409                          */
410                         extra_struct_bytes =
411                             ACPI_ROUND_UP_to_32_bITS(resource_length) -
412                             resource_length;
413                         break;
414
415                 case ACPI_RESOURCE_NAME_ADDRESS32:
416                 case ACPI_RESOURCE_NAME_ADDRESS16:
417                         /*
418                          * 32-Bit or 16-bit Address Resource:
419                          * Add the size of any optional data (resource_source)
420                          */
421                         extra_struct_bytes =
422                             acpi_rs_stream_option_length(resource_length,
423                                                          minimum_aml_resource_length);
424                         break;
425
426                 case ACPI_RESOURCE_NAME_EXTENDED_IRQ:
427                         /*
428                          * Extended IRQ:
429                          * Point past the interrupt_vector_flags to get the
430                          * interrupt_table_length.
431                          */
432                         buffer++;
433
434                         extra_struct_bytes =
435                             /*
436                              * Add 4 bytes for each additional interrupt. Note: at
437                              * least one interrupt is required and is included in
438                              * the minimum descriptor size
439                              */
440                             ((*buffer - 1) * sizeof(u32)) +
441                             /* Add the size of any optional data (resource_source) */
442                             acpi_rs_stream_option_length(resource_length -
443                                                          extra_struct_bytes,
444                                                          minimum_aml_resource_length);
445                         break;
446
447                 case ACPI_RESOURCE_NAME_ADDRESS64:
448                         /*
449                          * 64-Bit Address Resource:
450                          * Add the size of any optional data (resource_source)
451                          * Ensure a 64-bit boundary for the structure
452                          */
453                         extra_struct_bytes =
454                             ACPI_ROUND_UP_to_64_bITS
455                             (acpi_rs_stream_option_length
456                              (resource_length, minimum_aml_resource_length));
457                         break;
458
459                 default:
460                         break;
461                 }
462
463                 /* Update the required buffer size for the internal descriptor structs */
464
465                 temp16 = (u16) (acpi_gbl_resource_struct_sizes[resource_index] +
466                                 extra_struct_bytes);
467                 buffer_size += (u32) ACPI_ROUND_UP_TO_NATIVE_WORD(temp16);
468
469                 /*
470                  * Point to the next resource within the stream
471                  * using the size of the header plus the length contained in the header
472                  */
473                 aml_buffer += acpi_ut_get_descriptor_length(aml_buffer);
474         }
475
476         /* Did not find an end_tag resource descriptor */
477
478         return_ACPI_STATUS(AE_AML_NO_RESOURCE_END_TAG);
479 }
480
481 /*******************************************************************************
482  *
483  * FUNCTION:    acpi_rs_get_pci_routing_table_length
484  *
485  * PARAMETERS:  package_object          - Pointer to the package object
486  *              buffer_size_needed      - u32 pointer of the size buffer
487  *                                        needed to properly return the
488  *                                        parsed data
489  *
490  * RETURN:      Status
491  *
492  * DESCRIPTION: Given a package representing a PCI routing table, this
493  *              calculates the size of the corresponding linked list of
494  *              descriptions.
495  *
496  ******************************************************************************/
497
498 acpi_status
499 acpi_rs_get_pci_routing_table_length(union acpi_operand_object *package_object,
500                                      acpi_size * buffer_size_needed)
501 {
502         u32 number_of_elements;
503         acpi_size temp_size_needed = 0;
504         union acpi_operand_object **top_object_list;
505         u32 index;
506         union acpi_operand_object *package_element;
507         union acpi_operand_object **sub_object_list;
508         u8 name_found;
509         u32 table_index;
510
511         ACPI_FUNCTION_TRACE("rs_get_pci_routing_table_length");
512
513         number_of_elements = package_object->package.count;
514
515         /*
516          * Calculate the size of the return buffer.
517          * The base size is the number of elements * the sizes of the
518          * structures.  Additional space for the strings is added below.
519          * The minus one is to subtract the size of the u8 Source[1]
520          * member because it is added below.
521          *
522          * But each PRT_ENTRY structure has a pointer to a string and
523          * the size of that string must be found.
524          */
525         top_object_list = package_object->package.elements;
526
527         for (index = 0; index < number_of_elements; index++) {
528                 /* Dereference the sub-package */
529
530                 package_element = *top_object_list;
531
532                 /*
533                  * The sub_object_list will now point to an array of the
534                  * four IRQ elements: Address, Pin, Source and source_index
535                  */
536                 sub_object_list = package_element->package.elements;
537
538                 /* Scan the irq_table_elements for the Source Name String */
539
540                 name_found = FALSE;
541
542                 for (table_index = 0; table_index < 4 && !name_found;
543                      table_index++) {
544                         if (*sub_object_list && /* Null object allowed */
545                             ((ACPI_TYPE_STRING ==
546                               ACPI_GET_OBJECT_TYPE(*sub_object_list)) ||
547                              ((ACPI_TYPE_LOCAL_REFERENCE ==
548                                ACPI_GET_OBJECT_TYPE(*sub_object_list)) &&
549                               ((*sub_object_list)->reference.opcode ==
550                                AML_INT_NAMEPATH_OP)))) {
551                                 name_found = TRUE;
552                         } else {
553                                 /* Look at the next element */
554
555                                 sub_object_list++;
556                         }
557                 }
558
559                 temp_size_needed += (sizeof(struct acpi_pci_routing_table) - 4);
560
561                 /* Was a String type found? */
562
563                 if (name_found) {
564                         if (ACPI_GET_OBJECT_TYPE(*sub_object_list) ==
565                             ACPI_TYPE_STRING) {
566                                 /*
567                                  * The length String.Length field does not include the
568                                  * terminating NULL, add 1
569                                  */
570                                 temp_size_needed += ((acpi_size)
571                                                      (*sub_object_list)->string.
572                                                      length + 1);
573                         } else {
574                                 temp_size_needed += acpi_ns_get_pathname_length((*sub_object_list)->reference.node);
575                         }
576                 } else {
577                         /*
578                          * If no name was found, then this is a NULL, which is
579                          * translated as a u32 zero.
580                          */
581                         temp_size_needed += sizeof(u32);
582                 }
583
584                 /* Round up the size since each element must be aligned */
585
586                 temp_size_needed = ACPI_ROUND_UP_to_64_bITS(temp_size_needed);
587
588                 /* Point to the next union acpi_operand_object */
589
590                 top_object_list++;
591         }
592
593         /*
594          * Adding an extra element to the end of the list, essentially a
595          * NULL terminator
596          */
597         *buffer_size_needed =
598             temp_size_needed + sizeof(struct acpi_pci_routing_table);
599         return_ACPI_STATUS(AE_OK);
600 }