xref: /onnv-gate/usr/src/uts/intel/io/acpica/executer/exfldio.c (revision 11225:eb6056029d84)
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