17851SDana.Myers@Sun.COM /******************************************************************************
27851SDana.Myers@Sun.COM *
37851SDana.Myers@Sun.COM * Module Name: exfldio - Aml Field I/O
47851SDana.Myers@Sun.COM *
57851SDana.Myers@Sun.COM *****************************************************************************/
67851SDana.Myers@Sun.COM
77851SDana.Myers@Sun.COM /******************************************************************************
87851SDana.Myers@Sun.COM *
97851SDana.Myers@Sun.COM * 1. Copyright Notice
107851SDana.Myers@Sun.COM *
119980SDana.Myers@Sun.COM * Some or all of this work - Copyright (c) 1999 - 2009, Intel Corp.
127851SDana.Myers@Sun.COM * All rights reserved.
137851SDana.Myers@Sun.COM *
147851SDana.Myers@Sun.COM * 2. License
157851SDana.Myers@Sun.COM *
167851SDana.Myers@Sun.COM * 2.1. This is your license from Intel Corp. under its intellectual property
177851SDana.Myers@Sun.COM * rights. You may have additional license terms from the party that provided
187851SDana.Myers@Sun.COM * you this software, covering your right to use that party's intellectual
197851SDana.Myers@Sun.COM * property rights.
207851SDana.Myers@Sun.COM *
217851SDana.Myers@Sun.COM * 2.2. Intel grants, free of charge, to any person ("Licensee") obtaining a
227851SDana.Myers@Sun.COM * copy of the source code appearing in this file ("Covered Code") an
237851SDana.Myers@Sun.COM * irrevocable, perpetual, worldwide license under Intel's copyrights in the
247851SDana.Myers@Sun.COM * base code distributed originally by Intel ("Original Intel Code") to copy,
257851SDana.Myers@Sun.COM * make derivatives, distribute, use and display any portion of the Covered
267851SDana.Myers@Sun.COM * Code in any form, with the right to sublicense such rights; and
277851SDana.Myers@Sun.COM *
287851SDana.Myers@Sun.COM * 2.3. Intel grants Licensee a non-exclusive and non-transferable patent
297851SDana.Myers@Sun.COM * license (with the right to sublicense), under only those claims of Intel
307851SDana.Myers@Sun.COM * patents that are infringed by the Original Intel Code, to make, use, sell,
317851SDana.Myers@Sun.COM * offer to sell, and import the Covered Code and derivative works thereof
327851SDana.Myers@Sun.COM * solely to the minimum extent necessary to exercise the above copyright
337851SDana.Myers@Sun.COM * license, and in no event shall the patent license extend to any additions
347851SDana.Myers@Sun.COM * to or modifications of the Original Intel Code. No other license or right
357851SDana.Myers@Sun.COM * is granted directly or by implication, estoppel or otherwise;
367851SDana.Myers@Sun.COM *
377851SDana.Myers@Sun.COM * The above copyright and patent license is granted only if the following
387851SDana.Myers@Sun.COM * conditions are met:
397851SDana.Myers@Sun.COM *
407851SDana.Myers@Sun.COM * 3. Conditions
417851SDana.Myers@Sun.COM *
427851SDana.Myers@Sun.COM * 3.1. Redistribution of Source with Rights to Further Distribute Source.
437851SDana.Myers@Sun.COM * Redistribution of source code of any substantial portion of the Covered
447851SDana.Myers@Sun.COM * Code or modification with rights to further distribute source must include
457851SDana.Myers@Sun.COM * the above Copyright Notice, the above License, this list of Conditions,
467851SDana.Myers@Sun.COM * and the following Disclaimer and Export Compliance provision. In addition,
477851SDana.Myers@Sun.COM * Licensee must cause all Covered Code to which Licensee contributes to
487851SDana.Myers@Sun.COM * contain a file documenting the changes Licensee made to create that Covered
497851SDana.Myers@Sun.COM * Code and the date of any change. Licensee must include in that file the
507851SDana.Myers@Sun.COM * documentation of any changes made by any predecessor Licensee. Licensee
517851SDana.Myers@Sun.COM * must include a prominent statement that the modification is derived,
527851SDana.Myers@Sun.COM * directly or indirectly, from Original Intel Code.
537851SDana.Myers@Sun.COM *
547851SDana.Myers@Sun.COM * 3.2. Redistribution of Source with no Rights to Further Distribute Source.
557851SDana.Myers@Sun.COM * Redistribution of source code of any substantial portion of the Covered
567851SDana.Myers@Sun.COM * Code or modification without rights to further distribute source must
577851SDana.Myers@Sun.COM * include the following Disclaimer and Export Compliance provision in the
587851SDana.Myers@Sun.COM * documentation and/or other materials provided with distribution. In
597851SDana.Myers@Sun.COM * addition, Licensee may not authorize further sublicense of source of any
607851SDana.Myers@Sun.COM * portion of the Covered Code, and must include terms to the effect that the
617851SDana.Myers@Sun.COM * license from Licensee to its licensee is limited to the intellectual
627851SDana.Myers@Sun.COM * property embodied in the software Licensee provides to its licensee, and
637851SDana.Myers@Sun.COM * not to intellectual property embodied in modifications its licensee may
647851SDana.Myers@Sun.COM * make.
657851SDana.Myers@Sun.COM *
667851SDana.Myers@Sun.COM * 3.3. Redistribution of Executable. Redistribution in executable form of any
677851SDana.Myers@Sun.COM * substantial portion of the Covered Code or modification must reproduce the
687851SDana.Myers@Sun.COM * above Copyright Notice, and the following Disclaimer and Export Compliance
697851SDana.Myers@Sun.COM * provision in the documentation and/or other materials provided with the
707851SDana.Myers@Sun.COM * distribution.
717851SDana.Myers@Sun.COM *
727851SDana.Myers@Sun.COM * 3.4. Intel retains all right, title, and interest in and to the Original
737851SDana.Myers@Sun.COM * Intel Code.
747851SDana.Myers@Sun.COM *
757851SDana.Myers@Sun.COM * 3.5. Neither the name Intel nor any other trademark owned or controlled by
767851SDana.Myers@Sun.COM * Intel shall be used in advertising or otherwise to promote the sale, use or
777851SDana.Myers@Sun.COM * other dealings in products derived from or relating to the Covered Code
787851SDana.Myers@Sun.COM * without prior written authorization from Intel.
797851SDana.Myers@Sun.COM *
807851SDana.Myers@Sun.COM * 4. Disclaimer and Export Compliance
817851SDana.Myers@Sun.COM *
827851SDana.Myers@Sun.COM * 4.1. INTEL MAKES NO WARRANTY OF ANY KIND REGARDING ANY SOFTWARE PROVIDED
837851SDana.Myers@Sun.COM * HERE. ANY SOFTWARE ORIGINATING FROM INTEL OR DERIVED FROM INTEL SOFTWARE
847851SDana.Myers@Sun.COM * IS PROVIDED "AS IS," AND INTEL WILL NOT PROVIDE ANY SUPPORT, ASSISTANCE,
857851SDana.Myers@Sun.COM * INSTALLATION, TRAINING OR OTHER SERVICES. INTEL WILL NOT PROVIDE ANY
867851SDana.Myers@Sun.COM * UPDATES, ENHANCEMENTS OR EXTENSIONS. INTEL SPECIFICALLY DISCLAIMS ANY
877851SDana.Myers@Sun.COM * IMPLIED WARRANTIES OF MERCHANTABILITY, NONINFRINGEMENT AND FITNESS FOR A
887851SDana.Myers@Sun.COM * PARTICULAR PURPOSE.
897851SDana.Myers@Sun.COM *
907851SDana.Myers@Sun.COM * 4.2. IN NO EVENT SHALL INTEL HAVE ANY LIABILITY TO LICENSEE, ITS LICENSEES
917851SDana.Myers@Sun.COM * OR ANY OTHER THIRD PARTY, FOR ANY LOST PROFITS, LOST DATA, LOSS OF USE OR
927851SDana.Myers@Sun.COM * COSTS OF PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES, OR FOR ANY INDIRECT,
937851SDana.Myers@Sun.COM * SPECIAL OR CONSEQUENTIAL DAMAGES ARISING OUT OF THIS AGREEMENT, UNDER ANY
947851SDana.Myers@Sun.COM * CAUSE OF ACTION OR THEORY OF LIABILITY, AND IRRESPECTIVE OF WHETHER INTEL
957851SDana.Myers@Sun.COM * HAS ADVANCE NOTICE OF THE POSSIBILITY OF SUCH DAMAGES. THESE LIMITATIONS
967851SDana.Myers@Sun.COM * SHALL APPLY NOTWITHSTANDING THE FAILURE OF THE ESSENTIAL PURPOSE OF ANY
977851SDana.Myers@Sun.COM * LIMITED REMEDY.
987851SDana.Myers@Sun.COM *
997851SDana.Myers@Sun.COM * 4.3. Licensee shall not export, either directly or indirectly, any of this
1007851SDana.Myers@Sun.COM * software or system incorporating such software without first obtaining any
1017851SDana.Myers@Sun.COM * required license or other approval from the U. S. Department of Commerce or
1027851SDana.Myers@Sun.COM * any other agency or department of the United States Government. In the
1037851SDana.Myers@Sun.COM * event Licensee exports any such software from the United States or
1047851SDana.Myers@Sun.COM * re-exports any such software from a foreign destination, Licensee shall
1057851SDana.Myers@Sun.COM * ensure that the distribution and export/re-export of the software is in
1067851SDana.Myers@Sun.COM * compliance with all laws, regulations, orders, or other restrictions of the
1077851SDana.Myers@Sun.COM * U.S. Export Administration Regulations. Licensee agrees that neither it nor
1087851SDana.Myers@Sun.COM * any of its subsidiaries will export/re-export any technical data, process,
1097851SDana.Myers@Sun.COM * software, or service, directly or indirectly, to any country for which the
1107851SDana.Myers@Sun.COM * United States government or any agency thereof requires an export license,
1117851SDana.Myers@Sun.COM * other governmental approval, or letter of assurance, without first obtaining
1127851SDana.Myers@Sun.COM * such license, approval or letter.
1137851SDana.Myers@Sun.COM *
1147851SDana.Myers@Sun.COM *****************************************************************************/
1157851SDana.Myers@Sun.COM
1167851SDana.Myers@Sun.COM
1177851SDana.Myers@Sun.COM #define __EXFLDIO_C__
1187851SDana.Myers@Sun.COM
1197851SDana.Myers@Sun.COM #include "acpi.h"
1209980SDana.Myers@Sun.COM #include "accommon.h"
1217851SDana.Myers@Sun.COM #include "acinterp.h"
1227851SDana.Myers@Sun.COM #include "amlcode.h"
1237851SDana.Myers@Sun.COM #include "acevents.h"
1247851SDana.Myers@Sun.COM #include "acdispat.h"
1257851SDana.Myers@Sun.COM
1267851SDana.Myers@Sun.COM
1277851SDana.Myers@Sun.COM #define _COMPONENT ACPI_EXECUTER
1287851SDana.Myers@Sun.COM ACPI_MODULE_NAME ("exfldio")
1297851SDana.Myers@Sun.COM
1307851SDana.Myers@Sun.COM /* Local prototypes */
1317851SDana.Myers@Sun.COM
1327851SDana.Myers@Sun.COM static ACPI_STATUS
1337851SDana.Myers@Sun.COM AcpiExFieldDatumIo (
1347851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *ObjDesc,
1357851SDana.Myers@Sun.COM UINT32 FieldDatumByteOffset,
1367851SDana.Myers@Sun.COM ACPI_INTEGER *Value,
1377851SDana.Myers@Sun.COM UINT32 ReadWrite);
1387851SDana.Myers@Sun.COM
1397851SDana.Myers@Sun.COM static BOOLEAN
1407851SDana.Myers@Sun.COM AcpiExRegisterOverflow (
1417851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *ObjDesc,
1427851SDana.Myers@Sun.COM ACPI_INTEGER Value);
1437851SDana.Myers@Sun.COM
1447851SDana.Myers@Sun.COM static ACPI_STATUS
1457851SDana.Myers@Sun.COM AcpiExSetupRegion (
1467851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *ObjDesc,
1477851SDana.Myers@Sun.COM UINT32 FieldDatumByteOffset);
1487851SDana.Myers@Sun.COM
1497851SDana.Myers@Sun.COM
1507851SDana.Myers@Sun.COM /*******************************************************************************
1517851SDana.Myers@Sun.COM *
1527851SDana.Myers@Sun.COM * FUNCTION: AcpiExSetupRegion
1537851SDana.Myers@Sun.COM *
1547851SDana.Myers@Sun.COM * PARAMETERS: ObjDesc - Field to be read or written
1557851SDana.Myers@Sun.COM * FieldDatumByteOffset - Byte offset of this datum within the
1567851SDana.Myers@Sun.COM * parent field
1577851SDana.Myers@Sun.COM *
1587851SDana.Myers@Sun.COM * RETURN: Status
1597851SDana.Myers@Sun.COM *
1607851SDana.Myers@Sun.COM * DESCRIPTION: Common processing for AcpiExExtractFromField and
1617851SDana.Myers@Sun.COM * AcpiExInsertIntoField. Initialize the Region if necessary and
1627851SDana.Myers@Sun.COM * validate the request.
1637851SDana.Myers@Sun.COM *
1647851SDana.Myers@Sun.COM ******************************************************************************/
1657851SDana.Myers@Sun.COM
1667851SDana.Myers@Sun.COM static ACPI_STATUS
AcpiExSetupRegion(ACPI_OPERAND_OBJECT * ObjDesc,UINT32 FieldDatumByteOffset)1677851SDana.Myers@Sun.COM AcpiExSetupRegion (
1687851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *ObjDesc,
1697851SDana.Myers@Sun.COM UINT32 FieldDatumByteOffset)
1707851SDana.Myers@Sun.COM {
1717851SDana.Myers@Sun.COM ACPI_STATUS Status = AE_OK;
1727851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *RgnDesc;
1737851SDana.Myers@Sun.COM
1747851SDana.Myers@Sun.COM
1757851SDana.Myers@Sun.COM ACPI_FUNCTION_TRACE_U32 (ExSetupRegion, FieldDatumByteOffset);
1767851SDana.Myers@Sun.COM
1777851SDana.Myers@Sun.COM
1787851SDana.Myers@Sun.COM RgnDesc = ObjDesc->CommonField.RegionObj;
1797851SDana.Myers@Sun.COM
1807851SDana.Myers@Sun.COM /* We must have a valid region */
1817851SDana.Myers@Sun.COM
1829980SDana.Myers@Sun.COM if (RgnDesc->Common.Type != ACPI_TYPE_REGION)
1837851SDana.Myers@Sun.COM {
1847851SDana.Myers@Sun.COM ACPI_ERROR ((AE_INFO, "Needed Region, found type %X (%s)",
1859980SDana.Myers@Sun.COM RgnDesc->Common.Type,
1867851SDana.Myers@Sun.COM AcpiUtGetObjectTypeName (RgnDesc)));
1877851SDana.Myers@Sun.COM
1887851SDana.Myers@Sun.COM return_ACPI_STATUS (AE_AML_OPERAND_TYPE);
1897851SDana.Myers@Sun.COM }
1907851SDana.Myers@Sun.COM
1917851SDana.Myers@Sun.COM /*
1927851SDana.Myers@Sun.COM * If the Region Address and Length have not been previously evaluated,
1937851SDana.Myers@Sun.COM * evaluate them now and save the results.
1947851SDana.Myers@Sun.COM */
1957851SDana.Myers@Sun.COM if (!(RgnDesc->Common.Flags & AOPOBJ_DATA_VALID))
1967851SDana.Myers@Sun.COM {
1977851SDana.Myers@Sun.COM Status = AcpiDsGetRegionArguments (RgnDesc);
1987851SDana.Myers@Sun.COM if (ACPI_FAILURE (Status))
1997851SDana.Myers@Sun.COM {
2007851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
2017851SDana.Myers@Sun.COM }
2027851SDana.Myers@Sun.COM }
2037851SDana.Myers@Sun.COM
2047851SDana.Myers@Sun.COM /*
205*11225SDana.Myers@Sun.COM * Exit now for SMBus or IPMI address space, it has a non-linear address space
2067851SDana.Myers@Sun.COM * and the request cannot be directly validated
2077851SDana.Myers@Sun.COM */
208*11225SDana.Myers@Sun.COM if (RgnDesc->Region.SpaceId == ACPI_ADR_SPACE_SMBUS ||
209*11225SDana.Myers@Sun.COM RgnDesc->Region.SpaceId == ACPI_ADR_SPACE_IPMI)
2107851SDana.Myers@Sun.COM {
211*11225SDana.Myers@Sun.COM /* SMBus or IPMI has a non-linear address space */
2127851SDana.Myers@Sun.COM
2137851SDana.Myers@Sun.COM return_ACPI_STATUS (AE_OK);
2147851SDana.Myers@Sun.COM }
2157851SDana.Myers@Sun.COM
2167851SDana.Myers@Sun.COM #ifdef ACPI_UNDER_DEVELOPMENT
2177851SDana.Myers@Sun.COM /*
2187851SDana.Myers@Sun.COM * If the Field access is AnyAcc, we can now compute the optimal
2197851SDana.Myers@Sun.COM * access (because we know know the length of the parent region)
2207851SDana.Myers@Sun.COM */
2217851SDana.Myers@Sun.COM if (!(ObjDesc->Common.Flags & AOPOBJ_DATA_VALID))
2227851SDana.Myers@Sun.COM {
2237851SDana.Myers@Sun.COM if (ACPI_FAILURE (Status))
2247851SDana.Myers@Sun.COM {
2257851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
2267851SDana.Myers@Sun.COM }
2277851SDana.Myers@Sun.COM }
2287851SDana.Myers@Sun.COM #endif
2297851SDana.Myers@Sun.COM
2307851SDana.Myers@Sun.COM /*
2317851SDana.Myers@Sun.COM * Validate the request. The entire request from the byte offset for a
2327851SDana.Myers@Sun.COM * length of one field datum (access width) must fit within the region.
2337851SDana.Myers@Sun.COM * (Region length is specified in bytes)
2347851SDana.Myers@Sun.COM */
2357851SDana.Myers@Sun.COM if (RgnDesc->Region.Length <
2367851SDana.Myers@Sun.COM (ObjDesc->CommonField.BaseByteOffset +
2377851SDana.Myers@Sun.COM FieldDatumByteOffset +
2387851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessByteWidth))
2397851SDana.Myers@Sun.COM {
2407851SDana.Myers@Sun.COM if (AcpiGbl_EnableInterpreterSlack)
2417851SDana.Myers@Sun.COM {
2427851SDana.Myers@Sun.COM /*
2437851SDana.Myers@Sun.COM * Slack mode only: We will go ahead and allow access to this
2447851SDana.Myers@Sun.COM * field if it is within the region length rounded up to the next
2457851SDana.Myers@Sun.COM * access width boundary. ACPI_SIZE cast for 64-bit compile.
2467851SDana.Myers@Sun.COM */
2477851SDana.Myers@Sun.COM if (ACPI_ROUND_UP (RgnDesc->Region.Length,
2487851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessByteWidth) >=
2497851SDana.Myers@Sun.COM ((ACPI_SIZE) ObjDesc->CommonField.BaseByteOffset +
2507851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessByteWidth +
2517851SDana.Myers@Sun.COM FieldDatumByteOffset))
2527851SDana.Myers@Sun.COM {
2537851SDana.Myers@Sun.COM return_ACPI_STATUS (AE_OK);
2547851SDana.Myers@Sun.COM }
2557851SDana.Myers@Sun.COM }
2567851SDana.Myers@Sun.COM
2577851SDana.Myers@Sun.COM if (RgnDesc->Region.Length < ObjDesc->CommonField.AccessByteWidth)
2587851SDana.Myers@Sun.COM {
2597851SDana.Myers@Sun.COM /*
2607851SDana.Myers@Sun.COM * This is the case where the AccessType (AccWord, etc.) is wider
2617851SDana.Myers@Sun.COM * than the region itself. For example, a region of length one
2627851SDana.Myers@Sun.COM * byte, and a field with Dword access specified.
2637851SDana.Myers@Sun.COM */
2647851SDana.Myers@Sun.COM ACPI_ERROR ((AE_INFO,
2657851SDana.Myers@Sun.COM "Field [%4.4s] access width (%d bytes) too large for region [%4.4s] (length %X)",
2667851SDana.Myers@Sun.COM AcpiUtGetNodeName (ObjDesc->CommonField.Node),
2677851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessByteWidth,
2687851SDana.Myers@Sun.COM AcpiUtGetNodeName (RgnDesc->Region.Node),
2697851SDana.Myers@Sun.COM RgnDesc->Region.Length));
2707851SDana.Myers@Sun.COM }
2717851SDana.Myers@Sun.COM
2727851SDana.Myers@Sun.COM /*
2737851SDana.Myers@Sun.COM * Offset rounded up to next multiple of field width
2747851SDana.Myers@Sun.COM * exceeds region length, indicate an error
2757851SDana.Myers@Sun.COM */
2767851SDana.Myers@Sun.COM ACPI_ERROR ((AE_INFO,
2777851SDana.Myers@Sun.COM "Field [%4.4s] Base+Offset+Width %X+%X+%X is beyond end of region [%4.4s] (length %X)",
2787851SDana.Myers@Sun.COM AcpiUtGetNodeName (ObjDesc->CommonField.Node),
2797851SDana.Myers@Sun.COM ObjDesc->CommonField.BaseByteOffset,
2807851SDana.Myers@Sun.COM FieldDatumByteOffset, ObjDesc->CommonField.AccessByteWidth,
2817851SDana.Myers@Sun.COM AcpiUtGetNodeName (RgnDesc->Region.Node),
2827851SDana.Myers@Sun.COM RgnDesc->Region.Length));
2837851SDana.Myers@Sun.COM
2847851SDana.Myers@Sun.COM return_ACPI_STATUS (AE_AML_REGION_LIMIT);
2857851SDana.Myers@Sun.COM }
2867851SDana.Myers@Sun.COM
2877851SDana.Myers@Sun.COM return_ACPI_STATUS (AE_OK);
2887851SDana.Myers@Sun.COM }
2897851SDana.Myers@Sun.COM
2907851SDana.Myers@Sun.COM
2917851SDana.Myers@Sun.COM /*******************************************************************************
2927851SDana.Myers@Sun.COM *
2937851SDana.Myers@Sun.COM * FUNCTION: AcpiExAccessRegion
2947851SDana.Myers@Sun.COM *
2957851SDana.Myers@Sun.COM * PARAMETERS: ObjDesc - Field to be read
2967851SDana.Myers@Sun.COM * FieldDatumByteOffset - Byte offset of this datum within the
2977851SDana.Myers@Sun.COM * parent field
2987851SDana.Myers@Sun.COM * Value - Where to store value (must at least
2997851SDana.Myers@Sun.COM * the size of ACPI_INTEGER)
3007851SDana.Myers@Sun.COM * Function - Read or Write flag plus other region-
3017851SDana.Myers@Sun.COM * dependent flags
3027851SDana.Myers@Sun.COM *
3037851SDana.Myers@Sun.COM * RETURN: Status
3047851SDana.Myers@Sun.COM *
3057851SDana.Myers@Sun.COM * DESCRIPTION: Read or Write a single field datum to an Operation Region.
3067851SDana.Myers@Sun.COM *
3077851SDana.Myers@Sun.COM ******************************************************************************/
3087851SDana.Myers@Sun.COM
3097851SDana.Myers@Sun.COM ACPI_STATUS
AcpiExAccessRegion(ACPI_OPERAND_OBJECT * ObjDesc,UINT32 FieldDatumByteOffset,ACPI_INTEGER * Value,UINT32 Function)3107851SDana.Myers@Sun.COM AcpiExAccessRegion (
3117851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *ObjDesc,
3127851SDana.Myers@Sun.COM UINT32 FieldDatumByteOffset,
3137851SDana.Myers@Sun.COM ACPI_INTEGER *Value,
3147851SDana.Myers@Sun.COM UINT32 Function)
3157851SDana.Myers@Sun.COM {
3167851SDana.Myers@Sun.COM ACPI_STATUS Status;
3177851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *RgnDesc;
3189980SDana.Myers@Sun.COM UINT32 RegionOffset;
3197851SDana.Myers@Sun.COM
3207851SDana.Myers@Sun.COM
3217851SDana.Myers@Sun.COM ACPI_FUNCTION_TRACE (ExAccessRegion);
3227851SDana.Myers@Sun.COM
3237851SDana.Myers@Sun.COM
3247851SDana.Myers@Sun.COM /*
3257851SDana.Myers@Sun.COM * Ensure that the region operands are fully evaluated and verify
3267851SDana.Myers@Sun.COM * the validity of the request
3277851SDana.Myers@Sun.COM */
3287851SDana.Myers@Sun.COM Status = AcpiExSetupRegion (ObjDesc, FieldDatumByteOffset);
3297851SDana.Myers@Sun.COM if (ACPI_FAILURE (Status))
3307851SDana.Myers@Sun.COM {
3317851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
3327851SDana.Myers@Sun.COM }
3337851SDana.Myers@Sun.COM
3347851SDana.Myers@Sun.COM /*
3357851SDana.Myers@Sun.COM * The physical address of this field datum is:
3367851SDana.Myers@Sun.COM *
3377851SDana.Myers@Sun.COM * 1) The base of the region, plus
3387851SDana.Myers@Sun.COM * 2) The base offset of the field, plus
3397851SDana.Myers@Sun.COM * 3) The current offset into the field
3407851SDana.Myers@Sun.COM */
3417851SDana.Myers@Sun.COM RgnDesc = ObjDesc->CommonField.RegionObj;
3429980SDana.Myers@Sun.COM RegionOffset =
3439980SDana.Myers@Sun.COM ObjDesc->CommonField.BaseByteOffset +
3449980SDana.Myers@Sun.COM FieldDatumByteOffset;
3457851SDana.Myers@Sun.COM
3467851SDana.Myers@Sun.COM if ((Function & ACPI_IO_MASK) == ACPI_READ)
3477851SDana.Myers@Sun.COM {
3487851SDana.Myers@Sun.COM ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD, "[READ]"));
3497851SDana.Myers@Sun.COM }
3507851SDana.Myers@Sun.COM else
3517851SDana.Myers@Sun.COM {
3527851SDana.Myers@Sun.COM ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD, "[WRITE]"));
3537851SDana.Myers@Sun.COM }
3547851SDana.Myers@Sun.COM
3557851SDana.Myers@Sun.COM ACPI_DEBUG_PRINT_RAW ((ACPI_DB_BFIELD,
3567851SDana.Myers@Sun.COM " Region [%s:%X], Width %X, ByteBase %X, Offset %X at %p\n",
3577851SDana.Myers@Sun.COM AcpiUtGetRegionName (RgnDesc->Region.SpaceId),
3587851SDana.Myers@Sun.COM RgnDesc->Region.SpaceId,
3597851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessByteWidth,
3607851SDana.Myers@Sun.COM ObjDesc->CommonField.BaseByteOffset,
3617851SDana.Myers@Sun.COM FieldDatumByteOffset,
3629980SDana.Myers@Sun.COM ACPI_CAST_PTR (void, (RgnDesc->Region.Address + RegionOffset))));
3637851SDana.Myers@Sun.COM
3647851SDana.Myers@Sun.COM /* Invoke the appropriate AddressSpace/OpRegion handler */
3657851SDana.Myers@Sun.COM
3669980SDana.Myers@Sun.COM Status = AcpiEvAddressSpaceDispatch (RgnDesc, Function, RegionOffset,
3677851SDana.Myers@Sun.COM ACPI_MUL_8 (ObjDesc->CommonField.AccessByteWidth), Value);
3687851SDana.Myers@Sun.COM
3697851SDana.Myers@Sun.COM if (ACPI_FAILURE (Status))
3707851SDana.Myers@Sun.COM {
3717851SDana.Myers@Sun.COM if (Status == AE_NOT_IMPLEMENTED)
3727851SDana.Myers@Sun.COM {
3737851SDana.Myers@Sun.COM ACPI_ERROR ((AE_INFO,
3747851SDana.Myers@Sun.COM "Region %s(%X) not implemented",
3757851SDana.Myers@Sun.COM AcpiUtGetRegionName (RgnDesc->Region.SpaceId),
3767851SDana.Myers@Sun.COM RgnDesc->Region.SpaceId));
3777851SDana.Myers@Sun.COM }
3787851SDana.Myers@Sun.COM else if (Status == AE_NOT_EXIST)
3797851SDana.Myers@Sun.COM {
3807851SDana.Myers@Sun.COM ACPI_ERROR ((AE_INFO,
3817851SDana.Myers@Sun.COM "Region %s(%X) has no handler",
3827851SDana.Myers@Sun.COM AcpiUtGetRegionName (RgnDesc->Region.SpaceId),
3837851SDana.Myers@Sun.COM RgnDesc->Region.SpaceId));
3847851SDana.Myers@Sun.COM }
3857851SDana.Myers@Sun.COM }
3867851SDana.Myers@Sun.COM
3877851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
3887851SDana.Myers@Sun.COM }
3897851SDana.Myers@Sun.COM
3907851SDana.Myers@Sun.COM
3917851SDana.Myers@Sun.COM /*******************************************************************************
3927851SDana.Myers@Sun.COM *
3937851SDana.Myers@Sun.COM * FUNCTION: AcpiExRegisterOverflow
3947851SDana.Myers@Sun.COM *
3957851SDana.Myers@Sun.COM * PARAMETERS: ObjDesc - Register(Field) to be written
3967851SDana.Myers@Sun.COM * Value - Value to be stored
3977851SDana.Myers@Sun.COM *
3987851SDana.Myers@Sun.COM * RETURN: TRUE if value overflows the field, FALSE otherwise
3997851SDana.Myers@Sun.COM *
4007851SDana.Myers@Sun.COM * DESCRIPTION: Check if a value is out of range of the field being written.
4017851SDana.Myers@Sun.COM * Used to check if the values written to Index and Bank registers
4027851SDana.Myers@Sun.COM * are out of range. Normally, the value is simply truncated
4037851SDana.Myers@Sun.COM * to fit the field, but this case is most likely a serious
4047851SDana.Myers@Sun.COM * coding error in the ASL.
4057851SDana.Myers@Sun.COM *
4067851SDana.Myers@Sun.COM ******************************************************************************/
4077851SDana.Myers@Sun.COM
4087851SDana.Myers@Sun.COM static BOOLEAN
AcpiExRegisterOverflow(ACPI_OPERAND_OBJECT * ObjDesc,ACPI_INTEGER Value)4097851SDana.Myers@Sun.COM AcpiExRegisterOverflow (
4107851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *ObjDesc,
4117851SDana.Myers@Sun.COM ACPI_INTEGER Value)
4127851SDana.Myers@Sun.COM {
4137851SDana.Myers@Sun.COM
4147851SDana.Myers@Sun.COM if (ObjDesc->CommonField.BitLength >= ACPI_INTEGER_BIT_SIZE)
4157851SDana.Myers@Sun.COM {
4167851SDana.Myers@Sun.COM /*
4177851SDana.Myers@Sun.COM * The field is large enough to hold the maximum integer, so we can
4187851SDana.Myers@Sun.COM * never overflow it.
4197851SDana.Myers@Sun.COM */
4207851SDana.Myers@Sun.COM return (FALSE);
4217851SDana.Myers@Sun.COM }
4227851SDana.Myers@Sun.COM
4237851SDana.Myers@Sun.COM if (Value >= ((ACPI_INTEGER) 1 << ObjDesc->CommonField.BitLength))
4247851SDana.Myers@Sun.COM {
4257851SDana.Myers@Sun.COM /*
4267851SDana.Myers@Sun.COM * The Value is larger than the maximum value that can fit into
4277851SDana.Myers@Sun.COM * the register.
4287851SDana.Myers@Sun.COM */
4297851SDana.Myers@Sun.COM return (TRUE);
4307851SDana.Myers@Sun.COM }
4317851SDana.Myers@Sun.COM
4327851SDana.Myers@Sun.COM /* The Value will fit into the field with no truncation */
4337851SDana.Myers@Sun.COM
4347851SDana.Myers@Sun.COM return (FALSE);
4357851SDana.Myers@Sun.COM }
4367851SDana.Myers@Sun.COM
4377851SDana.Myers@Sun.COM
4387851SDana.Myers@Sun.COM /*******************************************************************************
4397851SDana.Myers@Sun.COM *
4407851SDana.Myers@Sun.COM * FUNCTION: AcpiExFieldDatumIo
4417851SDana.Myers@Sun.COM *
4427851SDana.Myers@Sun.COM * PARAMETERS: ObjDesc - Field to be read
4437851SDana.Myers@Sun.COM * FieldDatumByteOffset - Byte offset of this datum within the
4447851SDana.Myers@Sun.COM * parent field
4457851SDana.Myers@Sun.COM * Value - Where to store value (must be 64 bits)
4467851SDana.Myers@Sun.COM * ReadWrite - Read or Write flag
4477851SDana.Myers@Sun.COM *
4487851SDana.Myers@Sun.COM * RETURN: Status
4497851SDana.Myers@Sun.COM *
4507851SDana.Myers@Sun.COM * DESCRIPTION: Read or Write a single datum of a field. The FieldType is
4517851SDana.Myers@Sun.COM * demultiplexed here to handle the different types of fields
4527851SDana.Myers@Sun.COM * (BufferField, RegionField, IndexField, BankField)
4537851SDana.Myers@Sun.COM *
4547851SDana.Myers@Sun.COM ******************************************************************************/
4557851SDana.Myers@Sun.COM
4567851SDana.Myers@Sun.COM static ACPI_STATUS
AcpiExFieldDatumIo(ACPI_OPERAND_OBJECT * ObjDesc,UINT32 FieldDatumByteOffset,ACPI_INTEGER * Value,UINT32 ReadWrite)4577851SDana.Myers@Sun.COM AcpiExFieldDatumIo (
4587851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *ObjDesc,
4597851SDana.Myers@Sun.COM UINT32 FieldDatumByteOffset,
4607851SDana.Myers@Sun.COM ACPI_INTEGER *Value,
4617851SDana.Myers@Sun.COM UINT32 ReadWrite)
4627851SDana.Myers@Sun.COM {
4637851SDana.Myers@Sun.COM ACPI_STATUS Status;
4647851SDana.Myers@Sun.COM ACPI_INTEGER LocalValue;
4657851SDana.Myers@Sun.COM
4667851SDana.Myers@Sun.COM
4677851SDana.Myers@Sun.COM ACPI_FUNCTION_TRACE_U32 (ExFieldDatumIo, FieldDatumByteOffset);
4687851SDana.Myers@Sun.COM
4697851SDana.Myers@Sun.COM
4707851SDana.Myers@Sun.COM if (ReadWrite == ACPI_READ)
4717851SDana.Myers@Sun.COM {
4727851SDana.Myers@Sun.COM if (!Value)
4737851SDana.Myers@Sun.COM {
4747851SDana.Myers@Sun.COM LocalValue = 0;
4757851SDana.Myers@Sun.COM
4767851SDana.Myers@Sun.COM /* To support reads without saving return value */
4777851SDana.Myers@Sun.COM Value = &LocalValue;
4787851SDana.Myers@Sun.COM }
4797851SDana.Myers@Sun.COM
4807851SDana.Myers@Sun.COM /* Clear the entire return buffer first, [Very Important!] */
4817851SDana.Myers@Sun.COM
4827851SDana.Myers@Sun.COM *Value = 0;
4837851SDana.Myers@Sun.COM }
4847851SDana.Myers@Sun.COM
4857851SDana.Myers@Sun.COM /*
4867851SDana.Myers@Sun.COM * The four types of fields are:
4877851SDana.Myers@Sun.COM *
4887851SDana.Myers@Sun.COM * BufferField - Read/write from/to a Buffer
4897851SDana.Myers@Sun.COM * RegionField - Read/write from/to a Operation Region.
4907851SDana.Myers@Sun.COM * BankField - Write to a Bank Register, then read/write from/to an
4917851SDana.Myers@Sun.COM * OperationRegion
4927851SDana.Myers@Sun.COM * IndexField - Write to an Index Register, then read/write from/to a
4937851SDana.Myers@Sun.COM * Data Register
4947851SDana.Myers@Sun.COM */
4959980SDana.Myers@Sun.COM switch (ObjDesc->Common.Type)
4967851SDana.Myers@Sun.COM {
4977851SDana.Myers@Sun.COM case ACPI_TYPE_BUFFER_FIELD:
4987851SDana.Myers@Sun.COM /*
4997851SDana.Myers@Sun.COM * If the BufferField arguments have not been previously evaluated,
5007851SDana.Myers@Sun.COM * evaluate them now and save the results.
5017851SDana.Myers@Sun.COM */
5027851SDana.Myers@Sun.COM if (!(ObjDesc->Common.Flags & AOPOBJ_DATA_VALID))
5037851SDana.Myers@Sun.COM {
5047851SDana.Myers@Sun.COM Status = AcpiDsGetBufferFieldArguments (ObjDesc);
5057851SDana.Myers@Sun.COM if (ACPI_FAILURE (Status))
5067851SDana.Myers@Sun.COM {
5077851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
5087851SDana.Myers@Sun.COM }
5097851SDana.Myers@Sun.COM }
5107851SDana.Myers@Sun.COM
5117851SDana.Myers@Sun.COM if (ReadWrite == ACPI_READ)
5127851SDana.Myers@Sun.COM {
5137851SDana.Myers@Sun.COM /*
5147851SDana.Myers@Sun.COM * Copy the data from the source buffer.
5157851SDana.Myers@Sun.COM * Length is the field width in bytes.
5167851SDana.Myers@Sun.COM */
5177851SDana.Myers@Sun.COM ACPI_MEMCPY (Value,
5187851SDana.Myers@Sun.COM (ObjDesc->BufferField.BufferObj)->Buffer.Pointer +
5197851SDana.Myers@Sun.COM ObjDesc->BufferField.BaseByteOffset +
5207851SDana.Myers@Sun.COM FieldDatumByteOffset,
5217851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessByteWidth);
5227851SDana.Myers@Sun.COM }
5237851SDana.Myers@Sun.COM else
5247851SDana.Myers@Sun.COM {
5257851SDana.Myers@Sun.COM /*
5267851SDana.Myers@Sun.COM * Copy the data to the target buffer.
5277851SDana.Myers@Sun.COM * Length is the field width in bytes.
5287851SDana.Myers@Sun.COM */
5297851SDana.Myers@Sun.COM ACPI_MEMCPY ((ObjDesc->BufferField.BufferObj)->Buffer.Pointer +
5307851SDana.Myers@Sun.COM ObjDesc->BufferField.BaseByteOffset +
5317851SDana.Myers@Sun.COM FieldDatumByteOffset,
5327851SDana.Myers@Sun.COM Value, ObjDesc->CommonField.AccessByteWidth);
5337851SDana.Myers@Sun.COM }
5347851SDana.Myers@Sun.COM
5357851SDana.Myers@Sun.COM Status = AE_OK;
5367851SDana.Myers@Sun.COM break;
5377851SDana.Myers@Sun.COM
5387851SDana.Myers@Sun.COM
5397851SDana.Myers@Sun.COM case ACPI_TYPE_LOCAL_BANK_FIELD:
5407851SDana.Myers@Sun.COM
5417851SDana.Myers@Sun.COM /*
5427851SDana.Myers@Sun.COM * Ensure that the BankValue is not beyond the capacity of
5437851SDana.Myers@Sun.COM * the register
5447851SDana.Myers@Sun.COM */
5457851SDana.Myers@Sun.COM if (AcpiExRegisterOverflow (ObjDesc->BankField.BankObj,
5467851SDana.Myers@Sun.COM (ACPI_INTEGER) ObjDesc->BankField.Value))
5477851SDana.Myers@Sun.COM {
5487851SDana.Myers@Sun.COM return_ACPI_STATUS (AE_AML_REGISTER_LIMIT);
5497851SDana.Myers@Sun.COM }
5507851SDana.Myers@Sun.COM
5517851SDana.Myers@Sun.COM /*
5527851SDana.Myers@Sun.COM * For BankFields, we must write the BankValue to the BankRegister
5537851SDana.Myers@Sun.COM * (itself a RegionField) before we can access the data.
5547851SDana.Myers@Sun.COM */
5557851SDana.Myers@Sun.COM Status = AcpiExInsertIntoField (ObjDesc->BankField.BankObj,
5567851SDana.Myers@Sun.COM &ObjDesc->BankField.Value,
5577851SDana.Myers@Sun.COM sizeof (ObjDesc->BankField.Value));
5587851SDana.Myers@Sun.COM if (ACPI_FAILURE (Status))
5597851SDana.Myers@Sun.COM {
5607851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
5617851SDana.Myers@Sun.COM }
5627851SDana.Myers@Sun.COM
5637851SDana.Myers@Sun.COM /*
5647851SDana.Myers@Sun.COM * Now that the Bank has been selected, fall through to the
5657851SDana.Myers@Sun.COM * RegionField case and write the datum to the Operation Region
5667851SDana.Myers@Sun.COM */
5677851SDana.Myers@Sun.COM
5687851SDana.Myers@Sun.COM /*lint -fallthrough */
5697851SDana.Myers@Sun.COM
5707851SDana.Myers@Sun.COM
5717851SDana.Myers@Sun.COM case ACPI_TYPE_LOCAL_REGION_FIELD:
5727851SDana.Myers@Sun.COM /*
5737851SDana.Myers@Sun.COM * For simple RegionFields, we just directly access the owning
5747851SDana.Myers@Sun.COM * Operation Region.
5757851SDana.Myers@Sun.COM */
5767851SDana.Myers@Sun.COM Status = AcpiExAccessRegion (ObjDesc, FieldDatumByteOffset, Value,
5777851SDana.Myers@Sun.COM ReadWrite);
5787851SDana.Myers@Sun.COM break;
5797851SDana.Myers@Sun.COM
5807851SDana.Myers@Sun.COM
5817851SDana.Myers@Sun.COM case ACPI_TYPE_LOCAL_INDEX_FIELD:
5827851SDana.Myers@Sun.COM
5837851SDana.Myers@Sun.COM
5847851SDana.Myers@Sun.COM /*
5857851SDana.Myers@Sun.COM * Ensure that the IndexValue is not beyond the capacity of
5867851SDana.Myers@Sun.COM * the register
5877851SDana.Myers@Sun.COM */
5887851SDana.Myers@Sun.COM if (AcpiExRegisterOverflow (ObjDesc->IndexField.IndexObj,
5897851SDana.Myers@Sun.COM (ACPI_INTEGER) ObjDesc->IndexField.Value))
5907851SDana.Myers@Sun.COM {
5917851SDana.Myers@Sun.COM return_ACPI_STATUS (AE_AML_REGISTER_LIMIT);
5927851SDana.Myers@Sun.COM }
5937851SDana.Myers@Sun.COM
5947851SDana.Myers@Sun.COM /* Write the index value to the IndexRegister (itself a RegionField) */
5957851SDana.Myers@Sun.COM
5967851SDana.Myers@Sun.COM FieldDatumByteOffset += ObjDesc->IndexField.Value;
5977851SDana.Myers@Sun.COM
5987851SDana.Myers@Sun.COM ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
5997851SDana.Myers@Sun.COM "Write to Index Register: Value %8.8X\n",
6007851SDana.Myers@Sun.COM FieldDatumByteOffset));
6017851SDana.Myers@Sun.COM
6027851SDana.Myers@Sun.COM Status = AcpiExInsertIntoField (ObjDesc->IndexField.IndexObj,
6037851SDana.Myers@Sun.COM &FieldDatumByteOffset,
6047851SDana.Myers@Sun.COM sizeof (FieldDatumByteOffset));
6057851SDana.Myers@Sun.COM if (ACPI_FAILURE (Status))
6067851SDana.Myers@Sun.COM {
6077851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
6087851SDana.Myers@Sun.COM }
6097851SDana.Myers@Sun.COM
6107851SDana.Myers@Sun.COM if (ReadWrite == ACPI_READ)
6117851SDana.Myers@Sun.COM {
6127851SDana.Myers@Sun.COM /* Read the datum from the DataRegister */
6137851SDana.Myers@Sun.COM
6149980SDana.Myers@Sun.COM ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
6159980SDana.Myers@Sun.COM "Read from Data Register\n"));
6169980SDana.Myers@Sun.COM
6177851SDana.Myers@Sun.COM Status = AcpiExExtractFromField (ObjDesc->IndexField.DataObj,
6187851SDana.Myers@Sun.COM Value, sizeof (ACPI_INTEGER));
6197851SDana.Myers@Sun.COM }
6207851SDana.Myers@Sun.COM else
6217851SDana.Myers@Sun.COM {
6227851SDana.Myers@Sun.COM /* Write the datum to the DataRegister */
6237851SDana.Myers@Sun.COM
6249980SDana.Myers@Sun.COM ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
6259980SDana.Myers@Sun.COM "Write to Data Register: Value %8.8X%8.8X\n",
6269980SDana.Myers@Sun.COM ACPI_FORMAT_UINT64 (*Value)));
6279980SDana.Myers@Sun.COM
6287851SDana.Myers@Sun.COM Status = AcpiExInsertIntoField (ObjDesc->IndexField.DataObj,
6297851SDana.Myers@Sun.COM Value, sizeof (ACPI_INTEGER));
6307851SDana.Myers@Sun.COM }
6317851SDana.Myers@Sun.COM break;
6327851SDana.Myers@Sun.COM
6337851SDana.Myers@Sun.COM
6347851SDana.Myers@Sun.COM default:
6357851SDana.Myers@Sun.COM
6367851SDana.Myers@Sun.COM ACPI_ERROR ((AE_INFO, "Wrong object type in field I/O %X",
6379980SDana.Myers@Sun.COM ObjDesc->Common.Type));
6387851SDana.Myers@Sun.COM Status = AE_AML_INTERNAL;
6397851SDana.Myers@Sun.COM break;
6407851SDana.Myers@Sun.COM }
6417851SDana.Myers@Sun.COM
6427851SDana.Myers@Sun.COM if (ACPI_SUCCESS (Status))
6437851SDana.Myers@Sun.COM {
6447851SDana.Myers@Sun.COM if (ReadWrite == ACPI_READ)
6457851SDana.Myers@Sun.COM {
6467851SDana.Myers@Sun.COM ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
6477851SDana.Myers@Sun.COM "Value Read %8.8X%8.8X, Width %d\n",
6487851SDana.Myers@Sun.COM ACPI_FORMAT_UINT64 (*Value),
6497851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessByteWidth));
6507851SDana.Myers@Sun.COM }
6517851SDana.Myers@Sun.COM else
6527851SDana.Myers@Sun.COM {
6537851SDana.Myers@Sun.COM ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
6547851SDana.Myers@Sun.COM "Value Written %8.8X%8.8X, Width %d\n",
6557851SDana.Myers@Sun.COM ACPI_FORMAT_UINT64 (*Value),
6567851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessByteWidth));
6577851SDana.Myers@Sun.COM }
6587851SDana.Myers@Sun.COM }
6597851SDana.Myers@Sun.COM
6607851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
6617851SDana.Myers@Sun.COM }
6627851SDana.Myers@Sun.COM
6637851SDana.Myers@Sun.COM
6647851SDana.Myers@Sun.COM /*******************************************************************************
6657851SDana.Myers@Sun.COM *
6667851SDana.Myers@Sun.COM * FUNCTION: AcpiExWriteWithUpdateRule
6677851SDana.Myers@Sun.COM *
6687851SDana.Myers@Sun.COM * PARAMETERS: ObjDesc - Field to be written
6697851SDana.Myers@Sun.COM * Mask - bitmask within field datum
6707851SDana.Myers@Sun.COM * FieldValue - Value to write
6717851SDana.Myers@Sun.COM * FieldDatumByteOffset - Offset of datum within field
6727851SDana.Myers@Sun.COM *
6737851SDana.Myers@Sun.COM * RETURN: Status
6747851SDana.Myers@Sun.COM *
6757851SDana.Myers@Sun.COM * DESCRIPTION: Apply the field update rule to a field write
6767851SDana.Myers@Sun.COM *
6777851SDana.Myers@Sun.COM ******************************************************************************/
6787851SDana.Myers@Sun.COM
6797851SDana.Myers@Sun.COM ACPI_STATUS
AcpiExWriteWithUpdateRule(ACPI_OPERAND_OBJECT * ObjDesc,ACPI_INTEGER Mask,ACPI_INTEGER FieldValue,UINT32 FieldDatumByteOffset)6807851SDana.Myers@Sun.COM AcpiExWriteWithUpdateRule (
6817851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *ObjDesc,
6827851SDana.Myers@Sun.COM ACPI_INTEGER Mask,
6837851SDana.Myers@Sun.COM ACPI_INTEGER FieldValue,
6847851SDana.Myers@Sun.COM UINT32 FieldDatumByteOffset)
6857851SDana.Myers@Sun.COM {
6867851SDana.Myers@Sun.COM ACPI_STATUS Status = AE_OK;
6877851SDana.Myers@Sun.COM ACPI_INTEGER MergedValue;
6887851SDana.Myers@Sun.COM ACPI_INTEGER CurrentValue;
6897851SDana.Myers@Sun.COM
6907851SDana.Myers@Sun.COM
6917851SDana.Myers@Sun.COM ACPI_FUNCTION_TRACE_U32 (ExWriteWithUpdateRule, Mask);
6927851SDana.Myers@Sun.COM
6937851SDana.Myers@Sun.COM
6947851SDana.Myers@Sun.COM /* Start with the new bits */
6957851SDana.Myers@Sun.COM
6967851SDana.Myers@Sun.COM MergedValue = FieldValue;
6977851SDana.Myers@Sun.COM
6987851SDana.Myers@Sun.COM /* If the mask is all ones, we don't need to worry about the update rule */
6997851SDana.Myers@Sun.COM
7007851SDana.Myers@Sun.COM if (Mask != ACPI_INTEGER_MAX)
7017851SDana.Myers@Sun.COM {
7027851SDana.Myers@Sun.COM /* Decode the update rule */
7037851SDana.Myers@Sun.COM
7047851SDana.Myers@Sun.COM switch (ObjDesc->CommonField.FieldFlags & AML_FIELD_UPDATE_RULE_MASK)
7057851SDana.Myers@Sun.COM {
7067851SDana.Myers@Sun.COM case AML_FIELD_UPDATE_PRESERVE:
7077851SDana.Myers@Sun.COM /*
7087851SDana.Myers@Sun.COM * Check if update rule needs to be applied (not if mask is all
7097851SDana.Myers@Sun.COM * ones) The left shift drops the bits we want to ignore.
7107851SDana.Myers@Sun.COM */
7117851SDana.Myers@Sun.COM if ((~Mask << (ACPI_MUL_8 (sizeof (Mask)) -
7127851SDana.Myers@Sun.COM ACPI_MUL_8 (ObjDesc->CommonField.AccessByteWidth))) != 0)
7137851SDana.Myers@Sun.COM {
7147851SDana.Myers@Sun.COM /*
7157851SDana.Myers@Sun.COM * Read the current contents of the byte/word/dword containing
7167851SDana.Myers@Sun.COM * the field, and merge with the new field value.
7177851SDana.Myers@Sun.COM */
7187851SDana.Myers@Sun.COM Status = AcpiExFieldDatumIo (ObjDesc, FieldDatumByteOffset,
7197851SDana.Myers@Sun.COM &CurrentValue, ACPI_READ);
7207851SDana.Myers@Sun.COM if (ACPI_FAILURE (Status))
7217851SDana.Myers@Sun.COM {
7227851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
7237851SDana.Myers@Sun.COM }
7247851SDana.Myers@Sun.COM
7257851SDana.Myers@Sun.COM MergedValue |= (CurrentValue & ~Mask);
7267851SDana.Myers@Sun.COM }
7277851SDana.Myers@Sun.COM break;
7287851SDana.Myers@Sun.COM
7297851SDana.Myers@Sun.COM case AML_FIELD_UPDATE_WRITE_AS_ONES:
7307851SDana.Myers@Sun.COM
7317851SDana.Myers@Sun.COM /* Set positions outside the field to all ones */
7327851SDana.Myers@Sun.COM
7337851SDana.Myers@Sun.COM MergedValue |= ~Mask;
7347851SDana.Myers@Sun.COM break;
7357851SDana.Myers@Sun.COM
7367851SDana.Myers@Sun.COM case AML_FIELD_UPDATE_WRITE_AS_ZEROS:
7377851SDana.Myers@Sun.COM
7387851SDana.Myers@Sun.COM /* Set positions outside the field to all zeros */
7397851SDana.Myers@Sun.COM
7407851SDana.Myers@Sun.COM MergedValue &= Mask;
7417851SDana.Myers@Sun.COM break;
7427851SDana.Myers@Sun.COM
7437851SDana.Myers@Sun.COM default:
7447851SDana.Myers@Sun.COM
7457851SDana.Myers@Sun.COM ACPI_ERROR ((AE_INFO,
7467851SDana.Myers@Sun.COM "Unknown UpdateRule value: %X",
7477851SDana.Myers@Sun.COM (ObjDesc->CommonField.FieldFlags & AML_FIELD_UPDATE_RULE_MASK)));
7487851SDana.Myers@Sun.COM return_ACPI_STATUS (AE_AML_OPERAND_VALUE);
7497851SDana.Myers@Sun.COM }
7507851SDana.Myers@Sun.COM }
7517851SDana.Myers@Sun.COM
7527851SDana.Myers@Sun.COM ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
7537851SDana.Myers@Sun.COM "Mask %8.8X%8.8X, DatumOffset %X, Width %X, Value %8.8X%8.8X, MergedValue %8.8X%8.8X\n",
7547851SDana.Myers@Sun.COM ACPI_FORMAT_UINT64 (Mask),
7557851SDana.Myers@Sun.COM FieldDatumByteOffset,
7567851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessByteWidth,
7577851SDana.Myers@Sun.COM ACPI_FORMAT_UINT64 (FieldValue),
7587851SDana.Myers@Sun.COM ACPI_FORMAT_UINT64 (MergedValue)));
7597851SDana.Myers@Sun.COM
7607851SDana.Myers@Sun.COM /* Write the merged value */
7617851SDana.Myers@Sun.COM
7627851SDana.Myers@Sun.COM Status = AcpiExFieldDatumIo (ObjDesc, FieldDatumByteOffset,
7637851SDana.Myers@Sun.COM &MergedValue, ACPI_WRITE);
7647851SDana.Myers@Sun.COM
7657851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
7667851SDana.Myers@Sun.COM }
7677851SDana.Myers@Sun.COM
7687851SDana.Myers@Sun.COM
7697851SDana.Myers@Sun.COM /*******************************************************************************
7707851SDana.Myers@Sun.COM *
7717851SDana.Myers@Sun.COM * FUNCTION: AcpiExExtractFromField
7727851SDana.Myers@Sun.COM *
7737851SDana.Myers@Sun.COM * PARAMETERS: ObjDesc - Field to be read
7747851SDana.Myers@Sun.COM * Buffer - Where to store the field data
7757851SDana.Myers@Sun.COM * BufferLength - Length of Buffer
7767851SDana.Myers@Sun.COM *
7777851SDana.Myers@Sun.COM * RETURN: Status
7787851SDana.Myers@Sun.COM *
7797851SDana.Myers@Sun.COM * DESCRIPTION: Retrieve the current value of the given field
7807851SDana.Myers@Sun.COM *
7817851SDana.Myers@Sun.COM ******************************************************************************/
7827851SDana.Myers@Sun.COM
7837851SDana.Myers@Sun.COM ACPI_STATUS
AcpiExExtractFromField(ACPI_OPERAND_OBJECT * ObjDesc,void * Buffer,UINT32 BufferLength)7847851SDana.Myers@Sun.COM AcpiExExtractFromField (
7857851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *ObjDesc,
7867851SDana.Myers@Sun.COM void *Buffer,
7877851SDana.Myers@Sun.COM UINT32 BufferLength)
7887851SDana.Myers@Sun.COM {
7897851SDana.Myers@Sun.COM ACPI_STATUS Status;
7907851SDana.Myers@Sun.COM ACPI_INTEGER RawDatum;
7917851SDana.Myers@Sun.COM ACPI_INTEGER MergedDatum;
7927851SDana.Myers@Sun.COM UINT32 FieldOffset = 0;
7937851SDana.Myers@Sun.COM UINT32 BufferOffset = 0;
7947851SDana.Myers@Sun.COM UINT32 BufferTailBits;
7957851SDana.Myers@Sun.COM UINT32 DatumCount;
7967851SDana.Myers@Sun.COM UINT32 FieldDatumCount;
7977851SDana.Myers@Sun.COM UINT32 i;
7987851SDana.Myers@Sun.COM
7997851SDana.Myers@Sun.COM
8007851SDana.Myers@Sun.COM ACPI_FUNCTION_TRACE (ExExtractFromField);
8017851SDana.Myers@Sun.COM
8027851SDana.Myers@Sun.COM
8037851SDana.Myers@Sun.COM /* Validate target buffer and clear it */
8047851SDana.Myers@Sun.COM
8057851SDana.Myers@Sun.COM if (BufferLength <
8067851SDana.Myers@Sun.COM ACPI_ROUND_BITS_UP_TO_BYTES (ObjDesc->CommonField.BitLength))
8077851SDana.Myers@Sun.COM {
8087851SDana.Myers@Sun.COM ACPI_ERROR ((AE_INFO,
8097851SDana.Myers@Sun.COM "Field size %X (bits) is too large for buffer (%X)",
8107851SDana.Myers@Sun.COM ObjDesc->CommonField.BitLength, BufferLength));
8117851SDana.Myers@Sun.COM
8127851SDana.Myers@Sun.COM return_ACPI_STATUS (AE_BUFFER_OVERFLOW);
8137851SDana.Myers@Sun.COM }
8147851SDana.Myers@Sun.COM ACPI_MEMSET (Buffer, 0, BufferLength);
8157851SDana.Myers@Sun.COM
8167851SDana.Myers@Sun.COM /* Compute the number of datums (access width data items) */
8177851SDana.Myers@Sun.COM
8187851SDana.Myers@Sun.COM DatumCount = ACPI_ROUND_UP_TO (
8197851SDana.Myers@Sun.COM ObjDesc->CommonField.BitLength,
8207851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessBitWidth);
8217851SDana.Myers@Sun.COM FieldDatumCount = ACPI_ROUND_UP_TO (
8227851SDana.Myers@Sun.COM ObjDesc->CommonField.BitLength +
8237851SDana.Myers@Sun.COM ObjDesc->CommonField.StartFieldBitOffset,
8247851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessBitWidth);
8257851SDana.Myers@Sun.COM
8267851SDana.Myers@Sun.COM /* Priming read from the field */
8277851SDana.Myers@Sun.COM
8287851SDana.Myers@Sun.COM Status = AcpiExFieldDatumIo (ObjDesc, FieldOffset, &RawDatum, ACPI_READ);
8297851SDana.Myers@Sun.COM if (ACPI_FAILURE (Status))
8307851SDana.Myers@Sun.COM {
8317851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
8327851SDana.Myers@Sun.COM }
8337851SDana.Myers@Sun.COM MergedDatum = RawDatum >> ObjDesc->CommonField.StartFieldBitOffset;
8347851SDana.Myers@Sun.COM
8357851SDana.Myers@Sun.COM /* Read the rest of the field */
8367851SDana.Myers@Sun.COM
8377851SDana.Myers@Sun.COM for (i = 1; i < FieldDatumCount; i++)
8387851SDana.Myers@Sun.COM {
8397851SDana.Myers@Sun.COM /* Get next input datum from the field */
8407851SDana.Myers@Sun.COM
8417851SDana.Myers@Sun.COM FieldOffset += ObjDesc->CommonField.AccessByteWidth;
8427851SDana.Myers@Sun.COM Status = AcpiExFieldDatumIo (ObjDesc, FieldOffset,
8437851SDana.Myers@Sun.COM &RawDatum, ACPI_READ);
8447851SDana.Myers@Sun.COM if (ACPI_FAILURE (Status))
8457851SDana.Myers@Sun.COM {
8467851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
8477851SDana.Myers@Sun.COM }
8487851SDana.Myers@Sun.COM
8497851SDana.Myers@Sun.COM /*
8507851SDana.Myers@Sun.COM * Merge with previous datum if necessary.
8517851SDana.Myers@Sun.COM *
8527851SDana.Myers@Sun.COM * Note: Before the shift, check if the shift value will be larger than
8537851SDana.Myers@Sun.COM * the integer size. If so, there is no need to perform the operation.
8547851SDana.Myers@Sun.COM * This avoids the differences in behavior between different compilers
8557851SDana.Myers@Sun.COM * concerning shift values larger than the target data width.
8567851SDana.Myers@Sun.COM */
8577851SDana.Myers@Sun.COM if ((ObjDesc->CommonField.AccessBitWidth -
8587851SDana.Myers@Sun.COM ObjDesc->CommonField.StartFieldBitOffset) < ACPI_INTEGER_BIT_SIZE)
8597851SDana.Myers@Sun.COM {
8607851SDana.Myers@Sun.COM MergedDatum |= RawDatum <<
8617851SDana.Myers@Sun.COM (ObjDesc->CommonField.AccessBitWidth -
8627851SDana.Myers@Sun.COM ObjDesc->CommonField.StartFieldBitOffset);
8637851SDana.Myers@Sun.COM }
8647851SDana.Myers@Sun.COM
8657851SDana.Myers@Sun.COM if (i == DatumCount)
8667851SDana.Myers@Sun.COM {
8677851SDana.Myers@Sun.COM break;
8687851SDana.Myers@Sun.COM }
8697851SDana.Myers@Sun.COM
8707851SDana.Myers@Sun.COM /* Write merged datum to target buffer */
8717851SDana.Myers@Sun.COM
8727851SDana.Myers@Sun.COM ACPI_MEMCPY (((char *) Buffer) + BufferOffset, &MergedDatum,
8737851SDana.Myers@Sun.COM ACPI_MIN(ObjDesc->CommonField.AccessByteWidth,
8747851SDana.Myers@Sun.COM BufferLength - BufferOffset));
8757851SDana.Myers@Sun.COM
8767851SDana.Myers@Sun.COM BufferOffset += ObjDesc->CommonField.AccessByteWidth;
8777851SDana.Myers@Sun.COM MergedDatum = RawDatum >> ObjDesc->CommonField.StartFieldBitOffset;
8787851SDana.Myers@Sun.COM }
8797851SDana.Myers@Sun.COM
8807851SDana.Myers@Sun.COM /* Mask off any extra bits in the last datum */
8817851SDana.Myers@Sun.COM
8827851SDana.Myers@Sun.COM BufferTailBits = ObjDesc->CommonField.BitLength %
8837851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessBitWidth;
8847851SDana.Myers@Sun.COM if (BufferTailBits)
8857851SDana.Myers@Sun.COM {
8867851SDana.Myers@Sun.COM MergedDatum &= ACPI_MASK_BITS_ABOVE (BufferTailBits);
8877851SDana.Myers@Sun.COM }
8887851SDana.Myers@Sun.COM
8897851SDana.Myers@Sun.COM /* Write the last datum to the buffer */
8907851SDana.Myers@Sun.COM
8917851SDana.Myers@Sun.COM ACPI_MEMCPY (((char *) Buffer) + BufferOffset, &MergedDatum,
8927851SDana.Myers@Sun.COM ACPI_MIN(ObjDesc->CommonField.AccessByteWidth,
8937851SDana.Myers@Sun.COM BufferLength - BufferOffset));
8947851SDana.Myers@Sun.COM
8957851SDana.Myers@Sun.COM return_ACPI_STATUS (AE_OK);
8967851SDana.Myers@Sun.COM }
8977851SDana.Myers@Sun.COM
8987851SDana.Myers@Sun.COM
8997851SDana.Myers@Sun.COM /*******************************************************************************
9007851SDana.Myers@Sun.COM *
9017851SDana.Myers@Sun.COM * FUNCTION: AcpiExInsertIntoField
9027851SDana.Myers@Sun.COM *
9037851SDana.Myers@Sun.COM * PARAMETERS: ObjDesc - Field to be written
9047851SDana.Myers@Sun.COM * Buffer - Data to be written
9057851SDana.Myers@Sun.COM * BufferLength - Length of Buffer
9067851SDana.Myers@Sun.COM *
9077851SDana.Myers@Sun.COM * RETURN: Status
9087851SDana.Myers@Sun.COM *
9097851SDana.Myers@Sun.COM * DESCRIPTION: Store the Buffer contents into the given field
9107851SDana.Myers@Sun.COM *
9117851SDana.Myers@Sun.COM ******************************************************************************/
9127851SDana.Myers@Sun.COM
9137851SDana.Myers@Sun.COM ACPI_STATUS
AcpiExInsertIntoField(ACPI_OPERAND_OBJECT * ObjDesc,void * Buffer,UINT32 BufferLength)9147851SDana.Myers@Sun.COM AcpiExInsertIntoField (
9157851SDana.Myers@Sun.COM ACPI_OPERAND_OBJECT *ObjDesc,
9167851SDana.Myers@Sun.COM void *Buffer,
9177851SDana.Myers@Sun.COM UINT32 BufferLength)
9187851SDana.Myers@Sun.COM {
9197851SDana.Myers@Sun.COM ACPI_STATUS Status;
9207851SDana.Myers@Sun.COM ACPI_INTEGER Mask;
9217851SDana.Myers@Sun.COM ACPI_INTEGER WidthMask;
9227851SDana.Myers@Sun.COM ACPI_INTEGER MergedDatum;
9237851SDana.Myers@Sun.COM ACPI_INTEGER RawDatum = 0;
9247851SDana.Myers@Sun.COM UINT32 FieldOffset = 0;
9257851SDana.Myers@Sun.COM UINT32 BufferOffset = 0;
9267851SDana.Myers@Sun.COM UINT32 BufferTailBits;
9277851SDana.Myers@Sun.COM UINT32 DatumCount;
9287851SDana.Myers@Sun.COM UINT32 FieldDatumCount;
9297851SDana.Myers@Sun.COM UINT32 i;
9307851SDana.Myers@Sun.COM UINT32 RequiredLength;
9317851SDana.Myers@Sun.COM void *NewBuffer;
9327851SDana.Myers@Sun.COM
9337851SDana.Myers@Sun.COM
9347851SDana.Myers@Sun.COM ACPI_FUNCTION_TRACE (ExInsertIntoField);
9357851SDana.Myers@Sun.COM
9367851SDana.Myers@Sun.COM
9377851SDana.Myers@Sun.COM /* Validate input buffer */
9387851SDana.Myers@Sun.COM
9397851SDana.Myers@Sun.COM NewBuffer = NULL;
9407851SDana.Myers@Sun.COM RequiredLength = ACPI_ROUND_BITS_UP_TO_BYTES (
9417851SDana.Myers@Sun.COM ObjDesc->CommonField.BitLength);
9427851SDana.Myers@Sun.COM /*
9437851SDana.Myers@Sun.COM * We must have a buffer that is at least as long as the field
9447851SDana.Myers@Sun.COM * we are writing to. This is because individual fields are
9457851SDana.Myers@Sun.COM * indivisible and partial writes are not supported -- as per
9467851SDana.Myers@Sun.COM * the ACPI specification.
9477851SDana.Myers@Sun.COM */
9487851SDana.Myers@Sun.COM if (BufferLength < RequiredLength)
9497851SDana.Myers@Sun.COM {
9507851SDana.Myers@Sun.COM /* We need to create a new buffer */
9517851SDana.Myers@Sun.COM
9527851SDana.Myers@Sun.COM NewBuffer = ACPI_ALLOCATE_ZEROED (RequiredLength);
9537851SDana.Myers@Sun.COM if (!NewBuffer)
9547851SDana.Myers@Sun.COM {
9557851SDana.Myers@Sun.COM return_ACPI_STATUS (AE_NO_MEMORY);
9567851SDana.Myers@Sun.COM }
9577851SDana.Myers@Sun.COM
9587851SDana.Myers@Sun.COM /*
9597851SDana.Myers@Sun.COM * Copy the original data to the new buffer, starting
9607851SDana.Myers@Sun.COM * at Byte zero. All unused (upper) bytes of the
9617851SDana.Myers@Sun.COM * buffer will be 0.
9627851SDana.Myers@Sun.COM */
9637851SDana.Myers@Sun.COM ACPI_MEMCPY ((char *) NewBuffer, (char *) Buffer, BufferLength);
9647851SDana.Myers@Sun.COM Buffer = NewBuffer;
9657851SDana.Myers@Sun.COM BufferLength = RequiredLength;
9667851SDana.Myers@Sun.COM }
9677851SDana.Myers@Sun.COM
9687851SDana.Myers@Sun.COM /*
9697851SDana.Myers@Sun.COM * Create the bitmasks used for bit insertion.
9707851SDana.Myers@Sun.COM * Note: This if/else is used to bypass compiler differences with the
9717851SDana.Myers@Sun.COM * shift operator
9727851SDana.Myers@Sun.COM */
9737851SDana.Myers@Sun.COM if (ObjDesc->CommonField.AccessBitWidth == ACPI_INTEGER_BIT_SIZE)
9747851SDana.Myers@Sun.COM {
9757851SDana.Myers@Sun.COM WidthMask = ACPI_INTEGER_MAX;
9767851SDana.Myers@Sun.COM }
9777851SDana.Myers@Sun.COM else
9787851SDana.Myers@Sun.COM {
9797851SDana.Myers@Sun.COM WidthMask = ACPI_MASK_BITS_ABOVE (ObjDesc->CommonField.AccessBitWidth);
9807851SDana.Myers@Sun.COM }
9817851SDana.Myers@Sun.COM
9827851SDana.Myers@Sun.COM Mask = WidthMask &
9837851SDana.Myers@Sun.COM ACPI_MASK_BITS_BELOW (ObjDesc->CommonField.StartFieldBitOffset);
9847851SDana.Myers@Sun.COM
9857851SDana.Myers@Sun.COM /* Compute the number of datums (access width data items) */
9867851SDana.Myers@Sun.COM
9877851SDana.Myers@Sun.COM DatumCount = ACPI_ROUND_UP_TO (ObjDesc->CommonField.BitLength,
9887851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessBitWidth);
9897851SDana.Myers@Sun.COM
9907851SDana.Myers@Sun.COM FieldDatumCount = ACPI_ROUND_UP_TO (ObjDesc->CommonField.BitLength +
9917851SDana.Myers@Sun.COM ObjDesc->CommonField.StartFieldBitOffset,
9927851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessBitWidth);
9937851SDana.Myers@Sun.COM
9947851SDana.Myers@Sun.COM /* Get initial Datum from the input buffer */
9957851SDana.Myers@Sun.COM
9967851SDana.Myers@Sun.COM ACPI_MEMCPY (&RawDatum, Buffer,
9977851SDana.Myers@Sun.COM ACPI_MIN(ObjDesc->CommonField.AccessByteWidth,
9987851SDana.Myers@Sun.COM BufferLength - BufferOffset));
9997851SDana.Myers@Sun.COM
10007851SDana.Myers@Sun.COM MergedDatum = RawDatum << ObjDesc->CommonField.StartFieldBitOffset;
10017851SDana.Myers@Sun.COM
10027851SDana.Myers@Sun.COM /* Write the entire field */
10037851SDana.Myers@Sun.COM
10047851SDana.Myers@Sun.COM for (i = 1; i < FieldDatumCount; i++)
10057851SDana.Myers@Sun.COM {
10067851SDana.Myers@Sun.COM /* Write merged datum to the target field */
10077851SDana.Myers@Sun.COM
10087851SDana.Myers@Sun.COM MergedDatum &= Mask;
10097851SDana.Myers@Sun.COM Status = AcpiExWriteWithUpdateRule (ObjDesc, Mask,
10107851SDana.Myers@Sun.COM MergedDatum, FieldOffset);
10117851SDana.Myers@Sun.COM if (ACPI_FAILURE (Status))
10127851SDana.Myers@Sun.COM {
10137851SDana.Myers@Sun.COM goto Exit;
10147851SDana.Myers@Sun.COM }
10157851SDana.Myers@Sun.COM
10167851SDana.Myers@Sun.COM FieldOffset += ObjDesc->CommonField.AccessByteWidth;
10177851SDana.Myers@Sun.COM
10187851SDana.Myers@Sun.COM /*
10197851SDana.Myers@Sun.COM * Start new output datum by merging with previous input datum
10207851SDana.Myers@Sun.COM * if necessary.
10217851SDana.Myers@Sun.COM *
10227851SDana.Myers@Sun.COM * Note: Before the shift, check if the shift value will be larger than
10237851SDana.Myers@Sun.COM * the integer size. If so, there is no need to perform the operation.
10247851SDana.Myers@Sun.COM * This avoids the differences in behavior between different compilers
10257851SDana.Myers@Sun.COM * concerning shift values larger than the target data width.
10267851SDana.Myers@Sun.COM */
10277851SDana.Myers@Sun.COM if ((ObjDesc->CommonField.AccessBitWidth -
10287851SDana.Myers@Sun.COM ObjDesc->CommonField.StartFieldBitOffset) < ACPI_INTEGER_BIT_SIZE)
10297851SDana.Myers@Sun.COM {
10307851SDana.Myers@Sun.COM MergedDatum = RawDatum >>
10317851SDana.Myers@Sun.COM (ObjDesc->CommonField.AccessBitWidth -
10327851SDana.Myers@Sun.COM ObjDesc->CommonField.StartFieldBitOffset);
10337851SDana.Myers@Sun.COM }
10347851SDana.Myers@Sun.COM else
10357851SDana.Myers@Sun.COM {
10367851SDana.Myers@Sun.COM MergedDatum = 0;
10377851SDana.Myers@Sun.COM }
10387851SDana.Myers@Sun.COM
10397851SDana.Myers@Sun.COM Mask = WidthMask;
10407851SDana.Myers@Sun.COM
10417851SDana.Myers@Sun.COM if (i == DatumCount)
10427851SDana.Myers@Sun.COM {
10437851SDana.Myers@Sun.COM break;
10447851SDana.Myers@Sun.COM }
10457851SDana.Myers@Sun.COM
10467851SDana.Myers@Sun.COM /* Get the next input datum from the buffer */
10477851SDana.Myers@Sun.COM
10487851SDana.Myers@Sun.COM BufferOffset += ObjDesc->CommonField.AccessByteWidth;
10497851SDana.Myers@Sun.COM ACPI_MEMCPY (&RawDatum, ((char *) Buffer) + BufferOffset,
10507851SDana.Myers@Sun.COM ACPI_MIN(ObjDesc->CommonField.AccessByteWidth,
10517851SDana.Myers@Sun.COM BufferLength - BufferOffset));
10527851SDana.Myers@Sun.COM MergedDatum |= RawDatum << ObjDesc->CommonField.StartFieldBitOffset;
10537851SDana.Myers@Sun.COM }
10547851SDana.Myers@Sun.COM
10557851SDana.Myers@Sun.COM /* Mask off any extra bits in the last datum */
10567851SDana.Myers@Sun.COM
10577851SDana.Myers@Sun.COM BufferTailBits = (ObjDesc->CommonField.BitLength +
10587851SDana.Myers@Sun.COM ObjDesc->CommonField.StartFieldBitOffset) %
10597851SDana.Myers@Sun.COM ObjDesc->CommonField.AccessBitWidth;
10607851SDana.Myers@Sun.COM if (BufferTailBits)
10617851SDana.Myers@Sun.COM {
10627851SDana.Myers@Sun.COM Mask &= ACPI_MASK_BITS_ABOVE (BufferTailBits);
10637851SDana.Myers@Sun.COM }
10647851SDana.Myers@Sun.COM
10657851SDana.Myers@Sun.COM /* Write the last datum to the field */
10667851SDana.Myers@Sun.COM
10677851SDana.Myers@Sun.COM MergedDatum &= Mask;
10687851SDana.Myers@Sun.COM Status = AcpiExWriteWithUpdateRule (ObjDesc,
10697851SDana.Myers@Sun.COM Mask, MergedDatum, FieldOffset);
10707851SDana.Myers@Sun.COM
10717851SDana.Myers@Sun.COM Exit:
10727851SDana.Myers@Sun.COM /* Free temporary buffer if we used one */
10737851SDana.Myers@Sun.COM
10747851SDana.Myers@Sun.COM if (NewBuffer)
10757851SDana.Myers@Sun.COM {
10767851SDana.Myers@Sun.COM ACPI_FREE (NewBuffer);
10777851SDana.Myers@Sun.COM }
10787851SDana.Myers@Sun.COM return_ACPI_STATUS (Status);
10797851SDana.Myers@Sun.COM }
10807851SDana.Myers@Sun.COM
10817851SDana.Myers@Sun.COM
1082