1 files changed, 601 insertions, 0 deletions

diff --git a/drivers/acpi/dispatcher/dsfield.c b/drivers/acpi/dispatcher/dsfield.c
new file mode 100644
index 000000000000..2779211be756
--- /dev/null
+++ b/drivers/acpi/dispatcher/dsfield.c
@@ -0,0 +1,601 @@
+/******************************************************************************
+ *
+ * Module Name: dsfield - Dispatcher field routines
+ *
+ *****************************************************************************/
+
+/*
+ * Copyright (C) 2000 - 2005, R. Byron Moore
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions, and the following disclaimer,
+ *    without modification.
+ * 2. Redistributions in binary form must reproduce at minimum a disclaimer
+ *    substantially similar to the "NO WARRANTY" disclaimer below
+ *    ("Disclaimer") and any redistribution must be conditioned upon
+ *    including a substantially similar Disclaimer requirement for further
+ *    binary redistribution.
+ * 3. Neither the names of the above-listed copyright holders nor the names
+ *    of any contributors may be used to endorse or promote products derived
+ *    from this software without specific prior written permission.
+ *
+ * Alternatively, this software may be distributed under the terms of the
+ * GNU General Public License ("GPL") version 2 as published by the Free
+ * Software Foundation.
+ *
+ * NO WARRANTY
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
+ * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
+ * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
+ * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
+ * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGES.
+ */
+
+
+#include <acpi/acpi.h>
+#include <acpi/amlcode.h>
+#include <acpi/acdispat.h>
+#include <acpi/acinterp.h>
+#include <acpi/acnamesp.h>
+#include <acpi/acparser.h>
+
+
+#define _COMPONENT          ACPI_DISPATCHER
+         ACPI_MODULE_NAME    ("dsfield")
+
+
+/*******************************************************************************
+ *
+ * FUNCTION:    acpi_ds_create_buffer_field
+ *
+ * PARAMETERS:  Opcode              - The opcode to be executed
+ *              Operands            - List of operands for the opcode
+ *              walk_state          - Current state
+ *
+ * RETURN:      Status
+ *
+ * DESCRIPTION: Execute the create_field operators:
+ *              create_bit_field_op,
+ *              create_byte_field_op,
+ *              create_word_field_op,
+ *              create_dword_field_op,
+ *              create_qword_field_op,
+ *              create_field_op     (all of which define fields in buffers)
+ *
+ ******************************************************************************/
+
+acpi_status
+acpi_ds_create_buffer_field (
+        union acpi_parse_object         *op,
+        struct acpi_walk_state          *walk_state)
+{
+        union acpi_parse_object         *arg;
+        struct acpi_namespace_node      *node;
+        acpi_status                     status;
+        union acpi_operand_object       *obj_desc;
+        union acpi_operand_object       *second_desc = NULL;
+        u32                             flags;
+
+
+        ACPI_FUNCTION_TRACE ("ds_create_buffer_field");
+
+
+        /* Get the name_string argument */
+
+        if (op->common.aml_opcode == AML_CREATE_FIELD_OP) {
+                arg = acpi_ps_get_arg (op, 3);
+        }
+        else {
+                /* Create Bit/Byte/Word/Dword field */
+
+                arg = acpi_ps_get_arg (op, 2);
+        }
+
+        if (!arg) {
+                return_ACPI_STATUS (AE_AML_NO_OPERAND);
+        }
+
+        if (walk_state->deferred_node) {
+                node = walk_state->deferred_node;
+                status = AE_OK;
+        }
+        else {
+                /*
+                 * During the load phase, we want to enter the name of the field into
+                 * the namespace.  During the execute phase (when we evaluate the size
+                 * operand), we want to lookup the name
+                 */
+                if (walk_state->parse_flags & ACPI_PARSE_EXECUTE) {
+                        flags = ACPI_NS_NO_UPSEARCH | ACPI_NS_DONT_OPEN_SCOPE;
+                }
+                else {
+                        flags = ACPI_NS_NO_UPSEARCH | ACPI_NS_DONT_OPEN_SCOPE | ACPI_NS_ERROR_IF_FOUND;
+                }
+
+                /*
+                 * Enter the name_string into the namespace
+                 */
+                status = acpi_ns_lookup (walk_state->scope_info, arg->common.value.string,
+                                 ACPI_TYPE_ANY, ACPI_IMODE_LOAD_PASS1,
+                                 flags, walk_state, &(node));
+                if (ACPI_FAILURE (status)) {
+                        ACPI_REPORT_NSERROR (arg->common.value.string, status);
+                        return_ACPI_STATUS (status);
+                }
+        }
+
+        /* We could put the returned object (Node) on the object stack for later, but
+         * for now, we will put it in the "op" object that the parser uses, so we
+         * can get it again at the end of this scope
+         */
+        op->common.node = node;
+
+        /*
+         * If there is no object attached to the node, this node was just created and
+         * we need to create the field object.  Otherwise, this was a lookup of an
+         * existing node and we don't want to create the field object again.
+         */
+        obj_desc = acpi_ns_get_attached_object (node);
+        if (obj_desc) {
+                return_ACPI_STATUS (AE_OK);
+        }
+
+        /*
+         * The Field definition is not fully parsed at this time.
+         * (We must save the address of the AML for the buffer and index operands)
+         */
+
+        /* Create the buffer field object */
+
+        obj_desc = acpi_ut_create_internal_object (ACPI_TYPE_BUFFER_FIELD);
+        if (!obj_desc) {
+                status = AE_NO_MEMORY;
+                goto cleanup;
+        }
+
+        /*
+         * Remember location in AML stream of the field unit
+         * opcode and operands -- since the buffer and index
+         * operands must be evaluated.
+         */
+        second_desc                 = obj_desc->common.next_object;
+        second_desc->extra.aml_start = op->named.data;
+        second_desc->extra.aml_length = op->named.length;
+        obj_desc->buffer_field.node = node;
+
+        /* Attach constructed field descriptors to parent node */
+
+        status = acpi_ns_attach_object (node, obj_desc, ACPI_TYPE_BUFFER_FIELD);
+        if (ACPI_FAILURE (status)) {
+                goto cleanup;
+        }
+
+
+cleanup:
+
+        /* Remove local reference to the object */
+
+        acpi_ut_remove_reference (obj_desc);
+        return_ACPI_STATUS (status);
+}
+
+
+/*******************************************************************************
+ *
+ * FUNCTION:    acpi_ds_get_field_names
+ *
+ * PARAMETERS:  Info            - create_field info structure
+ *  `           walk_state      - Current method state
+ *              Arg             - First parser arg for the field name list
+ *
+ * RETURN:      Status
+ *
+ * DESCRIPTION: Process all named fields in a field declaration.  Names are
+ *              entered into the namespace.
+ *
+ ******************************************************************************/
+
+acpi_status
+acpi_ds_get_field_names (
+        struct acpi_create_field_info   *info,
+        struct acpi_walk_state          *walk_state,
+        union acpi_parse_object         *arg)
+{
+        acpi_status                     status;
+        acpi_integer                    position;
+
+
+        ACPI_FUNCTION_TRACE_PTR ("ds_get_field_names", info);
+
+
+        /* First field starts at bit zero */
+
+        info->field_bit_position = 0;
+
+        /* Process all elements in the field list (of parse nodes) */
+
+        while (arg) {
+                /*
+                 * Three types of field elements are handled:
+                 * 1) Offset - specifies a bit offset
+                 * 2) access_as - changes the access mode
+                 * 3) Name - Enters a new named field into the namespace
+                 */
+                switch (arg->common.aml_opcode) {
+                case AML_INT_RESERVEDFIELD_OP:
+
+                        position = (acpi_integer) info->field_bit_position
+                                         + (acpi_integer) arg->common.value.size;
+
+                        if (position > ACPI_UINT32_MAX) {
+                                ACPI_REPORT_ERROR (("Bit offset within field too large (> 0xFFFFFFFF)\n"));
+                                return_ACPI_STATUS (AE_SUPPORT);
+                        }
+
+                        info->field_bit_position = (u32) position;
+                        break;
+
+
+                case AML_INT_ACCESSFIELD_OP:
+
+                        /*
+                         * Get a new access_type and access_attribute -- to be used for all
+                         * field units that follow, until field end or another access_as keyword.
+                         *
+                         * In field_flags, preserve the flag bits other than the ACCESS_TYPE bits
+                         */
+                        info->field_flags = (u8) ((info->field_flags & ~(AML_FIELD_ACCESS_TYPE_MASK)) |
+                                          ((u8) ((u32) arg->common.value.integer >> 8)));
+
+                        info->attribute = (u8) (arg->common.value.integer);
+                        break;
+
+
+                case AML_INT_NAMEDFIELD_OP:
+
+                        /* Lookup the name */
+
+                        status = acpi_ns_lookup (walk_state->scope_info,
+                                          (char *) &arg->named.name,
+                                          info->field_type, ACPI_IMODE_EXECUTE, ACPI_NS_DONT_OPEN_SCOPE,
+                                          walk_state, &info->field_node);
+                        if (ACPI_FAILURE (status)) {
+                                ACPI_REPORT_NSERROR ((char *) &arg->named.name, status);
+                                if (status != AE_ALREADY_EXISTS) {
+                                        return_ACPI_STATUS (status);
+                                }
+
+                                /* Already exists, ignore error */
+                        }
+                        else {
+                                arg->common.node = info->field_node;
+                                info->field_bit_length = arg->common.value.size;
+
+                                /* Create and initialize an object for the new Field Node */
+
+                                status = acpi_ex_prep_field_value (info);
+                                if (ACPI_FAILURE (status)) {
+                                        return_ACPI_STATUS (status);
+                                }
+                        }
+
+                        /* Keep track of bit position for the next field */
+
+                        position = (acpi_integer) info->field_bit_position
+                                         + (acpi_integer) arg->common.value.size;
+
+                        if (position > ACPI_UINT32_MAX) {
+                                ACPI_REPORT_ERROR (("Field [%4.4s] bit offset too large (> 0xFFFFFFFF)\n",
+                                                (char *) &info->field_node->name));
+                                return_ACPI_STATUS (AE_SUPPORT);
+                        }
+
+                        info->field_bit_position += info->field_bit_length;
+                        break;
+
+
+                default:
+
+                        ACPI_DEBUG_PRINT ((ACPI_DB_ERROR, "Invalid opcode in field list: %X\n",
+                                arg->common.aml_opcode));
+                        return_ACPI_STATUS (AE_AML_BAD_OPCODE);
+                }
+
+                arg = arg->common.next;
+        }
+
+        return_ACPI_STATUS (AE_OK);
+}
+
+
+/*******************************************************************************
+ *
+ * FUNCTION:    acpi_ds_create_field
+ *
+ * PARAMETERS:  Op              - Op containing the Field definition and args
+ *              region_node     - Object for the containing Operation Region
+ *  `           walk_state      - Current method state
+ *
+ * RETURN:      Status
+ *
+ * DESCRIPTION: Create a new field in the specified operation region
+ *
+ ******************************************************************************/
+
+acpi_status
+acpi_ds_create_field (
+        union acpi_parse_object         *op,
+        struct acpi_namespace_node      *region_node,
+        struct acpi_walk_state          *walk_state)
+{
+        acpi_status                     status;
+        union acpi_parse_object         *arg;
+        struct acpi_create_field_info   info;
+
+
+        ACPI_FUNCTION_TRACE_PTR ("ds_create_field", op);
+
+
+        /* First arg is the name of the parent op_region (must already exist) */
+
+        arg = op->common.value.arg;
+        if (!region_node) {
+                status = acpi_ns_lookup (walk_state->scope_info, arg->common.value.name,
+                                  ACPI_TYPE_REGION, ACPI_IMODE_EXECUTE,
+                                  ACPI_NS_SEARCH_PARENT, walk_state, &region_node);
+                if (ACPI_FAILURE (status)) {
+                        ACPI_REPORT_NSERROR (arg->common.value.name, status);
+                        return_ACPI_STATUS (status);
+                }
+        }
+
+        /* Second arg is the field flags */
+
+        arg = arg->common.next;
+        info.field_flags = (u8) arg->common.value.integer;
+        info.attribute = 0;
+
+        /* Each remaining arg is a Named Field */
+
+        info.field_type = ACPI_TYPE_LOCAL_REGION_FIELD;
+        info.region_node = region_node;
+
+        status = acpi_ds_get_field_names (&info, walk_state, arg->common.next);
+
+        return_ACPI_STATUS (status);
+}
+
+
+/*******************************************************************************
+ *
+ * FUNCTION:    acpi_ds_init_field_objects
+ *
+ * PARAMETERS:  Op              - Op containing the Field definition and args
+ *  `           walk_state      - Current method state
+ *
+ * RETURN:      Status
+ *
+ * DESCRIPTION: For each "Field Unit" name in the argument list that is
+ *              part of the field declaration, enter the name into the
+ *              namespace.
+ *
+ ******************************************************************************/
+
+acpi_status
+acpi_ds_init_field_objects (
+        union acpi_parse_object         *op,
+        struct acpi_walk_state          *walk_state)
+{
+        acpi_status                     status;
+        union acpi_parse_object         *arg = NULL;
+        struct acpi_namespace_node      *node;
+        u8                              type = 0;
+
+
+        ACPI_FUNCTION_TRACE_PTR ("ds_init_field_objects", op);
+
+
+        switch (walk_state->opcode) {
+        case AML_FIELD_OP:
+                arg = acpi_ps_get_arg (op, 2);
+                type = ACPI_TYPE_LOCAL_REGION_FIELD;
+                break;
+
+        case AML_BANK_FIELD_OP:
+                arg = acpi_ps_get_arg (op, 4);
+                type = ACPI_TYPE_LOCAL_BANK_FIELD;
+                break;
+
+        case AML_INDEX_FIELD_OP:
+                arg = acpi_ps_get_arg (op, 3);
+                type = ACPI_TYPE_LOCAL_INDEX_FIELD;
+                break;
+
+        default:
+                return_ACPI_STATUS (AE_BAD_PARAMETER);
+        }
+
+        /*
+         * Walk the list of entries in the field_list
+         */
+        while (arg) {
+                /* Ignore OFFSET and ACCESSAS terms here */
+
+                if (arg->common.aml_opcode == AML_INT_NAMEDFIELD_OP) {
+                        status = acpi_ns_lookup (walk_state->scope_info,
+                                          (char *) &arg->named.name,
+                                          type, ACPI_IMODE_LOAD_PASS1,
+                                          ACPI_NS_NO_UPSEARCH | ACPI_NS_DONT_OPEN_SCOPE | ACPI_NS_ERROR_IF_FOUND,
+                                          walk_state, &node);
+                        if (ACPI_FAILURE (status)) {
+                                ACPI_REPORT_NSERROR ((char *) &arg->named.name, status);
+                                if (status != AE_ALREADY_EXISTS) {
+                                        return_ACPI_STATUS (status);
+                                }
+
+                                /* Name already exists, just ignore this error */
+
+                                status = AE_OK;
+                        }
+
+                        arg->common.node = node;
+                }
+
+                /* Move to next field in the list */
+
+                arg = arg->common.next;
+        }
+
+        return_ACPI_STATUS (AE_OK);
+}
+
+
+/*******************************************************************************
+ *
+ * FUNCTION:    acpi_ds_create_bank_field
+ *
+ * PARAMETERS:  Op              - Op containing the Field definition and args
+ *              region_node     - Object for the containing Operation Region
+ *  `           walk_state      - Current method state
+ *
+ * RETURN:      Status
+ *
+ * DESCRIPTION: Create a new bank field in the specified operation region
+ *
+ ******************************************************************************/
+
+acpi_status
+acpi_ds_create_bank_field (
+        union acpi_parse_object         *op,
+        struct acpi_namespace_node      *region_node,
+        struct acpi_walk_state          *walk_state)
+{
+        acpi_status                     status;
+        union acpi_parse_object         *arg;
+        struct acpi_create_field_info   info;
+
+
+        ACPI_FUNCTION_TRACE_PTR ("ds_create_bank_field", op);
+
+
+        /* First arg is the name of the parent op_region (must already exist) */
+
+        arg = op->common.value.arg;
+        if (!region_node) {
+                status = acpi_ns_lookup (walk_state->scope_info, arg->common.value.name,
+                                  ACPI_TYPE_REGION, ACPI_IMODE_EXECUTE,
+                                  ACPI_NS_SEARCH_PARENT, walk_state, &region_node);
+                if (ACPI_FAILURE (status)) {
+                        ACPI_REPORT_NSERROR (arg->common.value.name, status);
+                        return_ACPI_STATUS (status);
+                }
+        }
+
+        /* Second arg is the Bank Register (Field) (must already exist) */
+
+        arg = arg->common.next;
+        status = acpi_ns_lookup (walk_state->scope_info, arg->common.value.string,
+                          ACPI_TYPE_ANY, ACPI_IMODE_EXECUTE,
+                          ACPI_NS_SEARCH_PARENT, walk_state, &info.register_node);
+        if (ACPI_FAILURE (status)) {
+                ACPI_REPORT_NSERROR (arg->common.value.string, status);
+                return_ACPI_STATUS (status);
+        }
+
+        /* Third arg is the bank_value */
+
+        arg = arg->common.next;
+        info.bank_value = (u32) arg->common.value.integer;
+
+        /* Fourth arg is the field flags */
+
+        arg = arg->common.next;
+        info.field_flags = (u8) arg->common.value.integer;
+
+        /* Each remaining arg is a Named Field */
+
+        info.field_type = ACPI_TYPE_LOCAL_BANK_FIELD;
+        info.region_node = region_node;
+
+        status = acpi_ds_get_field_names (&info, walk_state, arg->common.next);
+
+        return_ACPI_STATUS (status);
+}
+
+
+/*******************************************************************************
+ *
+ * FUNCTION:    acpi_ds_create_index_field
+ *
+ * PARAMETERS:  Op              - Op containing the Field definition and args
+ *              region_node     - Object for the containing Operation Region
+ *  `           walk_state      - Current method state
+ *
+ * RETURN:      Status
+ *
+ * DESCRIPTION: Create a new index field in the specified operation region
+ *
+ ******************************************************************************/
+
+acpi_status
+acpi_ds_create_index_field (
+        union acpi_parse_object         *op,
+        struct acpi_namespace_node      *region_node,
+        struct acpi_walk_state          *walk_state)
+{
+        acpi_status                     status;
+        union acpi_parse_object         *arg;
+        struct acpi_create_field_info   info;
+
+
+        ACPI_FUNCTION_TRACE_PTR ("ds_create_index_field", op);
+
+
+        /* First arg is the name of the Index register (must already exist) */
+
+        arg = op->common.value.arg;
+        status = acpi_ns_lookup (walk_state->scope_info, arg->common.value.string,
+                          ACPI_TYPE_ANY, ACPI_IMODE_EXECUTE,
+                          ACPI_NS_SEARCH_PARENT, walk_state, &info.register_node);
+        if (ACPI_FAILURE (status)) {
+                ACPI_REPORT_NSERROR (arg->common.value.string, status);
+                return_ACPI_STATUS (status);
+        }
+
+        /* Second arg is the data register (must already exist) */
+
+        arg = arg->common.next;
+        status = acpi_ns_lookup (walk_state->scope_info, arg->common.value.string,
+                          ACPI_TYPE_ANY, ACPI_IMODE_EXECUTE,
+                          ACPI_NS_SEARCH_PARENT, walk_state, &info.data_register_node);
+        if (ACPI_FAILURE (status)) {
+                ACPI_REPORT_NSERROR (arg->common.value.string, status);
+                return_ACPI_STATUS (status);
+        }
+
+        /* Next arg is the field flags */
+
+        arg = arg->common.next;
+        info.field_flags = (u8) arg->common.value.integer;
+
+        /* Each remaining arg is a Named Field */
+
+        info.field_type = ACPI_TYPE_LOCAL_INDEX_FIELD;
+        info.region_node = region_node;
+
+        status = acpi_ds_get_field_names (&info, walk_state, arg->common.next);
+
+        return_ACPI_STATUS (status);
+}
+
+