1 files changed, 340 insertions, 0 deletions

diff --git a/drivers/acpi/acpica/exfield.c b/drivers/acpi/acpica/exfield.c
new file mode 100644
index 00000000000..7b6df031039
--- /dev/null
+++ b/drivers/acpi/acpica/exfield.c
@@ -0,0 +1,340 @@
+/******************************************************************************
+ *
+ * Module Name: exfield - ACPI AML (p-code) execution - field manipulation
+ *
+ *****************************************************************************/
+
+/*
+ * Copyright (C) 2000 - 2008, Intel Corp.
+ * 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/accommon.h>
+#include <acpi/acdispat.h>
+#include <acpi/acinterp.h>
+
+#define _COMPONENT          ACPI_EXECUTER
+ACPI_MODULE_NAME("exfield")
+
+/*******************************************************************************
+ *
+ * FUNCTION:    acpi_ex_read_data_from_field
+ *
+ * PARAMETERS:  walk_state          - Current execution state
+ *              obj_desc            - The named field
+ *              ret_buffer_desc     - Where the return data object is stored
+ *
+ * RETURN:      Status
+ *
+ * DESCRIPTION: Read from a named field.  Returns either an Integer or a
+ *              Buffer, depending on the size of the field.
+ *
+ ******************************************************************************/
+acpi_status
+acpi_ex_read_data_from_field(struct acpi_walk_state *walk_state,
+                             union acpi_operand_object *obj_desc,
+                             union acpi_operand_object **ret_buffer_desc)
+{
+        acpi_status status;
+        union acpi_operand_object *buffer_desc;
+        acpi_size length;
+        void *buffer;
+
+        ACPI_FUNCTION_TRACE_PTR(ex_read_data_from_field, obj_desc);
+
+        /* Parameter validation */
+
+        if (!obj_desc) {
+                return_ACPI_STATUS(AE_AML_NO_OPERAND);
+        }
+        if (!ret_buffer_desc) {
+                return_ACPI_STATUS(AE_BAD_PARAMETER);
+        }
+
+        if (ACPI_GET_OBJECT_TYPE(obj_desc) == ACPI_TYPE_BUFFER_FIELD) {
+                /*
+                 * If the buffer_field arguments have not been previously evaluated,
+                 * evaluate them now and save the results.
+                 */
+                if (!(obj_desc->common.flags & AOPOBJ_DATA_VALID)) {
+                        status = acpi_ds_get_buffer_field_arguments(obj_desc);
+                        if (ACPI_FAILURE(status)) {
+                                return_ACPI_STATUS(status);
+                        }
+                }
+        } else
+            if ((ACPI_GET_OBJECT_TYPE(obj_desc) == ACPI_TYPE_LOCAL_REGION_FIELD)
+                && (obj_desc->field.region_obj->region.space_id ==
+                    ACPI_ADR_SPACE_SMBUS)) {
+                /*
+                 * This is an SMBus read.  We must create a buffer to hold the data
+                 * and directly access the region handler.
+                 */
+                buffer_desc =
+                    acpi_ut_create_buffer_object(ACPI_SMBUS_BUFFER_SIZE);
+                if (!buffer_desc) {
+                        return_ACPI_STATUS(AE_NO_MEMORY);
+                }
+
+                /* Lock entire transaction if requested */
+
+                acpi_ex_acquire_global_lock(obj_desc->common_field.field_flags);
+
+                /*
+                 * Perform the read.
+                 * Note: Smbus protocol value is passed in upper 16-bits of Function
+                 */
+                status = acpi_ex_access_region(obj_desc, 0,
+                                               ACPI_CAST_PTR(acpi_integer,
+                                                             buffer_desc->
+                                                             buffer.pointer),
+                                               ACPI_READ | (obj_desc->field.
+                                                            attribute << 16));
+                acpi_ex_release_global_lock(obj_desc->common_field.field_flags);
+                goto exit;
+        }
+
+        /*
+         * Allocate a buffer for the contents of the field.
+         *
+         * If the field is larger than the size of an acpi_integer, create
+         * a BUFFER to hold it.  Otherwise, use an INTEGER.  This allows
+         * the use of arithmetic operators on the returned value if the
+         * field size is equal or smaller than an Integer.
+         *
+         * Note: Field.length is in bits.
+         */
+        length =
+            (acpi_size) ACPI_ROUND_BITS_UP_TO_BYTES(obj_desc->field.bit_length);
+        if (length > acpi_gbl_integer_byte_width) {
+
+                /* Field is too large for an Integer, create a Buffer instead */
+
+                buffer_desc = acpi_ut_create_buffer_object(length);
+                if (!buffer_desc) {
+                        return_ACPI_STATUS(AE_NO_MEMORY);
+                }
+                buffer = buffer_desc->buffer.pointer;
+        } else {
+                /* Field will fit within an Integer (normal case) */
+
+                buffer_desc = acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
+                if (!buffer_desc) {
+                        return_ACPI_STATUS(AE_NO_MEMORY);
+                }
+
+                length = acpi_gbl_integer_byte_width;
+                buffer_desc->integer.value = 0;
+                buffer = &buffer_desc->integer.value;
+        }
+
+        ACPI_DEBUG_PRINT((ACPI_DB_BFIELD,
+                          "FieldRead [TO]:   Obj %p, Type %X, Buf %p, ByteLen %X\n",
+                          obj_desc, ACPI_GET_OBJECT_TYPE(obj_desc), buffer,
+                          (u32) length));
+        ACPI_DEBUG_PRINT((ACPI_DB_BFIELD,
+                          "FieldRead [FROM]: BitLen %X, BitOff %X, ByteOff %X\n",
+                          obj_desc->common_field.bit_length,
+                          obj_desc->common_field.start_field_bit_offset,
+                          obj_desc->common_field.base_byte_offset));
+
+        /* Lock entire transaction if requested */
+
+        acpi_ex_acquire_global_lock(obj_desc->common_field.field_flags);
+
+        /* Read from the field */
+
+        status = acpi_ex_extract_from_field(obj_desc, buffer, (u32) length);
+        acpi_ex_release_global_lock(obj_desc->common_field.field_flags);
+
+      exit:
+        if (ACPI_FAILURE(status)) {
+                acpi_ut_remove_reference(buffer_desc);
+        } else {
+                *ret_buffer_desc = buffer_desc;
+        }
+
+        return_ACPI_STATUS(status);
+}
+
+/*******************************************************************************
+ *
+ * FUNCTION:    acpi_ex_write_data_to_field
+ *
+ * PARAMETERS:  source_desc         - Contains data to write
+ *              obj_desc            - The named field
+ *              result_desc         - Where the return value is returned, if any
+ *
+ * RETURN:      Status
+ *
+ * DESCRIPTION: Write to a named field
+ *
+ ******************************************************************************/
+
+acpi_status
+acpi_ex_write_data_to_field(union acpi_operand_object *source_desc,
+                            union acpi_operand_object *obj_desc,
+                            union acpi_operand_object **result_desc)
+{
+        acpi_status status;
+        u32 length;
+        void *buffer;
+        union acpi_operand_object *buffer_desc;
+
+        ACPI_FUNCTION_TRACE_PTR(ex_write_data_to_field, obj_desc);
+
+        /* Parameter validation */
+
+        if (!source_desc || !obj_desc) {
+                return_ACPI_STATUS(AE_AML_NO_OPERAND);
+        }
+
+        if (ACPI_GET_OBJECT_TYPE(obj_desc) == ACPI_TYPE_BUFFER_FIELD) {
+                /*
+                 * If the buffer_field arguments have not been previously evaluated,
+                 * evaluate them now and save the results.
+                 */
+                if (!(obj_desc->common.flags & AOPOBJ_DATA_VALID)) {
+                        status = acpi_ds_get_buffer_field_arguments(obj_desc);
+                        if (ACPI_FAILURE(status)) {
+                                return_ACPI_STATUS(status);
+                        }
+                }
+        } else
+            if ((ACPI_GET_OBJECT_TYPE(obj_desc) == ACPI_TYPE_LOCAL_REGION_FIELD)
+                && (obj_desc->field.region_obj->region.space_id ==
+                    ACPI_ADR_SPACE_SMBUS)) {
+                /*
+                 * This is an SMBus write.  We will bypass the entire field mechanism
+                 * and handoff the buffer directly to the handler.
+                 *
+                 * Source must be a buffer of sufficient size (ACPI_SMBUS_BUFFER_SIZE).
+                 */
+                if (ACPI_GET_OBJECT_TYPE(source_desc) != ACPI_TYPE_BUFFER) {
+                        ACPI_ERROR((AE_INFO,
+                                    "SMBus write requires Buffer, found type %s",
+                                    acpi_ut_get_object_type_name(source_desc)));
+
+                        return_ACPI_STATUS(AE_AML_OPERAND_TYPE);
+                }
+
+                if (source_desc->buffer.length < ACPI_SMBUS_BUFFER_SIZE) {
+                        ACPI_ERROR((AE_INFO,
+                                    "SMBus write requires Buffer of length %X, found length %X",
+                                    ACPI_SMBUS_BUFFER_SIZE,
+                                    source_desc->buffer.length));
+
+                        return_ACPI_STATUS(AE_AML_BUFFER_LIMIT);
+                }
+
+                buffer_desc =
+                    acpi_ut_create_buffer_object(ACPI_SMBUS_BUFFER_SIZE);
+                if (!buffer_desc) {
+                        return_ACPI_STATUS(AE_NO_MEMORY);
+                }
+
+                buffer = buffer_desc->buffer.pointer;
+                ACPI_MEMCPY(buffer, source_desc->buffer.pointer,
+                            ACPI_SMBUS_BUFFER_SIZE);
+
+                /* Lock entire transaction if requested */
+
+                acpi_ex_acquire_global_lock(obj_desc->common_field.field_flags);
+
+                /*
+                 * Perform the write (returns status and perhaps data in the
+                 * same buffer)
+                 * Note: SMBus protocol type is passed in upper 16-bits of Function.
+                 */
+                status = acpi_ex_access_region(obj_desc, 0,
+                                               (acpi_integer *) buffer,
+                                               ACPI_WRITE | (obj_desc->field.
+                                                             attribute << 16));
+                acpi_ex_release_global_lock(obj_desc->common_field.field_flags);
+
+                *result_desc = buffer_desc;
+                return_ACPI_STATUS(status);
+        }
+
+        /* Get a pointer to the data to be written */
+
+        switch (ACPI_GET_OBJECT_TYPE(source_desc)) {
+        case ACPI_TYPE_INTEGER:
+                buffer = &source_desc->integer.value;
+                length = sizeof(source_desc->integer.value);
+                break;
+
+        case ACPI_TYPE_BUFFER:
+                buffer = source_desc->buffer.pointer;
+                length = source_desc->buffer.length;
+                break;
+
+        case ACPI_TYPE_STRING:
+                buffer = source_desc->string.pointer;
+                length = source_desc->string.length;
+                break;
+
+        default:
+                return_ACPI_STATUS(AE_AML_OPERAND_TYPE);
+        }
+
+        ACPI_DEBUG_PRINT((ACPI_DB_BFIELD,
+                          "FieldWrite [FROM]: Obj %p (%s:%X), Buf %p, ByteLen %X\n",
+                          source_desc,
+                          acpi_ut_get_type_name(ACPI_GET_OBJECT_TYPE
+                                                (source_desc)),
+                          ACPI_GET_OBJECT_TYPE(source_desc), buffer, length));
+
+        ACPI_DEBUG_PRINT((ACPI_DB_BFIELD,
+                          "FieldWrite [TO]:   Obj %p (%s:%X), BitLen %X, BitOff %X, ByteOff %X\n",
+                          obj_desc,
+                          acpi_ut_get_type_name(ACPI_GET_OBJECT_TYPE(obj_desc)),
+                          ACPI_GET_OBJECT_TYPE(obj_desc),
+                          obj_desc->common_field.bit_length,
+                          obj_desc->common_field.start_field_bit_offset,
+                          obj_desc->common_field.base_byte_offset));
+
+        /* Lock entire transaction if requested */
+
+        acpi_ex_acquire_global_lock(obj_desc->common_field.field_flags);
+
+        /* Write to the field */
+
+        status = acpi_ex_insert_into_field(obj_desc, buffer, length);
+        acpi_ex_release_global_lock(obj_desc->common_field.field_flags);
+
+        return_ACPI_STATUS(status);
+}