xref: /titanic_51/usr/src/uts/intel/io/acpica/executer/exfldio.c (revision 7ff836697c120cb94bd30d5c2204eb9b74718e4c)
1 /******************************************************************************
2  *
3  * Module Name: exfldio - Aml Field I/O
4  *
5  *****************************************************************************/
6 
7 /******************************************************************************
8  *
9  * 1. Copyright Notice
10  *
11  * Some or all of this work - Copyright (c) 1999 - 2009, Intel Corp.
12  * All rights reserved.
13  *
14  * 2. License
15  *
16  * 2.1. This is your license from Intel Corp. under its intellectual property
17  * rights.  You may have additional license terms from the party that provided
18  * you this software, covering your right to use that party's intellectual
19  * property rights.
20  *
21  * 2.2. Intel grants, free of charge, to any person ("Licensee") obtaining a
22  * copy of the source code appearing in this file ("Covered Code") an
23  * irrevocable, perpetual, worldwide license under Intel's copyrights in the
24  * base code distributed originally by Intel ("Original Intel Code") to copy,
25  * make derivatives, distribute, use and display any portion of the Covered
26  * Code in any form, with the right to sublicense such rights; and
27  *
28  * 2.3. Intel grants Licensee a non-exclusive and non-transferable patent
29  * license (with the right to sublicense), under only those claims of Intel
30  * patents that are infringed by the Original Intel Code, to make, use, sell,
31  * offer to sell, and import the Covered Code and derivative works thereof
32  * solely to the minimum extent necessary to exercise the above copyright
33  * license, and in no event shall the patent license extend to any additions
34  * to or modifications of the Original Intel Code.  No other license or right
35  * is granted directly or by implication, estoppel or otherwise;
36  *
37  * The above copyright and patent license is granted only if the following
38  * conditions are met:
39  *
40  * 3. Conditions
41  *
42  * 3.1. Redistribution of Source with Rights to Further Distribute Source.
43  * Redistribution of source code of any substantial portion of the Covered
44  * Code or modification with rights to further distribute source must include
45  * the above Copyright Notice, the above License, this list of Conditions,
46  * and the following Disclaimer and Export Compliance provision.  In addition,
47  * Licensee must cause all Covered Code to which Licensee contributes to
48  * contain a file documenting the changes Licensee made to create that Covered
49  * Code and the date of any change.  Licensee must include in that file the
50  * documentation of any changes made by any predecessor Licensee.  Licensee
51  * must include a prominent statement that the modification is derived,
52  * directly or indirectly, from Original Intel Code.
53  *
54  * 3.2. Redistribution of Source with no Rights to Further Distribute Source.
55  * Redistribution of source code of any substantial portion of the Covered
56  * Code or modification without rights to further distribute source must
57  * include the following Disclaimer and Export Compliance provision in the
58  * documentation and/or other materials provided with distribution.  In
59  * addition, Licensee may not authorize further sublicense of source of any
60  * portion of the Covered Code, and must include terms to the effect that the
61  * license from Licensee to its licensee is limited to the intellectual
62  * property embodied in the software Licensee provides to its licensee, and
63  * not to intellectual property embodied in modifications its licensee may
64  * make.
65  *
66  * 3.3. Redistribution of Executable. Redistribution in executable form of any
67  * substantial portion of the Covered Code or modification must reproduce the
68  * above Copyright Notice, and the following Disclaimer and Export Compliance
69  * provision in the documentation and/or other materials provided with the
70  * distribution.
71  *
72  * 3.4. Intel retains all right, title, and interest in and to the Original
73  * Intel Code.
74  *
75  * 3.5. Neither the name Intel nor any other trademark owned or controlled by
76  * Intel shall be used in advertising or otherwise to promote the sale, use or
77  * other dealings in products derived from or relating to the Covered Code
78  * without prior written authorization from Intel.
79  *
80  * 4. Disclaimer and Export Compliance
81  *
82  * 4.1. INTEL MAKES NO WARRANTY OF ANY KIND REGARDING ANY SOFTWARE PROVIDED
83  * HERE.  ANY SOFTWARE ORIGINATING FROM INTEL OR DERIVED FROM INTEL SOFTWARE
84  * IS PROVIDED "AS IS," AND INTEL WILL NOT PROVIDE ANY SUPPORT,  ASSISTANCE,
85  * INSTALLATION, TRAINING OR OTHER SERVICES.  INTEL WILL NOT PROVIDE ANY
86  * UPDATES, ENHANCEMENTS OR EXTENSIONS.  INTEL SPECIFICALLY DISCLAIMS ANY
87  * IMPLIED WARRANTIES OF MERCHANTABILITY, NONINFRINGEMENT AND FITNESS FOR A
88  * PARTICULAR PURPOSE.
89  *
90  * 4.2. IN NO EVENT SHALL INTEL HAVE ANY LIABILITY TO LICENSEE, ITS LICENSEES
91  * OR ANY OTHER THIRD PARTY, FOR ANY LOST PROFITS, LOST DATA, LOSS OF USE OR
92  * COSTS OF PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES, OR FOR ANY INDIRECT,
93  * SPECIAL OR CONSEQUENTIAL DAMAGES ARISING OUT OF THIS AGREEMENT, UNDER ANY
94  * CAUSE OF ACTION OR THEORY OF LIABILITY, AND IRRESPECTIVE OF WHETHER INTEL
95  * HAS ADVANCE NOTICE OF THE POSSIBILITY OF SUCH DAMAGES.  THESE LIMITATIONS
96  * SHALL APPLY NOTWITHSTANDING THE FAILURE OF THE ESSENTIAL PURPOSE OF ANY
97  * LIMITED REMEDY.
98  *
99  * 4.3. Licensee shall not export, either directly or indirectly, any of this
100  * software or system incorporating such software without first obtaining any
101  * required license or other approval from the U. S. Department of Commerce or
102  * any other agency or department of the United States Government.  In the
103  * event Licensee exports any such software from the United States or
104  * re-exports any such software from a foreign destination, Licensee shall
105  * ensure that the distribution and export/re-export of the software is in
106  * compliance with all laws, regulations, orders, or other restrictions of the
107  * U.S. Export Administration Regulations. Licensee agrees that neither it nor
108  * any of its subsidiaries will export/re-export any technical data, process,
109  * software, or service, directly or indirectly, to any country for which the
110  * United States government or any agency thereof requires an export license,
111  * other governmental approval, or letter of assurance, without first obtaining
112  * such license, approval or letter.
113  *
114  *****************************************************************************/
115 
116 
117 #define __EXFLDIO_C__
118 
119 #include "acpi.h"
120 #include "accommon.h"
121 #include "acinterp.h"
122 #include "amlcode.h"
123 #include "acevents.h"
124 #include "acdispat.h"
125 
126 
127 #define _COMPONENT          ACPI_EXECUTER
128         ACPI_MODULE_NAME    ("exfldio")
129 
130 /* Local prototypes */
131 
132 static ACPI_STATUS
133 AcpiExFieldDatumIo (
134     ACPI_OPERAND_OBJECT     *ObjDesc,
135     UINT32                  FieldDatumByteOffset,
136     ACPI_INTEGER            *Value,
137     UINT32                  ReadWrite);
138 
139 static BOOLEAN
140 AcpiExRegisterOverflow (
141     ACPI_OPERAND_OBJECT     *ObjDesc,
142     ACPI_INTEGER            Value);
143 
144 static ACPI_STATUS
145 AcpiExSetupRegion (
146     ACPI_OPERAND_OBJECT     *ObjDesc,
147     UINT32                  FieldDatumByteOffset);
148 
149 
150 /*******************************************************************************
151  *
152  * FUNCTION:    AcpiExSetupRegion
153  *
154  * PARAMETERS:  ObjDesc                 - Field to be read or written
155  *              FieldDatumByteOffset    - Byte offset of this datum within the
156  *                                        parent field
157  *
158  * RETURN:      Status
159  *
160  * DESCRIPTION: Common processing for AcpiExExtractFromField and
161  *              AcpiExInsertIntoField.  Initialize the Region if necessary and
162  *              validate the request.
163  *
164  ******************************************************************************/
165 
166 static ACPI_STATUS
167 AcpiExSetupRegion (
168     ACPI_OPERAND_OBJECT     *ObjDesc,
169     UINT32                  FieldDatumByteOffset)
170 {
171     ACPI_STATUS             Status = AE_OK;
172     ACPI_OPERAND_OBJECT     *RgnDesc;
173 
174 
175     ACPI_FUNCTION_TRACE_U32 (ExSetupRegion, FieldDatumByteOffset);
176 
177 
178     RgnDesc = ObjDesc->CommonField.RegionObj;
179 
180     /* We must have a valid region */
181 
182     if (RgnDesc->Common.Type != ACPI_TYPE_REGION)
183     {
184         ACPI_ERROR ((AE_INFO, "Needed Region, found type %X (%s)",
185             RgnDesc->Common.Type,
186             AcpiUtGetObjectTypeName (RgnDesc)));
187 
188         return_ACPI_STATUS (AE_AML_OPERAND_TYPE);
189     }
190 
191     /*
192      * If the Region Address and Length have not been previously evaluated,
193      * evaluate them now and save the results.
194      */
195     if (!(RgnDesc->Common.Flags & AOPOBJ_DATA_VALID))
196     {
197         Status = AcpiDsGetRegionArguments (RgnDesc);
198         if (ACPI_FAILURE (Status))
199         {
200             return_ACPI_STATUS (Status);
201         }
202     }
203 
204     /*
205      * Exit now for SMBus address space, it has a non-linear address space
206      * and the request cannot be directly validated
207      */
208     if (RgnDesc->Region.SpaceId == ACPI_ADR_SPACE_SMBUS)
209     {
210         /* SMBus has a non-linear address space */
211 
212         return_ACPI_STATUS (AE_OK);
213     }
214 
215 #ifdef ACPI_UNDER_DEVELOPMENT
216     /*
217      * If the Field access is AnyAcc, we can now compute the optimal
218      * access (because we know know the length of the parent region)
219      */
220     if (!(ObjDesc->Common.Flags & AOPOBJ_DATA_VALID))
221     {
222         if (ACPI_FAILURE (Status))
223         {
224             return_ACPI_STATUS (Status);
225         }
226     }
227 #endif
228 
229     /*
230      * Validate the request.  The entire request from the byte offset for a
231      * length of one field datum (access width) must fit within the region.
232      * (Region length is specified in bytes)
233      */
234     if (RgnDesc->Region.Length <
235             (ObjDesc->CommonField.BaseByteOffset +
236             FieldDatumByteOffset +
237             ObjDesc->CommonField.AccessByteWidth))
238     {
239         if (AcpiGbl_EnableInterpreterSlack)
240         {
241             /*
242              * Slack mode only:  We will go ahead and allow access to this
243              * field if it is within the region length rounded up to the next
244              * access width boundary. ACPI_SIZE cast for 64-bit compile.
245              */
246             if (ACPI_ROUND_UP (RgnDesc->Region.Length,
247                     ObjDesc->CommonField.AccessByteWidth) >=
248                 ((ACPI_SIZE) ObjDesc->CommonField.BaseByteOffset +
249                     ObjDesc->CommonField.AccessByteWidth +
250                     FieldDatumByteOffset))
251             {
252                 return_ACPI_STATUS (AE_OK);
253             }
254         }
255 
256         if (RgnDesc->Region.Length < ObjDesc->CommonField.AccessByteWidth)
257         {
258             /*
259              * This is the case where the AccessType (AccWord, etc.) is wider
260              * than the region itself.  For example, a region of length one
261              * byte, and a field with Dword access specified.
262              */
263             ACPI_ERROR ((AE_INFO,
264                 "Field [%4.4s] access width (%d bytes) too large for region [%4.4s] (length %X)",
265                 AcpiUtGetNodeName (ObjDesc->CommonField.Node),
266                 ObjDesc->CommonField.AccessByteWidth,
267                 AcpiUtGetNodeName (RgnDesc->Region.Node),
268                 RgnDesc->Region.Length));
269         }
270 
271         /*
272          * Offset rounded up to next multiple of field width
273          * exceeds region length, indicate an error
274          */
275         ACPI_ERROR ((AE_INFO,
276             "Field [%4.4s] Base+Offset+Width %X+%X+%X is beyond end of region [%4.4s] (length %X)",
277             AcpiUtGetNodeName (ObjDesc->CommonField.Node),
278             ObjDesc->CommonField.BaseByteOffset,
279             FieldDatumByteOffset, ObjDesc->CommonField.AccessByteWidth,
280             AcpiUtGetNodeName (RgnDesc->Region.Node),
281             RgnDesc->Region.Length));
282 
283         return_ACPI_STATUS (AE_AML_REGION_LIMIT);
284     }
285 
286     return_ACPI_STATUS (AE_OK);
287 }
288 
289 
290 /*******************************************************************************
291  *
292  * FUNCTION:    AcpiExAccessRegion
293  *
294  * PARAMETERS:  ObjDesc                 - Field to be read
295  *              FieldDatumByteOffset    - Byte offset of this datum within the
296  *                                        parent field
297  *              Value                   - Where to store value (must at least
298  *                                        the size of ACPI_INTEGER)
299  *              Function                - Read or Write flag plus other region-
300  *                                        dependent flags
301  *
302  * RETURN:      Status
303  *
304  * DESCRIPTION: Read or Write a single field datum to an Operation Region.
305  *
306  ******************************************************************************/
307 
308 ACPI_STATUS
309 AcpiExAccessRegion (
310     ACPI_OPERAND_OBJECT     *ObjDesc,
311     UINT32                  FieldDatumByteOffset,
312     ACPI_INTEGER            *Value,
313     UINT32                  Function)
314 {
315     ACPI_STATUS             Status;
316     ACPI_OPERAND_OBJECT     *RgnDesc;
317     UINT32                  RegionOffset;
318 
319 
320     ACPI_FUNCTION_TRACE (ExAccessRegion);
321 
322 
323     /*
324      * Ensure that the region operands are fully evaluated and verify
325      * the validity of the request
326      */
327     Status = AcpiExSetupRegion (ObjDesc, FieldDatumByteOffset);
328     if (ACPI_FAILURE (Status))
329     {
330         return_ACPI_STATUS (Status);
331     }
332 
333     /*
334      * The physical address of this field datum is:
335      *
336      * 1) The base of the region, plus
337      * 2) The base offset of the field, plus
338      * 3) The current offset into the field
339      */
340     RgnDesc = ObjDesc->CommonField.RegionObj;
341     RegionOffset =
342         ObjDesc->CommonField.BaseByteOffset +
343         FieldDatumByteOffset;
344 
345     if ((Function & ACPI_IO_MASK) == ACPI_READ)
346     {
347         ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD, "[READ]"));
348     }
349     else
350     {
351         ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD, "[WRITE]"));
352     }
353 
354     ACPI_DEBUG_PRINT_RAW ((ACPI_DB_BFIELD,
355         " Region [%s:%X], Width %X, ByteBase %X, Offset %X at %p\n",
356         AcpiUtGetRegionName (RgnDesc->Region.SpaceId),
357         RgnDesc->Region.SpaceId,
358         ObjDesc->CommonField.AccessByteWidth,
359         ObjDesc->CommonField.BaseByteOffset,
360         FieldDatumByteOffset,
361         ACPI_CAST_PTR (void, (RgnDesc->Region.Address + RegionOffset))));
362 
363     /* Invoke the appropriate AddressSpace/OpRegion handler */
364 
365     Status = AcpiEvAddressSpaceDispatch (RgnDesc, Function, RegionOffset,
366                 ACPI_MUL_8 (ObjDesc->CommonField.AccessByteWidth), Value);
367 
368     if (ACPI_FAILURE (Status))
369     {
370         if (Status == AE_NOT_IMPLEMENTED)
371         {
372             ACPI_ERROR ((AE_INFO,
373                 "Region %s(%X) not implemented",
374                 AcpiUtGetRegionName (RgnDesc->Region.SpaceId),
375                 RgnDesc->Region.SpaceId));
376         }
377         else if (Status == AE_NOT_EXIST)
378         {
379             ACPI_ERROR ((AE_INFO,
380                 "Region %s(%X) has no handler",
381                 AcpiUtGetRegionName (RgnDesc->Region.SpaceId),
382                 RgnDesc->Region.SpaceId));
383         }
384     }
385 
386     return_ACPI_STATUS (Status);
387 }
388 
389 
390 /*******************************************************************************
391  *
392  * FUNCTION:    AcpiExRegisterOverflow
393  *
394  * PARAMETERS:  ObjDesc                 - Register(Field) to be written
395  *              Value                   - Value to be stored
396  *
397  * RETURN:      TRUE if value overflows the field, FALSE otherwise
398  *
399  * DESCRIPTION: Check if a value is out of range of the field being written.
400  *              Used to check if the values written to Index and Bank registers
401  *              are out of range.  Normally, the value is simply truncated
402  *              to fit the field, but this case is most likely a serious
403  *              coding error in the ASL.
404  *
405  ******************************************************************************/
406 
407 static BOOLEAN
408 AcpiExRegisterOverflow (
409     ACPI_OPERAND_OBJECT     *ObjDesc,
410     ACPI_INTEGER            Value)
411 {
412 
413     if (ObjDesc->CommonField.BitLength >= ACPI_INTEGER_BIT_SIZE)
414     {
415         /*
416          * The field is large enough to hold the maximum integer, so we can
417          * never overflow it.
418          */
419         return (FALSE);
420     }
421 
422     if (Value >= ((ACPI_INTEGER) 1 << ObjDesc->CommonField.BitLength))
423     {
424         /*
425          * The Value is larger than the maximum value that can fit into
426          * the register.
427          */
428         return (TRUE);
429     }
430 
431     /* The Value will fit into the field with no truncation */
432 
433     return (FALSE);
434 }
435 
436 
437 /*******************************************************************************
438  *
439  * FUNCTION:    AcpiExFieldDatumIo
440  *
441  * PARAMETERS:  ObjDesc                 - Field to be read
442  *              FieldDatumByteOffset    - Byte offset of this datum within the
443  *                                        parent field
444  *              Value                   - Where to store value (must be 64 bits)
445  *              ReadWrite               - Read or Write flag
446  *
447  * RETURN:      Status
448  *
449  * DESCRIPTION: Read or Write a single datum of a field.  The FieldType is
450  *              demultiplexed here to handle the different types of fields
451  *              (BufferField, RegionField, IndexField, BankField)
452  *
453  ******************************************************************************/
454 
455 static ACPI_STATUS
456 AcpiExFieldDatumIo (
457     ACPI_OPERAND_OBJECT     *ObjDesc,
458     UINT32                  FieldDatumByteOffset,
459     ACPI_INTEGER            *Value,
460     UINT32                  ReadWrite)
461 {
462     ACPI_STATUS             Status;
463     ACPI_INTEGER            LocalValue;
464 
465 
466     ACPI_FUNCTION_TRACE_U32 (ExFieldDatumIo, FieldDatumByteOffset);
467 
468 
469     if (ReadWrite == ACPI_READ)
470     {
471         if (!Value)
472         {
473             LocalValue = 0;
474 
475             /* To support reads without saving return value */
476             Value = &LocalValue;
477         }
478 
479         /* Clear the entire return buffer first, [Very Important!] */
480 
481         *Value = 0;
482     }
483 
484     /*
485      * The four types of fields are:
486      *
487      * BufferField - Read/write from/to a Buffer
488      * RegionField - Read/write from/to a Operation Region.
489      * BankField   - Write to a Bank Register, then read/write from/to an
490      *               OperationRegion
491      * IndexField  - Write to an Index Register, then read/write from/to a
492      *               Data Register
493      */
494     switch (ObjDesc->Common.Type)
495     {
496     case ACPI_TYPE_BUFFER_FIELD:
497         /*
498          * If the BufferField arguments have not been previously evaluated,
499          * evaluate them now and save the results.
500          */
501         if (!(ObjDesc->Common.Flags & AOPOBJ_DATA_VALID))
502         {
503             Status = AcpiDsGetBufferFieldArguments (ObjDesc);
504             if (ACPI_FAILURE (Status))
505             {
506                 return_ACPI_STATUS (Status);
507             }
508         }
509 
510         if (ReadWrite == ACPI_READ)
511         {
512             /*
513              * Copy the data from the source buffer.
514              * Length is the field width in bytes.
515              */
516             ACPI_MEMCPY (Value,
517                 (ObjDesc->BufferField.BufferObj)->Buffer.Pointer +
518                     ObjDesc->BufferField.BaseByteOffset +
519                     FieldDatumByteOffset,
520                 ObjDesc->CommonField.AccessByteWidth);
521         }
522         else
523         {
524             /*
525              * Copy the data to the target buffer.
526              * Length is the field width in bytes.
527              */
528             ACPI_MEMCPY ((ObjDesc->BufferField.BufferObj)->Buffer.Pointer +
529                 ObjDesc->BufferField.BaseByteOffset +
530                 FieldDatumByteOffset,
531                 Value, ObjDesc->CommonField.AccessByteWidth);
532         }
533 
534         Status = AE_OK;
535         break;
536 
537 
538     case ACPI_TYPE_LOCAL_BANK_FIELD:
539 
540         /*
541          * Ensure that the BankValue is not beyond the capacity of
542          * the register
543          */
544         if (AcpiExRegisterOverflow (ObjDesc->BankField.BankObj,
545                 (ACPI_INTEGER) ObjDesc->BankField.Value))
546         {
547             return_ACPI_STATUS (AE_AML_REGISTER_LIMIT);
548         }
549 
550         /*
551          * For BankFields, we must write the BankValue to the BankRegister
552          * (itself a RegionField) before we can access the data.
553          */
554         Status = AcpiExInsertIntoField (ObjDesc->BankField.BankObj,
555                     &ObjDesc->BankField.Value,
556                     sizeof (ObjDesc->BankField.Value));
557         if (ACPI_FAILURE (Status))
558         {
559             return_ACPI_STATUS (Status);
560         }
561 
562         /*
563          * Now that the Bank has been selected, fall through to the
564          * RegionField case and write the datum to the Operation Region
565          */
566 
567         /*lint -fallthrough */
568 
569 
570     case ACPI_TYPE_LOCAL_REGION_FIELD:
571         /*
572          * For simple RegionFields, we just directly access the owning
573          * Operation Region.
574          */
575         Status = AcpiExAccessRegion (ObjDesc, FieldDatumByteOffset, Value,
576                     ReadWrite);
577         break;
578 
579 
580     case ACPI_TYPE_LOCAL_INDEX_FIELD:
581 
582 
583         /*
584          * Ensure that the IndexValue is not beyond the capacity of
585          * the register
586          */
587         if (AcpiExRegisterOverflow (ObjDesc->IndexField.IndexObj,
588                 (ACPI_INTEGER) ObjDesc->IndexField.Value))
589         {
590             return_ACPI_STATUS (AE_AML_REGISTER_LIMIT);
591         }
592 
593         /* Write the index value to the IndexRegister (itself a RegionField) */
594 
595         FieldDatumByteOffset += ObjDesc->IndexField.Value;
596 
597         ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
598             "Write to Index Register: Value %8.8X\n",
599             FieldDatumByteOffset));
600 
601         Status = AcpiExInsertIntoField (ObjDesc->IndexField.IndexObj,
602                     &FieldDatumByteOffset,
603                     sizeof (FieldDatumByteOffset));
604         if (ACPI_FAILURE (Status))
605         {
606             return_ACPI_STATUS (Status);
607         }
608 
609         if (ReadWrite == ACPI_READ)
610         {
611             /* Read the datum from the DataRegister */
612 
613             ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
614                 "Read from Data Register\n"));
615 
616             Status = AcpiExExtractFromField (ObjDesc->IndexField.DataObj,
617                         Value, sizeof (ACPI_INTEGER));
618         }
619         else
620         {
621             /* Write the datum to the DataRegister */
622 
623             ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
624                 "Write to Data Register: Value %8.8X%8.8X\n",
625                 ACPI_FORMAT_UINT64 (*Value)));
626 
627             Status = AcpiExInsertIntoField (ObjDesc->IndexField.DataObj,
628                         Value, sizeof (ACPI_INTEGER));
629         }
630         break;
631 
632 
633     default:
634 
635         ACPI_ERROR ((AE_INFO, "Wrong object type in field I/O %X",
636             ObjDesc->Common.Type));
637         Status = AE_AML_INTERNAL;
638         break;
639     }
640 
641     if (ACPI_SUCCESS (Status))
642     {
643         if (ReadWrite == ACPI_READ)
644         {
645             ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
646                 "Value Read %8.8X%8.8X, Width %d\n",
647                 ACPI_FORMAT_UINT64 (*Value),
648                 ObjDesc->CommonField.AccessByteWidth));
649         }
650         else
651         {
652             ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
653                 "Value Written %8.8X%8.8X, Width %d\n",
654                 ACPI_FORMAT_UINT64 (*Value),
655                 ObjDesc->CommonField.AccessByteWidth));
656         }
657     }
658 
659     return_ACPI_STATUS (Status);
660 }
661 
662 
663 /*******************************************************************************
664  *
665  * FUNCTION:    AcpiExWriteWithUpdateRule
666  *
667  * PARAMETERS:  ObjDesc                 - Field to be written
668  *              Mask                    - bitmask within field datum
669  *              FieldValue              - Value to write
670  *              FieldDatumByteOffset    - Offset of datum within field
671  *
672  * RETURN:      Status
673  *
674  * DESCRIPTION: Apply the field update rule to a field write
675  *
676  ******************************************************************************/
677 
678 ACPI_STATUS
679 AcpiExWriteWithUpdateRule (
680     ACPI_OPERAND_OBJECT     *ObjDesc,
681     ACPI_INTEGER            Mask,
682     ACPI_INTEGER            FieldValue,
683     UINT32                  FieldDatumByteOffset)
684 {
685     ACPI_STATUS             Status = AE_OK;
686     ACPI_INTEGER            MergedValue;
687     ACPI_INTEGER            CurrentValue;
688 
689 
690     ACPI_FUNCTION_TRACE_U32 (ExWriteWithUpdateRule, Mask);
691 
692 
693     /* Start with the new bits  */
694 
695     MergedValue = FieldValue;
696 
697     /* If the mask is all ones, we don't need to worry about the update rule */
698 
699     if (Mask != ACPI_INTEGER_MAX)
700     {
701         /* Decode the update rule */
702 
703         switch (ObjDesc->CommonField.FieldFlags & AML_FIELD_UPDATE_RULE_MASK)
704         {
705         case AML_FIELD_UPDATE_PRESERVE:
706             /*
707              * Check if update rule needs to be applied (not if mask is all
708              * ones)  The left shift drops the bits we want to ignore.
709              */
710             if ((~Mask << (ACPI_MUL_8 (sizeof (Mask)) -
711                            ACPI_MUL_8 (ObjDesc->CommonField.AccessByteWidth))) != 0)
712             {
713                 /*
714                  * Read the current contents of the byte/word/dword containing
715                  * the field, and merge with the new field value.
716                  */
717                 Status = AcpiExFieldDatumIo (ObjDesc, FieldDatumByteOffset,
718                             &CurrentValue, ACPI_READ);
719                 if (ACPI_FAILURE (Status))
720                 {
721                     return_ACPI_STATUS (Status);
722                 }
723 
724                 MergedValue |= (CurrentValue & ~Mask);
725             }
726             break;
727 
728         case AML_FIELD_UPDATE_WRITE_AS_ONES:
729 
730             /* Set positions outside the field to all ones */
731 
732             MergedValue |= ~Mask;
733             break;
734 
735         case AML_FIELD_UPDATE_WRITE_AS_ZEROS:
736 
737             /* Set positions outside the field to all zeros */
738 
739             MergedValue &= Mask;
740             break;
741 
742         default:
743 
744             ACPI_ERROR ((AE_INFO,
745                 "Unknown UpdateRule value: %X",
746                 (ObjDesc->CommonField.FieldFlags & AML_FIELD_UPDATE_RULE_MASK)));
747             return_ACPI_STATUS (AE_AML_OPERAND_VALUE);
748         }
749     }
750 
751     ACPI_DEBUG_PRINT ((ACPI_DB_BFIELD,
752         "Mask %8.8X%8.8X, DatumOffset %X, Width %X, Value %8.8X%8.8X, MergedValue %8.8X%8.8X\n",
753         ACPI_FORMAT_UINT64 (Mask),
754         FieldDatumByteOffset,
755         ObjDesc->CommonField.AccessByteWidth,
756         ACPI_FORMAT_UINT64 (FieldValue),
757         ACPI_FORMAT_UINT64 (MergedValue)));
758 
759     /* Write the merged value */
760 
761     Status = AcpiExFieldDatumIo (ObjDesc, FieldDatumByteOffset,
762                 &MergedValue, ACPI_WRITE);
763 
764     return_ACPI_STATUS (Status);
765 }
766 
767 
768 /*******************************************************************************
769  *
770  * FUNCTION:    AcpiExExtractFromField
771  *
772  * PARAMETERS:  ObjDesc             - Field to be read
773  *              Buffer              - Where to store the field data
774  *              BufferLength        - Length of Buffer
775  *
776  * RETURN:      Status
777  *
778  * DESCRIPTION: Retrieve the current value of the given field
779  *
780  ******************************************************************************/
781 
782 ACPI_STATUS
783 AcpiExExtractFromField (
784     ACPI_OPERAND_OBJECT     *ObjDesc,
785     void                    *Buffer,
786     UINT32                  BufferLength)
787 {
788     ACPI_STATUS             Status;
789     ACPI_INTEGER            RawDatum;
790     ACPI_INTEGER            MergedDatum;
791     UINT32                  FieldOffset = 0;
792     UINT32                  BufferOffset = 0;
793     UINT32                  BufferTailBits;
794     UINT32                  DatumCount;
795     UINT32                  FieldDatumCount;
796     UINT32                  i;
797 
798 
799     ACPI_FUNCTION_TRACE (ExExtractFromField);
800 
801 
802     /* Validate target buffer and clear it */
803 
804     if (BufferLength <
805             ACPI_ROUND_BITS_UP_TO_BYTES (ObjDesc->CommonField.BitLength))
806     {
807         ACPI_ERROR ((AE_INFO,
808             "Field size %X (bits) is too large for buffer (%X)",
809             ObjDesc->CommonField.BitLength, BufferLength));
810 
811         return_ACPI_STATUS (AE_BUFFER_OVERFLOW);
812     }
813     ACPI_MEMSET (Buffer, 0, BufferLength);
814 
815     /* Compute the number of datums (access width data items) */
816 
817     DatumCount = ACPI_ROUND_UP_TO (
818                         ObjDesc->CommonField.BitLength,
819                         ObjDesc->CommonField.AccessBitWidth);
820     FieldDatumCount = ACPI_ROUND_UP_TO (
821                         ObjDesc->CommonField.BitLength +
822                         ObjDesc->CommonField.StartFieldBitOffset,
823                         ObjDesc->CommonField.AccessBitWidth);
824 
825     /* Priming read from the field */
826 
827     Status = AcpiExFieldDatumIo (ObjDesc, FieldOffset, &RawDatum, ACPI_READ);
828     if (ACPI_FAILURE (Status))
829     {
830         return_ACPI_STATUS (Status);
831     }
832     MergedDatum = RawDatum >> ObjDesc->CommonField.StartFieldBitOffset;
833 
834     /* Read the rest of the field */
835 
836     for (i = 1; i < FieldDatumCount; i++)
837     {
838         /* Get next input datum from the field */
839 
840         FieldOffset += ObjDesc->CommonField.AccessByteWidth;
841         Status = AcpiExFieldDatumIo (ObjDesc, FieldOffset,
842                     &RawDatum, ACPI_READ);
843         if (ACPI_FAILURE (Status))
844         {
845             return_ACPI_STATUS (Status);
846         }
847 
848         /*
849          * Merge with previous datum if necessary.
850          *
851          * Note: Before the shift, check if the shift value will be larger than
852          * the integer size. If so, there is no need to perform the operation.
853          * This avoids the differences in behavior between different compilers
854          * concerning shift values larger than the target data width.
855          */
856         if ((ObjDesc->CommonField.AccessBitWidth -
857             ObjDesc->CommonField.StartFieldBitOffset) < ACPI_INTEGER_BIT_SIZE)
858         {
859             MergedDatum |= RawDatum <<
860                 (ObjDesc->CommonField.AccessBitWidth -
861                     ObjDesc->CommonField.StartFieldBitOffset);
862         }
863 
864         if (i == DatumCount)
865         {
866             break;
867         }
868 
869         /* Write merged datum to target buffer */
870 
871         ACPI_MEMCPY (((char *) Buffer) + BufferOffset, &MergedDatum,
872             ACPI_MIN(ObjDesc->CommonField.AccessByteWidth,
873                 BufferLength - BufferOffset));
874 
875         BufferOffset += ObjDesc->CommonField.AccessByteWidth;
876         MergedDatum = RawDatum >> ObjDesc->CommonField.StartFieldBitOffset;
877     }
878 
879     /* Mask off any extra bits in the last datum */
880 
881     BufferTailBits = ObjDesc->CommonField.BitLength %
882                         ObjDesc->CommonField.AccessBitWidth;
883     if (BufferTailBits)
884     {
885         MergedDatum &= ACPI_MASK_BITS_ABOVE (BufferTailBits);
886     }
887 
888     /* Write the last datum to the buffer */
889 
890     ACPI_MEMCPY (((char *) Buffer) + BufferOffset, &MergedDatum,
891         ACPI_MIN(ObjDesc->CommonField.AccessByteWidth,
892             BufferLength - BufferOffset));
893 
894     return_ACPI_STATUS (AE_OK);
895 }
896 
897 
898 /*******************************************************************************
899  *
900  * FUNCTION:    AcpiExInsertIntoField
901  *
902  * PARAMETERS:  ObjDesc             - Field to be written
903  *              Buffer              - Data to be written
904  *              BufferLength        - Length of Buffer
905  *
906  * RETURN:      Status
907  *
908  * DESCRIPTION: Store the Buffer contents into the given field
909  *
910  ******************************************************************************/
911 
912 ACPI_STATUS
913 AcpiExInsertIntoField (
914     ACPI_OPERAND_OBJECT     *ObjDesc,
915     void                    *Buffer,
916     UINT32                  BufferLength)
917 {
918     ACPI_STATUS             Status;
919     ACPI_INTEGER            Mask;
920     ACPI_INTEGER            WidthMask;
921     ACPI_INTEGER            MergedDatum;
922     ACPI_INTEGER            RawDatum = 0;
923     UINT32                  FieldOffset = 0;
924     UINT32                  BufferOffset = 0;
925     UINT32                  BufferTailBits;
926     UINT32                  DatumCount;
927     UINT32                  FieldDatumCount;
928     UINT32                  i;
929     UINT32                  RequiredLength;
930     void                    *NewBuffer;
931 
932 
933     ACPI_FUNCTION_TRACE (ExInsertIntoField);
934 
935 
936     /* Validate input buffer */
937 
938     NewBuffer = NULL;
939     RequiredLength = ACPI_ROUND_BITS_UP_TO_BYTES (
940                         ObjDesc->CommonField.BitLength);
941     /*
942      * We must have a buffer that is at least as long as the field
943      * we are writing to.  This is because individual fields are
944      * indivisible and partial writes are not supported -- as per
945      * the ACPI specification.
946      */
947     if (BufferLength < RequiredLength)
948     {
949         /* We need to create a new buffer */
950 
951         NewBuffer = ACPI_ALLOCATE_ZEROED (RequiredLength);
952         if (!NewBuffer)
953         {
954             return_ACPI_STATUS (AE_NO_MEMORY);
955         }
956 
957         /*
958          * Copy the original data to the new buffer, starting
959          * at Byte zero.  All unused (upper) bytes of the
960          * buffer will be 0.
961          */
962         ACPI_MEMCPY ((char *) NewBuffer, (char *) Buffer, BufferLength);
963         Buffer = NewBuffer;
964         BufferLength = RequiredLength;
965     }
966 
967     /*
968      * Create the bitmasks used for bit insertion.
969      * Note: This if/else is used to bypass compiler differences with the
970      * shift operator
971      */
972     if (ObjDesc->CommonField.AccessBitWidth == ACPI_INTEGER_BIT_SIZE)
973     {
974         WidthMask = ACPI_INTEGER_MAX;
975     }
976     else
977     {
978         WidthMask = ACPI_MASK_BITS_ABOVE (ObjDesc->CommonField.AccessBitWidth);
979     }
980 
981     Mask = WidthMask &
982             ACPI_MASK_BITS_BELOW (ObjDesc->CommonField.StartFieldBitOffset);
983 
984     /* Compute the number of datums (access width data items) */
985 
986     DatumCount = ACPI_ROUND_UP_TO (ObjDesc->CommonField.BitLength,
987                     ObjDesc->CommonField.AccessBitWidth);
988 
989     FieldDatumCount = ACPI_ROUND_UP_TO (ObjDesc->CommonField.BitLength +
990                         ObjDesc->CommonField.StartFieldBitOffset,
991                         ObjDesc->CommonField.AccessBitWidth);
992 
993     /* Get initial Datum from the input buffer */
994 
995     ACPI_MEMCPY (&RawDatum, Buffer,
996         ACPI_MIN(ObjDesc->CommonField.AccessByteWidth,
997             BufferLength - BufferOffset));
998 
999     MergedDatum = RawDatum << ObjDesc->CommonField.StartFieldBitOffset;
1000 
1001     /* Write the entire field */
1002 
1003     for (i = 1; i < FieldDatumCount; i++)
1004     {
1005         /* Write merged datum to the target field */
1006 
1007         MergedDatum &= Mask;
1008         Status = AcpiExWriteWithUpdateRule (ObjDesc, Mask,
1009                     MergedDatum, FieldOffset);
1010         if (ACPI_FAILURE (Status))
1011         {
1012             goto Exit;
1013         }
1014 
1015         FieldOffset += ObjDesc->CommonField.AccessByteWidth;
1016 
1017         /*
1018          * Start new output datum by merging with previous input datum
1019          * if necessary.
1020          *
1021          * Note: Before the shift, check if the shift value will be larger than
1022          * the integer size. If so, there is no need to perform the operation.
1023          * This avoids the differences in behavior between different compilers
1024          * concerning shift values larger than the target data width.
1025          */
1026         if ((ObjDesc->CommonField.AccessBitWidth -
1027             ObjDesc->CommonField.StartFieldBitOffset) < ACPI_INTEGER_BIT_SIZE)
1028         {
1029             MergedDatum = RawDatum >>
1030                 (ObjDesc->CommonField.AccessBitWidth -
1031                     ObjDesc->CommonField.StartFieldBitOffset);
1032         }
1033         else
1034         {
1035             MergedDatum = 0;
1036         }
1037 
1038         Mask = WidthMask;
1039 
1040         if (i == DatumCount)
1041         {
1042             break;
1043         }
1044 
1045         /* Get the next input datum from the buffer */
1046 
1047         BufferOffset += ObjDesc->CommonField.AccessByteWidth;
1048         ACPI_MEMCPY (&RawDatum, ((char *) Buffer) + BufferOffset,
1049             ACPI_MIN(ObjDesc->CommonField.AccessByteWidth,
1050                      BufferLength - BufferOffset));
1051         MergedDatum |= RawDatum << ObjDesc->CommonField.StartFieldBitOffset;
1052     }
1053 
1054     /* Mask off any extra bits in the last datum */
1055 
1056     BufferTailBits = (ObjDesc->CommonField.BitLength +
1057             ObjDesc->CommonField.StartFieldBitOffset) %
1058                 ObjDesc->CommonField.AccessBitWidth;
1059     if (BufferTailBits)
1060     {
1061         Mask &= ACPI_MASK_BITS_ABOVE (BufferTailBits);
1062     }
1063 
1064     /* Write the last datum to the field */
1065 
1066     MergedDatum &= Mask;
1067     Status = AcpiExWriteWithUpdateRule (ObjDesc,
1068                 Mask, MergedDatum, FieldOffset);
1069 
1070 Exit:
1071     /* Free temporary buffer if we used one */
1072 
1073     if (NewBuffer)
1074     {
1075         ACPI_FREE (NewBuffer);
1076     }
1077     return_ACPI_STATUS (Status);
1078 }
1079 
1080 
1081