rscreate.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:13k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*******************************************************************************
  2.  *
  3.  * Module Name: rscreate - Create resource lists/tables
  4.  *              $Revision: 36 $
  5.  *
  6.  ******************************************************************************/
  7. /*
  8.  *  Copyright (C) 2000, 2001 R. Byron Moore
  9.  *
  10.  *  This program is free software; you can redistribute it and/or modify
  11.  *  it under the terms of the GNU General Public License as published by
  12.  *  the Free Software Foundation; either version 2 of the License, or
  13.  *  (at your option) any later version.
  14.  *
  15.  *  This program is distributed in the hope that it will be useful,
  16.  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  17.  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18.  *  GNU General Public License for more details.
  19.  *
  20.  *  You should have received a copy of the GNU General Public License
  21.  *  along with this program; if not, write to the Free Software
  22.  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  23.  */
  24. #include "acpi.h"
  25. #include "acresrc.h"
  26. #include "amlcode.h"
  27. #include "acnamesp.h"
  28. #define _COMPONENT          ACPI_RESOURCES
  29.  MODULE_NAME         ("rscreate")
  30. /*******************************************************************************
  31.  *
  32.  * FUNCTION:    Acpi_rs_create_resource_list
  33.  *
  34.  * PARAMETERS:  Byte_stream_buffer      - Pointer to the resource byte stream
  35.  *              Output_buffer           - Pointer to the user's buffer
  36.  *              Output_buffer_length    - Pointer to the size of Output_buffer
  37.  *
  38.  * RETURN:      Status  - AE_OK if okay, else a valid acpi_status code
  39.  *              If Output_buffer is not large enough, Output_buffer_length
  40.  *              indicates how large Output_buffer should be, else it
  41.  *              indicates how may u8 elements of Output_buffer are valid.
  42.  *
  43.  * DESCRIPTION: Takes the byte stream returned from a _CRS, _PRS control method
  44.  *              execution and parses the stream to create a linked list
  45.  *              of device resources.
  46.  *
  47.  ******************************************************************************/
  48. acpi_status
  49. acpi_rs_create_resource_list (
  50. acpi_operand_object     *byte_stream_buffer,
  51. u8                      *output_buffer,
  52. u32                     *output_buffer_length)
  53. {
  54. acpi_status             status;
  55. u8                      *byte_stream_start;
  56. u32                     list_size_needed = 0;
  57. u32                     byte_stream_buffer_length;
  58. FUNCTION_TRACE ("Rs_create_resource_list");
  59. ACPI_DEBUG_PRINT ((ACPI_DB_INFO, "Byte_stream_buffer = %pn", byte_stream_buffer));
  60. /*
  61.  * Params already validated, so we don't re-validate here
  62.  */
  63. byte_stream_buffer_length = byte_stream_buffer->buffer.length;
  64. byte_stream_start = byte_stream_buffer->buffer.pointer;
  65. /*
  66.  * Pass the Byte_stream_buffer into a module that can calculate
  67.  * the buffer size needed for the linked list
  68.  */
  69. status = acpi_rs_calculate_list_length (byte_stream_start, byte_stream_buffer_length,
  70.  &list_size_needed);
  71. ACPI_DEBUG_PRINT ((ACPI_DB_INFO, "Status=%X List_size_needed=%Xn",
  72. status, list_size_needed));
  73. /*
  74.  * Exit with the error passed back
  75.  */
  76. if (ACPI_FAILURE (status)) {
  77. return_ACPI_STATUS (status);
  78. }
  79. /*
  80.  * If the linked list will fit into the available buffer
  81.  * call to fill in the list
  82.  */
  83. if (list_size_needed <= *output_buffer_length) {
  84. /*
  85.  * Zero out the return buffer before proceeding
  86.  */
  87. MEMSET (output_buffer, 0x00, *output_buffer_length);
  88. status = acpi_rs_byte_stream_to_list (byte_stream_start, byte_stream_buffer_length,
  89.  &output_buffer);
  90. /*
  91.  * Exit with the error passed back
  92.  */
  93. if (ACPI_FAILURE (status)) {
  94. return_ACPI_STATUS (status);
  95. }
  96. ACPI_DEBUG_PRINT ((ACPI_DB_INFO, "Output_buffer = %pn", output_buffer));
  97. }
  98. else {
  99. *output_buffer_length = list_size_needed;
  100. return_ACPI_STATUS (AE_BUFFER_OVERFLOW);
  101. }
  102. *output_buffer_length = list_size_needed;
  103. return_ACPI_STATUS (AE_OK);
  104. }
  105. /*******************************************************************************
  106.  *
  107.  * FUNCTION:    Acpi_rs_create_pci_routing_table
  108.  *
  109.  * PARAMETERS:  Package_object          - Pointer to an acpi_operand_object
  110.  *                                        package
  111.  *              Output_buffer           - Pointer to the user's buffer
  112.  *              Output_buffer_length    - Size of Output_buffer
  113.  *
  114.  * RETURN:      Status  AE_OK if okay, else a valid acpi_status code.
  115.  *              If the Output_buffer is too small, the error will be
  116.  *              AE_BUFFER_OVERFLOW and Output_buffer_length will point
  117.  *              to the size buffer needed.
  118.  *
  119.  * DESCRIPTION: Takes the acpi_operand_object  package and creates a
  120.  *              linked list of PCI interrupt descriptions
  121.  *
  122.  ******************************************************************************/
  123. acpi_status
  124. acpi_rs_create_pci_routing_table (
  125. acpi_operand_object     *package_object,
  126. u8                      *output_buffer,
  127. u32                     *output_buffer_length)
  128. {
  129. u8                      *buffer = output_buffer;
  130. acpi_operand_object     **top_object_list = NULL;
  131. acpi_operand_object     **sub_object_list = NULL;
  132. acpi_operand_object     *package_element = NULL;
  133. u32                     buffer_size_needed = 0;
  134. u32                     number_of_elements = 0;
  135. u32                     index = 0;
  136. pci_routing_table       *user_prt = NULL;
  137. acpi_namespace_node     *node;
  138. acpi_status             status;
  139. FUNCTION_TRACE ("Rs_create_pci_routing_table");
  140. /*
  141.  * Params already validated, so we don't re-validate here
  142.  */
  143. status = acpi_rs_calculate_pci_routing_table_length (package_object,
  144.  &buffer_size_needed);
  145. if (!ACPI_SUCCESS(status)) {
  146. return_ACPI_STATUS (status);
  147. }
  148. ACPI_DEBUG_PRINT ((ACPI_DB_INFO, "Buffer_size_needed = %Xn", buffer_size_needed));
  149. /*
  150.  * If the data will fit into the available buffer
  151.  * call to fill in the list
  152.  */
  153. if (buffer_size_needed <= *output_buffer_length) {
  154. /*
  155.  * Zero out the return buffer before proceeding
  156.  */
  157. MEMSET (output_buffer, 0x00, *output_buffer_length);
  158. /*
  159.  * Loop through the ACPI_INTERNAL_OBJECTS - Each object should
  160.  * contain a u32 Address, a u8 Pin, a Name and a u8
  161.  * Source_index.
  162.  */
  163. top_object_list     = package_object->package.elements;
  164. number_of_elements  = package_object->package.count;
  165. user_prt            = (pci_routing_table *) buffer;
  166. buffer = ROUND_PTR_UP_TO_8 (buffer, u8);
  167. for (index = 0; index < number_of_elements; index++) {
  168. /*
  169.  * Point User_prt past this current structure
  170.  *
  171.  * NOTE: On the first iteration, User_prt->Length will
  172.  * be zero because we cleared the return buffer earlier
  173.  */
  174. buffer += user_prt->length;
  175. user_prt = (pci_routing_table *) buffer;
  176. /*
  177.  * Fill in the Length field with the information we
  178.  * have at this point.
  179.  * The minus four is to subtract the size of the
  180.  * u8 Source[4] member because it is added below.
  181.  */
  182. user_prt->length = (sizeof (pci_routing_table) -4);
  183. /*
  184.  * Dereference the sub-package
  185.  */
  186. package_element = *top_object_list;
  187. /*
  188.  * The Sub_object_list will now point to an array of
  189.  * the four IRQ elements: Address, Pin, Source and
  190.  * Source_index
  191.  */
  192. sub_object_list = package_element->package.elements;
  193. /*
  194.  * 1) First subobject:  Dereference the Address
  195.  */
  196. if (ACPI_TYPE_INTEGER == (*sub_object_list)->common.type) {
  197. user_prt->address = (*sub_object_list)->integer.value;
  198. }
  199. else {
  200. ACPI_DEBUG_PRINT ((ACPI_DB_ERROR, "Need Integer, found %sn",
  201. acpi_ut_get_type_name ((*sub_object_list)->common.type)));
  202. return_ACPI_STATUS (AE_BAD_DATA);
  203. }
  204. /*
  205.  * 2) Second subobject: Dereference the Pin
  206.  */
  207. sub_object_list++;
  208. if (ACPI_TYPE_INTEGER == (*sub_object_list)->common.type) {
  209. user_prt->pin = (u32) (*sub_object_list)->integer.value;
  210. }
  211. else {
  212. ACPI_DEBUG_PRINT ((ACPI_DB_ERROR, "Need Integer, found %sn",
  213. acpi_ut_get_type_name ((*sub_object_list)->common.type)));
  214. return_ACPI_STATUS (AE_BAD_DATA);
  215. }
  216. /*
  217.  * 3) Third subobject: Dereference the Source Name
  218.  */
  219. sub_object_list++;
  220. switch ((*sub_object_list)->common.type) {
  221. case INTERNAL_TYPE_REFERENCE:
  222. if ((*sub_object_list)->reference.opcode != AML_INT_NAMEPATH_OP) {
  223.    ACPI_DEBUG_PRINT ((ACPI_DB_ERROR, "Need name, found reference op %Xn",
  224. (*sub_object_list)->reference.opcode));
  225. return_ACPI_STATUS (AE_BAD_DATA);
  226. }
  227. node = (*sub_object_list)->reference.node;
  228. /* TBD: use *remaining* length of the buffer! */
  229. status = acpi_ns_handle_to_pathname ((acpi_handle *) node,
  230.  output_buffer_length, user_prt->source);
  231. user_prt->length += STRLEN (user_prt->source) + 1; /* include null terminator */
  232. break;
  233. case ACPI_TYPE_STRING:
  234. STRCPY (user_prt->source,
  235.   (*sub_object_list)->string.pointer);
  236. /*
  237.  * Add to the Length field the length of the string
  238.  */
  239. user_prt->length += (*sub_object_list)->string.length;
  240. break;
  241. case ACPI_TYPE_INTEGER:
  242. /*
  243.  * If this is a number, then the Source Name
  244.  * is NULL, since the entire buffer was zeroed
  245.  * out, we can leave this alone.
  246.  */
  247. /*
  248.  * Add to the Length field the length of
  249.  * the u32 NULL
  250.  */
  251. user_prt->length += sizeof (u32);
  252. break;
  253. default:
  254.    ACPI_DEBUG_PRINT ((ACPI_DB_ERROR, "Need Integer, found %sn",
  255. acpi_ut_get_type_name ((*sub_object_list)->common.type)));
  256.    return_ACPI_STATUS (AE_BAD_DATA);
  257.    break;
  258. }
  259. /* Now align the current length */
  260. user_prt->length = ROUND_UP_TO_64_bITS (user_prt->length);
  261. /*
  262.  * 4) Fourth subobject: Dereference the Source Index
  263.  */
  264. sub_object_list++;
  265. if (ACPI_TYPE_INTEGER == (*sub_object_list)->common.type) {
  266. user_prt->source_index = (u32) (*sub_object_list)->integer.value;
  267. }
  268. else {
  269. ACPI_DEBUG_PRINT ((ACPI_DB_ERROR, "Need Integer, found %sn",
  270. acpi_ut_get_type_name ((*sub_object_list)->common.type)));
  271. return_ACPI_STATUS (AE_BAD_DATA);
  272. }
  273. /*
  274.  * Point to the next acpi_operand_object
  275.  */
  276. top_object_list++;
  277. }
  278. ACPI_DEBUG_PRINT ((ACPI_DB_INFO, "Output_buffer = %pn", output_buffer));
  279. }
  280. else {
  281. *output_buffer_length = buffer_size_needed;
  282. return_ACPI_STATUS (AE_BUFFER_OVERFLOW);
  283. }
  284. /*
  285.  * Report the amount of buffer used
  286.  */
  287. *output_buffer_length = buffer_size_needed;
  288. return_ACPI_STATUS (AE_OK);
  289. }
  290. /*******************************************************************************
  291.  *
  292.  * FUNCTION:    Acpi_rs_create_byte_stream
  293.  *
  294.  * PARAMETERS:  Linked_list_buffer      - Pointer to the resource linked list
  295.  *              Output_buffer           - Pointer to the user's buffer
  296.  *              Output_buffer_length    - Size of Output_buffer
  297.  *
  298.  * RETURN:      Status  AE_OK if okay, else a valid acpi_status code.
  299.  *              If the Output_buffer is too small, the error will be
  300.  *              AE_BUFFER_OVERFLOW and Output_buffer_length will point
  301.  *              to the size buffer needed.
  302.  *
  303.  * DESCRIPTION: Takes the linked list of device resources and
  304.  *              creates a bytestream to be used as input for the
  305.  *              _SRS control method.
  306.  *
  307.  ******************************************************************************/
  308. acpi_status
  309. acpi_rs_create_byte_stream (
  310. acpi_resource           *linked_list_buffer,
  311. u8                      *output_buffer,
  312. u32                     *output_buffer_length)
  313. {
  314. acpi_status             status;
  315. u32                     byte_stream_size_needed = 0;
  316. FUNCTION_TRACE ("Rs_create_byte_stream");
  317. ACPI_DEBUG_PRINT ((ACPI_DB_INFO, "Linked_list_buffer = %pn", linked_list_buffer));
  318. /*
  319.  * Params already validated, so we don't re-validate here
  320.  *
  321.  * Pass the Linked_list_buffer into a module that can calculate
  322.  * the buffer size needed for the byte stream.
  323.  */
  324. status = acpi_rs_calculate_byte_stream_length (linked_list_buffer,
  325.  &byte_stream_size_needed);
  326. ACPI_DEBUG_PRINT ((ACPI_DB_INFO, "Byte_stream_size_needed=%X, %sn",
  327. byte_stream_size_needed, acpi_format_exception (status)));
  328. /*
  329.  * Exit with the error passed back
  330.  */
  331. if (ACPI_FAILURE (status)) {
  332. return_ACPI_STATUS (status);
  333. }
  334. /*
  335.  * If the linked list will fit into the available buffer
  336.  * call to fill in the list
  337.  */
  338. if (byte_stream_size_needed <= *output_buffer_length) {
  339. /*
  340.  * Zero out the return buffer before proceeding
  341.  */
  342. MEMSET (output_buffer, 0x00, *output_buffer_length);
  343. status = acpi_rs_list_to_byte_stream (linked_list_buffer, byte_stream_size_needed,
  344.  &output_buffer);
  345. /*
  346.  * Exit with the error passed back
  347.  */
  348. if (ACPI_FAILURE (status)) {
  349. return_ACPI_STATUS (status);
  350. }
  351. ACPI_DEBUG_PRINT ((ACPI_DB_INFO, "Output_buffer = %pn", output_buffer));
  352. }
  353. else {
  354. *output_buffer_length = byte_stream_size_needed;
  355. return_ACPI_STATUS (AE_BUFFER_OVERFLOW);
  356. }
  357. return_ACPI_STATUS (AE_OK);
  358. }