934 lines
		
	
	
		
			25 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			934 lines
		
	
	
		
			25 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /******************************************************************************
 | |
|  *
 | |
|  * Module Name: psargs - Parse AML opcode arguments
 | |
|  *
 | |
|  *****************************************************************************/
 | |
| 
 | |
| /*
 | |
|  * Copyright (C) 2000 - 2014, Intel Corp.
 | |
|  * All rights reserved.
 | |
|  *
 | |
|  * Redistribution and use in source and binary forms, with or without
 | |
|  * modification, are permitted provided that the following conditions
 | |
|  * are met:
 | |
|  * 1. Redistributions of source code must retain the above copyright
 | |
|  *    notice, this list of conditions, and the following disclaimer,
 | |
|  *    without modification.
 | |
|  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
 | |
|  *    substantially similar to the "NO WARRANTY" disclaimer below
 | |
|  *    ("Disclaimer") and any redistribution must be conditioned upon
 | |
|  *    including a substantially similar Disclaimer requirement for further
 | |
|  *    binary redistribution.
 | |
|  * 3. Neither the names of the above-listed copyright holders nor the names
 | |
|  *    of any contributors may be used to endorse or promote products derived
 | |
|  *    from this software without specific prior written permission.
 | |
|  *
 | |
|  * Alternatively, this software may be distributed under the terms of the
 | |
|  * GNU General Public License ("GPL") version 2 as published by the Free
 | |
|  * Software Foundation.
 | |
|  *
 | |
|  * NO WARRANTY
 | |
|  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 | |
|  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 | |
|  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
 | |
|  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 | |
|  * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 | |
|  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 | |
|  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 | |
|  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
 | |
|  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
 | |
|  * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 | |
|  * POSSIBILITY OF SUCH DAMAGES.
 | |
|  */
 | |
| 
 | |
| #include "acpi.h"
 | |
| #include "accommon.h"
 | |
| #include "acparser.h"
 | |
| #include "amlcode.h"
 | |
| #include "acnamesp.h"
 | |
| #include "acdispat.h"
 | |
| 
 | |
| #define _COMPONENT          ACPI_PARSER
 | |
|         ACPI_MODULE_NAME    ("psargs")
 | |
| 
 | |
| /* Local prototypes */
 | |
| 
 | |
| static UINT32
 | |
| AcpiPsGetNextPackageLength (
 | |
|     ACPI_PARSE_STATE        *ParserState);
 | |
| 
 | |
| static ACPI_PARSE_OBJECT *
 | |
| AcpiPsGetNextField (
 | |
|     ACPI_PARSE_STATE        *ParserState);
 | |
| 
 | |
| 
 | |
| /*******************************************************************************
 | |
|  *
 | |
|  * FUNCTION:    AcpiPsGetNextPackageLength
 | |
|  *
 | |
|  * PARAMETERS:  ParserState         - Current parser state object
 | |
|  *
 | |
|  * RETURN:      Decoded package length. On completion, the AML pointer points
 | |
|  *              past the length byte or bytes.
 | |
|  *
 | |
|  * DESCRIPTION: Decode and return a package length field.
 | |
|  *              Note: Largest package length is 28 bits, from ACPI specification
 | |
|  *
 | |
|  ******************************************************************************/
 | |
| 
 | |
| static UINT32
 | |
| AcpiPsGetNextPackageLength (
 | |
|     ACPI_PARSE_STATE        *ParserState)
 | |
| {
 | |
|     UINT8                   *Aml = ParserState->Aml;
 | |
|     UINT32                  PackageLength = 0;
 | |
|     UINT32                  ByteCount;
 | |
|     UINT8                   ByteZeroMask = 0x3F; /* Default [0:5] */
 | |
| 
 | |
| 
 | |
|     ACPI_FUNCTION_TRACE (PsGetNextPackageLength);
 | |
| 
 | |
| 
 | |
|     /*
 | |
|      * Byte 0 bits [6:7] contain the number of additional bytes
 | |
|      * used to encode the package length, either 0,1,2, or 3
 | |
|      */
 | |
|     ByteCount = (Aml[0] >> 6);
 | |
|     ParserState->Aml += ((ACPI_SIZE) ByteCount + 1);
 | |
| 
 | |
|     /* Get bytes 3, 2, 1 as needed */
 | |
| 
 | |
|     while (ByteCount)
 | |
|     {
 | |
|         /*
 | |
|          * Final bit positions for the package length bytes:
 | |
|          *      Byte3->[20:27]
 | |
|          *      Byte2->[12:19]
 | |
|          *      Byte1->[04:11]
 | |
|          *      Byte0->[00:03]
 | |
|          */
 | |
|         PackageLength |= (Aml[ByteCount] << ((ByteCount << 3) - 4));
 | |
| 
 | |
|         ByteZeroMask = 0x0F; /* Use bits [0:3] of byte 0 */
 | |
|         ByteCount--;
 | |
|     }
 | |
| 
 | |
|     /* Byte 0 is a special case, either bits [0:3] or [0:5] are used */
 | |
| 
 | |
|     PackageLength |= (Aml[0] & ByteZeroMask);
 | |
|     return_UINT32 (PackageLength);
 | |
| }
 | |
| 
 | |
| 
 | |
| /*******************************************************************************
 | |
|  *
 | |
|  * FUNCTION:    AcpiPsGetNextPackageEnd
 | |
|  *
 | |
|  * PARAMETERS:  ParserState         - Current parser state object
 | |
|  *
 | |
|  * RETURN:      Pointer to end-of-package +1
 | |
|  *
 | |
|  * DESCRIPTION: Get next package length and return a pointer past the end of
 | |
|  *              the package. Consumes the package length field
 | |
|  *
 | |
|  ******************************************************************************/
 | |
| 
 | |
| UINT8 *
 | |
| AcpiPsGetNextPackageEnd (
 | |
|     ACPI_PARSE_STATE        *ParserState)
 | |
| {
 | |
|     UINT8                   *Start = ParserState->Aml;
 | |
|     UINT32                  PackageLength;
 | |
| 
 | |
| 
 | |
|     ACPI_FUNCTION_TRACE (PsGetNextPackageEnd);
 | |
| 
 | |
| 
 | |
|     /* Function below updates ParserState->Aml */
 | |
| 
 | |
|     PackageLength = AcpiPsGetNextPackageLength (ParserState);
 | |
| 
 | |
|     return_PTR (Start + PackageLength); /* end of package */
 | |
| }
 | |
| 
 | |
| 
 | |
| /*******************************************************************************
 | |
|  *
 | |
|  * FUNCTION:    AcpiPsGetNextNamestring
 | |
|  *
 | |
|  * PARAMETERS:  ParserState         - Current parser state object
 | |
|  *
 | |
|  * RETURN:      Pointer to the start of the name string (pointer points into
 | |
|  *              the AML.
 | |
|  *
 | |
|  * DESCRIPTION: Get next raw namestring within the AML stream. Handles all name
 | |
|  *              prefix characters. Set parser state to point past the string.
 | |
|  *              (Name is consumed from the AML.)
 | |
|  *
 | |
|  ******************************************************************************/
 | |
| 
 | |
| char *
 | |
| AcpiPsGetNextNamestring (
 | |
|     ACPI_PARSE_STATE        *ParserState)
 | |
| {
 | |
|     UINT8                   *Start = ParserState->Aml;
 | |
|     UINT8                   *End = ParserState->Aml;
 | |
| 
 | |
| 
 | |
|     ACPI_FUNCTION_TRACE (PsGetNextNamestring);
 | |
| 
 | |
| 
 | |
|     /* Point past any namestring prefix characters (backslash or carat) */
 | |
| 
 | |
|     while (ACPI_IS_ROOT_PREFIX (*End) ||
 | |
|            ACPI_IS_PARENT_PREFIX (*End))
 | |
|     {
 | |
|         End++;
 | |
|     }
 | |
| 
 | |
|     /* Decode the path prefix character */
 | |
| 
 | |
|     switch (*End)
 | |
|     {
 | |
|     case 0:
 | |
| 
 | |
|         /* NullName */
 | |
| 
 | |
|         if (End == Start)
 | |
|         {
 | |
|             Start = NULL;
 | |
|         }
 | |
|         End++;
 | |
|         break;
 | |
| 
 | |
|     case AML_DUAL_NAME_PREFIX:
 | |
| 
 | |
|         /* Two name segments */
 | |
| 
 | |
|         End += 1 + (2 * ACPI_NAME_SIZE);
 | |
|         break;
 | |
| 
 | |
|     case AML_MULTI_NAME_PREFIX_OP:
 | |
| 
 | |
|         /* Multiple name segments, 4 chars each, count in next byte */
 | |
| 
 | |
|         End += 2 + (*(End + 1) * ACPI_NAME_SIZE);
 | |
|         break;
 | |
| 
 | |
|     default:
 | |
| 
 | |
|         /* Single name segment */
 | |
| 
 | |
|         End += ACPI_NAME_SIZE;
 | |
|         break;
 | |
|     }
 | |
| 
 | |
|     ParserState->Aml = End;
 | |
|     return_PTR ((char *) Start);
 | |
| }
 | |
| 
 | |
| 
 | |
| /*******************************************************************************
 | |
|  *
 | |
|  * FUNCTION:    AcpiPsGetNextNamepath
 | |
|  *
 | |
|  * PARAMETERS:  ParserState         - Current parser state object
 | |
|  *              Arg                 - Where the namepath will be stored
 | |
|  *              ArgCount            - If the namepath points to a control method
 | |
|  *                                    the method's argument is returned here.
 | |
|  *              PossibleMethodCall  - Whether the namepath can possibly be the
 | |
|  *                                    start of a method call
 | |
|  *
 | |
|  * RETURN:      Status
 | |
|  *
 | |
|  * DESCRIPTION: Get next name (if method call, return # of required args).
 | |
|  *              Names are looked up in the internal namespace to determine
 | |
|  *              if the name represents a control method. If a method
 | |
|  *              is found, the number of arguments to the method is returned.
 | |
|  *              This information is critical for parsing to continue correctly.
 | |
|  *
 | |
|  ******************************************************************************/
 | |
| 
 | |
| ACPI_STATUS
 | |
| AcpiPsGetNextNamepath (
 | |
|     ACPI_WALK_STATE         *WalkState,
 | |
|     ACPI_PARSE_STATE        *ParserState,
 | |
|     ACPI_PARSE_OBJECT       *Arg,
 | |
|     BOOLEAN                 PossibleMethodCall)
 | |
| {
 | |
|     ACPI_STATUS             Status;
 | |
|     char                    *Path;
 | |
|     ACPI_PARSE_OBJECT       *NameOp;
 | |
|     ACPI_OPERAND_OBJECT     *MethodDesc;
 | |
|     ACPI_NAMESPACE_NODE     *Node;
 | |
|     UINT8                   *Start = ParserState->Aml;
 | |
| 
 | |
| 
 | |
|     ACPI_FUNCTION_TRACE (PsGetNextNamepath);
 | |
| 
 | |
| 
 | |
|     Path = AcpiPsGetNextNamestring (ParserState);
 | |
|     AcpiPsInitOp (Arg, AML_INT_NAMEPATH_OP);
 | |
| 
 | |
|     /* Null path case is allowed, just exit */
 | |
| 
 | |
|     if (!Path)
 | |
|     {
 | |
|         Arg->Common.Value.Name = Path;
 | |
|         return_ACPI_STATUS (AE_OK);
 | |
|     }
 | |
| 
 | |
|     /*
 | |
|      * Lookup the name in the internal namespace, starting with the current
 | |
|      * scope. We don't want to add anything new to the namespace here,
 | |
|      * however, so we use MODE_EXECUTE.
 | |
|      * Allow searching of the parent tree, but don't open a new scope -
 | |
|      * we just want to lookup the object (must be mode EXECUTE to perform
 | |
|      * the upsearch)
 | |
|      */
 | |
|     Status = AcpiNsLookup (WalkState->ScopeInfo, Path,
 | |
|                 ACPI_TYPE_ANY, ACPI_IMODE_EXECUTE,
 | |
|                 ACPI_NS_SEARCH_PARENT | ACPI_NS_DONT_OPEN_SCOPE, NULL, &Node);
 | |
| 
 | |
|     /*
 | |
|      * If this name is a control method invocation, we must
 | |
|      * setup the method call
 | |
|      */
 | |
|     if (ACPI_SUCCESS (Status) &&
 | |
|         PossibleMethodCall &&
 | |
|         (Node->Type == ACPI_TYPE_METHOD))
 | |
|     {
 | |
|         if (WalkState->Opcode == AML_UNLOAD_OP)
 | |
|         {
 | |
|             /*
 | |
|              * AcpiPsGetNextNamestring has increased the AML pointer,
 | |
|              * so we need to restore the saved AML pointer for method call.
 | |
|              */
 | |
|             WalkState->ParserState.Aml = Start;
 | |
|             WalkState->ArgCount = 1;
 | |
|             AcpiPsInitOp (Arg, AML_INT_METHODCALL_OP);
 | |
|             return_ACPI_STATUS (AE_OK);
 | |
|         }
 | |
| 
 | |
|         /* This name is actually a control method invocation */
 | |
| 
 | |
|         MethodDesc = AcpiNsGetAttachedObject (Node);
 | |
|         ACPI_DEBUG_PRINT ((ACPI_DB_PARSE,
 | |
|             "Control Method - %p Desc %p Path=%p\n", Node, MethodDesc, Path));
 | |
| 
 | |
|         NameOp = AcpiPsAllocOp (AML_INT_NAMEPATH_OP);
 | |
|         if (!NameOp)
 | |
|         {
 | |
|             return_ACPI_STATUS (AE_NO_MEMORY);
 | |
|         }
 | |
| 
 | |
|         /* Change Arg into a METHOD CALL and attach name to it */
 | |
| 
 | |
|         AcpiPsInitOp (Arg, AML_INT_METHODCALL_OP);
 | |
|         NameOp->Common.Value.Name = Path;
 | |
| 
 | |
|         /* Point METHODCALL/NAME to the METHOD Node */
 | |
| 
 | |
|         NameOp->Common.Node = Node;
 | |
|         AcpiPsAppendArg (Arg, NameOp);
 | |
| 
 | |
|         if (!MethodDesc)
 | |
|         {
 | |
|             ACPI_ERROR ((AE_INFO,
 | |
|                 "Control Method %p has no attached object",
 | |
|                 Node));
 | |
|             return_ACPI_STATUS (AE_AML_INTERNAL);
 | |
|         }
 | |
| 
 | |
|         ACPI_DEBUG_PRINT ((ACPI_DB_PARSE,
 | |
|             "Control Method - %p Args %X\n",
 | |
|             Node, MethodDesc->Method.ParamCount));
 | |
| 
 | |
|         /* Get the number of arguments to expect */
 | |
| 
 | |
|         WalkState->ArgCount = MethodDesc->Method.ParamCount;
 | |
|         return_ACPI_STATUS (AE_OK);
 | |
|     }
 | |
| 
 | |
|     /*
 | |
|      * Special handling if the name was not found during the lookup -
 | |
|      * some NotFound cases are allowed
 | |
|      */
 | |
|     if (Status == AE_NOT_FOUND)
 | |
|     {
 | |
|         /* 1) NotFound is ok during load pass 1/2 (allow forward references) */
 | |
| 
 | |
|         if ((WalkState->ParseFlags & ACPI_PARSE_MODE_MASK) !=
 | |
|                 ACPI_PARSE_EXECUTE)
 | |
|         {
 | |
|             Status = AE_OK;
 | |
|         }
 | |
| 
 | |
|         /* 2) NotFound during a CondRefOf(x) is ok by definition */
 | |
| 
 | |
|         else if (WalkState->Op->Common.AmlOpcode == AML_COND_REF_OF_OP)
 | |
|         {
 | |
|             Status = AE_OK;
 | |
|         }
 | |
| 
 | |
|         /*
 | |
|          * 3) NotFound while building a Package is ok at this point, we
 | |
|          * may flag as an error later if slack mode is not enabled.
 | |
|          * (Some ASL code depends on allowing this behavior)
 | |
|          */
 | |
|         else if ((Arg->Common.Parent) &&
 | |
|             ((Arg->Common.Parent->Common.AmlOpcode == AML_PACKAGE_OP) ||
 | |
|              (Arg->Common.Parent->Common.AmlOpcode == AML_VAR_PACKAGE_OP)))
 | |
|         {
 | |
|             Status = AE_OK;
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     /* Final exception check (may have been changed from code above) */
 | |
| 
 | |
|     if (ACPI_FAILURE (Status))
 | |
|     {
 | |
|         ACPI_ERROR_NAMESPACE (Path, Status);
 | |
| 
 | |
|         if ((WalkState->ParseFlags & ACPI_PARSE_MODE_MASK) ==
 | |
|                 ACPI_PARSE_EXECUTE)
 | |
|         {
 | |
|             /* Report a control method execution error */
 | |
| 
 | |
|             Status = AcpiDsMethodError (Status, WalkState);
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     /* Save the namepath */
 | |
| 
 | |
|     Arg->Common.Value.Name = Path;
 | |
|     return_ACPI_STATUS (Status);
 | |
| }
 | |
| 
 | |
| 
 | |
| /*******************************************************************************
 | |
|  *
 | |
|  * FUNCTION:    AcpiPsGetNextSimpleArg
 | |
|  *
 | |
|  * PARAMETERS:  ParserState         - Current parser state object
 | |
|  *              ArgType             - The argument type (AML_*_ARG)
 | |
|  *              Arg                 - Where the argument is returned
 | |
|  *
 | |
|  * RETURN:      None
 | |
|  *
 | |
|  * DESCRIPTION: Get the next simple argument (constant, string, or namestring)
 | |
|  *
 | |
|  ******************************************************************************/
 | |
| 
 | |
| void
 | |
| AcpiPsGetNextSimpleArg (
 | |
|     ACPI_PARSE_STATE        *ParserState,
 | |
|     UINT32                  ArgType,
 | |
|     ACPI_PARSE_OBJECT       *Arg)
 | |
| {
 | |
|     UINT32                  Length;
 | |
|     UINT16                  Opcode;
 | |
|     UINT8                   *Aml = ParserState->Aml;
 | |
| 
 | |
| 
 | |
|     ACPI_FUNCTION_TRACE_U32 (PsGetNextSimpleArg, ArgType);
 | |
| 
 | |
| 
 | |
|     switch (ArgType)
 | |
|     {
 | |
|     case ARGP_BYTEDATA:
 | |
| 
 | |
|         /* Get 1 byte from the AML stream */
 | |
| 
 | |
|         Opcode = AML_BYTE_OP;
 | |
|         Arg->Common.Value.Integer = (UINT64) *Aml;
 | |
|         Length = 1;
 | |
|         break;
 | |
| 
 | |
|     case ARGP_WORDDATA:
 | |
| 
 | |
|         /* Get 2 bytes from the AML stream */
 | |
| 
 | |
|         Opcode = AML_WORD_OP;
 | |
|         ACPI_MOVE_16_TO_64 (&Arg->Common.Value.Integer, Aml);
 | |
|         Length = 2;
 | |
|         break;
 | |
| 
 | |
|     case ARGP_DWORDDATA:
 | |
| 
 | |
|         /* Get 4 bytes from the AML stream */
 | |
| 
 | |
|         Opcode = AML_DWORD_OP;
 | |
|         ACPI_MOVE_32_TO_64 (&Arg->Common.Value.Integer, Aml);
 | |
|         Length = 4;
 | |
|         break;
 | |
| 
 | |
|     case ARGP_QWORDDATA:
 | |
| 
 | |
|         /* Get 8 bytes from the AML stream */
 | |
| 
 | |
|         Opcode = AML_QWORD_OP;
 | |
|         ACPI_MOVE_64_TO_64 (&Arg->Common.Value.Integer, Aml);
 | |
|         Length = 8;
 | |
|         break;
 | |
| 
 | |
|     case ARGP_CHARLIST:
 | |
| 
 | |
|         /* Get a pointer to the string, point past the string */
 | |
| 
 | |
|         Opcode = AML_STRING_OP;
 | |
|         Arg->Common.Value.String = ACPI_CAST_PTR (char, Aml);
 | |
| 
 | |
|         /* Find the null terminator */
 | |
| 
 | |
|         Length = 0;
 | |
|         while (Aml[Length])
 | |
|         {
 | |
|             Length++;
 | |
|         }
 | |
|         Length++;
 | |
|         break;
 | |
| 
 | |
|     case ARGP_NAME:
 | |
|     case ARGP_NAMESTRING:
 | |
| 
 | |
|         AcpiPsInitOp (Arg, AML_INT_NAMEPATH_OP);
 | |
|         Arg->Common.Value.Name = AcpiPsGetNextNamestring (ParserState);
 | |
|         return_VOID;
 | |
| 
 | |
|     default:
 | |
| 
 | |
|         ACPI_ERROR ((AE_INFO, "Invalid ArgType 0x%X", ArgType));
 | |
|         return_VOID;
 | |
|     }
 | |
| 
 | |
|     AcpiPsInitOp (Arg, Opcode);
 | |
|     ParserState->Aml += Length;
 | |
|     return_VOID;
 | |
| }
 | |
| 
 | |
| 
 | |
| /*******************************************************************************
 | |
|  *
 | |
|  * FUNCTION:    AcpiPsGetNextField
 | |
|  *
 | |
|  * PARAMETERS:  ParserState         - Current parser state object
 | |
|  *
 | |
|  * RETURN:      A newly allocated FIELD op
 | |
|  *
 | |
|  * DESCRIPTION: Get next field (NamedField, ReservedField, or AccessField)
 | |
|  *
 | |
|  ******************************************************************************/
 | |
| 
 | |
| static ACPI_PARSE_OBJECT *
 | |
| AcpiPsGetNextField (
 | |
|     ACPI_PARSE_STATE        *ParserState)
 | |
| {
 | |
|     UINT32                  AmlOffset;
 | |
|     ACPI_PARSE_OBJECT       *Field;
 | |
|     ACPI_PARSE_OBJECT       *Arg = NULL;
 | |
|     UINT16                  Opcode;
 | |
|     UINT32                  Name;
 | |
|     UINT8                   AccessType;
 | |
|     UINT8                   AccessAttribute;
 | |
|     UINT8                   AccessLength;
 | |
|     UINT32                  PkgLength;
 | |
|     UINT8                   *PkgEnd;
 | |
|     UINT32                  BufferLength;
 | |
| 
 | |
| 
 | |
|     ACPI_FUNCTION_TRACE (PsGetNextField);
 | |
| 
 | |
| 
 | |
|     AmlOffset = (UINT32) ACPI_PTR_DIFF (
 | |
|         ParserState->Aml, ParserState->AmlStart);
 | |
| 
 | |
|     /* Determine field type */
 | |
| 
 | |
|     switch (ACPI_GET8 (ParserState->Aml))
 | |
|     {
 | |
|     case AML_FIELD_OFFSET_OP:
 | |
| 
 | |
|         Opcode = AML_INT_RESERVEDFIELD_OP;
 | |
|         ParserState->Aml++;
 | |
|         break;
 | |
| 
 | |
|     case AML_FIELD_ACCESS_OP:
 | |
| 
 | |
|         Opcode = AML_INT_ACCESSFIELD_OP;
 | |
|         ParserState->Aml++;
 | |
|         break;
 | |
| 
 | |
|     case AML_FIELD_CONNECTION_OP:
 | |
| 
 | |
|         Opcode = AML_INT_CONNECTION_OP;
 | |
|         ParserState->Aml++;
 | |
|         break;
 | |
| 
 | |
|     case AML_FIELD_EXT_ACCESS_OP:
 | |
| 
 | |
|         Opcode = AML_INT_EXTACCESSFIELD_OP;
 | |
|         ParserState->Aml++;
 | |
|         break;
 | |
| 
 | |
|     default:
 | |
| 
 | |
|         Opcode = AML_INT_NAMEDFIELD_OP;
 | |
|         break;
 | |
|     }
 | |
| 
 | |
|     /* Allocate a new field op */
 | |
| 
 | |
|     Field = AcpiPsAllocOp (Opcode);
 | |
|     if (!Field)
 | |
|     {
 | |
|         return_PTR (NULL);
 | |
|     }
 | |
| 
 | |
|     Field->Common.AmlOffset = AmlOffset;
 | |
| 
 | |
|     /* Decode the field type */
 | |
| 
 | |
|     switch (Opcode)
 | |
|     {
 | |
|     case AML_INT_NAMEDFIELD_OP:
 | |
| 
 | |
|         /* Get the 4-character name */
 | |
| 
 | |
|         ACPI_MOVE_32_TO_32 (&Name, ParserState->Aml);
 | |
|         AcpiPsSetName (Field, Name);
 | |
|         ParserState->Aml += ACPI_NAME_SIZE;
 | |
| 
 | |
|         /* Get the length which is encoded as a package length */
 | |
| 
 | |
|         Field->Common.Value.Size = AcpiPsGetNextPackageLength (ParserState);
 | |
|         break;
 | |
| 
 | |
| 
 | |
|     case AML_INT_RESERVEDFIELD_OP:
 | |
| 
 | |
|         /* Get the length which is encoded as a package length */
 | |
| 
 | |
|         Field->Common.Value.Size = AcpiPsGetNextPackageLength (ParserState);
 | |
|         break;
 | |
| 
 | |
| 
 | |
|     case AML_INT_ACCESSFIELD_OP:
 | |
|     case AML_INT_EXTACCESSFIELD_OP:
 | |
| 
 | |
|         /*
 | |
|          * Get AccessType and AccessAttrib and merge into the field Op
 | |
|          * AccessType is first operand, AccessAttribute is second. stuff
 | |
|          * these bytes into the node integer value for convenience.
 | |
|          */
 | |
| 
 | |
|         /* Get the two bytes (Type/Attribute) */
 | |
| 
 | |
|         AccessType = ACPI_GET8 (ParserState->Aml);
 | |
|         ParserState->Aml++;
 | |
|         AccessAttribute = ACPI_GET8 (ParserState->Aml);
 | |
|         ParserState->Aml++;
 | |
| 
 | |
|         Field->Common.Value.Integer = (UINT8) AccessType;
 | |
|         Field->Common.Value.Integer |= (UINT16) (AccessAttribute << 8);
 | |
| 
 | |
|         /* This opcode has a third byte, AccessLength */
 | |
| 
 | |
|         if (Opcode == AML_INT_EXTACCESSFIELD_OP)
 | |
|         {
 | |
|             AccessLength = ACPI_GET8 (ParserState->Aml);
 | |
|             ParserState->Aml++;
 | |
| 
 | |
|             Field->Common.Value.Integer |= (UINT32) (AccessLength << 16);
 | |
|         }
 | |
|         break;
 | |
| 
 | |
| 
 | |
|     case AML_INT_CONNECTION_OP:
 | |
| 
 | |
|         /*
 | |
|          * Argument for Connection operator can be either a Buffer
 | |
|          * (resource descriptor), or a NameString.
 | |
|          */
 | |
|         if (ACPI_GET8 (ParserState->Aml) == AML_BUFFER_OP)
 | |
|         {
 | |
|             ParserState->Aml++;
 | |
| 
 | |
|             PkgEnd = ParserState->Aml;
 | |
|             PkgLength = AcpiPsGetNextPackageLength (ParserState);
 | |
|             PkgEnd += PkgLength;
 | |
| 
 | |
|             if (ParserState->Aml < PkgEnd)
 | |
|             {
 | |
|                 /* Non-empty list */
 | |
| 
 | |
|                 Arg = AcpiPsAllocOp (AML_INT_BYTELIST_OP);
 | |
|                 if (!Arg)
 | |
|                 {
 | |
|                     AcpiPsFreeOp (Field);
 | |
|                     return_PTR (NULL);
 | |
|                 }
 | |
| 
 | |
|                 /* Get the actual buffer length argument */
 | |
| 
 | |
|                 Opcode = ACPI_GET8 (ParserState->Aml);
 | |
|                 ParserState->Aml++;
 | |
| 
 | |
|                 switch (Opcode)
 | |
|                 {
 | |
|                 case AML_BYTE_OP:       /* AML_BYTEDATA_ARG */
 | |
| 
 | |
|                     BufferLength = ACPI_GET8 (ParserState->Aml);
 | |
|                     ParserState->Aml += 1;
 | |
|                     break;
 | |
| 
 | |
|                 case AML_WORD_OP:       /* AML_WORDDATA_ARG */
 | |
| 
 | |
|                     BufferLength = ACPI_GET16 (ParserState->Aml);
 | |
|                     ParserState->Aml += 2;
 | |
|                     break;
 | |
| 
 | |
|                 case AML_DWORD_OP:      /* AML_DWORDATA_ARG */
 | |
| 
 | |
|                     BufferLength = ACPI_GET32 (ParserState->Aml);
 | |
|                     ParserState->Aml += 4;
 | |
|                     break;
 | |
| 
 | |
|                 default:
 | |
| 
 | |
|                     BufferLength = 0;
 | |
|                     break;
 | |
|                 }
 | |
| 
 | |
|                 /* Fill in bytelist data */
 | |
| 
 | |
|                 Arg->Named.Value.Size = BufferLength;
 | |
|                 Arg->Named.Data = ParserState->Aml;
 | |
|             }
 | |
| 
 | |
|             /* Skip to End of byte data */
 | |
| 
 | |
|             ParserState->Aml = PkgEnd;
 | |
|         }
 | |
|         else
 | |
|         {
 | |
|             Arg = AcpiPsAllocOp (AML_INT_NAMEPATH_OP);
 | |
|             if (!Arg)
 | |
|             {
 | |
|                 AcpiPsFreeOp (Field);
 | |
|                 return_PTR (NULL);
 | |
|             }
 | |
| 
 | |
|             /* Get the Namestring argument */
 | |
| 
 | |
|             Arg->Common.Value.Name = AcpiPsGetNextNamestring (ParserState);
 | |
|         }
 | |
| 
 | |
|         /* Link the buffer/namestring to parent (CONNECTION_OP) */
 | |
| 
 | |
|         AcpiPsAppendArg (Field, Arg);
 | |
|         break;
 | |
| 
 | |
| 
 | |
|     default:
 | |
| 
 | |
|         /* Opcode was set in previous switch */
 | |
|         break;
 | |
|     }
 | |
| 
 | |
|     return_PTR (Field);
 | |
| }
 | |
| 
 | |
| 
 | |
| /*******************************************************************************
 | |
|  *
 | |
|  * FUNCTION:    AcpiPsGetNextArg
 | |
|  *
 | |
|  * PARAMETERS:  WalkState           - Current state
 | |
|  *              ParserState         - Current parser state object
 | |
|  *              ArgType             - The argument type (AML_*_ARG)
 | |
|  *              ReturnArg           - Where the next arg is returned
 | |
|  *
 | |
|  * RETURN:      Status, and an op object containing the next argument.
 | |
|  *
 | |
|  * DESCRIPTION: Get next argument (including complex list arguments that require
 | |
|  *              pushing the parser stack)
 | |
|  *
 | |
|  ******************************************************************************/
 | |
| 
 | |
| ACPI_STATUS
 | |
| AcpiPsGetNextArg (
 | |
|     ACPI_WALK_STATE         *WalkState,
 | |
|     ACPI_PARSE_STATE        *ParserState,
 | |
|     UINT32                  ArgType,
 | |
|     ACPI_PARSE_OBJECT       **ReturnArg)
 | |
| {
 | |
|     ACPI_PARSE_OBJECT       *Arg = NULL;
 | |
|     ACPI_PARSE_OBJECT       *Prev = NULL;
 | |
|     ACPI_PARSE_OBJECT       *Field;
 | |
|     UINT32                  Subop;
 | |
|     ACPI_STATUS             Status = AE_OK;
 | |
| 
 | |
| 
 | |
|     ACPI_FUNCTION_TRACE_PTR (PsGetNextArg, ParserState);
 | |
| 
 | |
| 
 | |
|     switch (ArgType)
 | |
|     {
 | |
|     case ARGP_BYTEDATA:
 | |
|     case ARGP_WORDDATA:
 | |
|     case ARGP_DWORDDATA:
 | |
|     case ARGP_CHARLIST:
 | |
|     case ARGP_NAME:
 | |
|     case ARGP_NAMESTRING:
 | |
| 
 | |
|         /* Constants, strings, and namestrings are all the same size */
 | |
| 
 | |
|         Arg = AcpiPsAllocOp (AML_BYTE_OP);
 | |
|         if (!Arg)
 | |
|         {
 | |
|             return_ACPI_STATUS (AE_NO_MEMORY);
 | |
|         }
 | |
|         AcpiPsGetNextSimpleArg (ParserState, ArgType, Arg);
 | |
|         break;
 | |
| 
 | |
|     case ARGP_PKGLENGTH:
 | |
| 
 | |
|         /* Package length, nothing returned */
 | |
| 
 | |
|         ParserState->PkgEnd = AcpiPsGetNextPackageEnd (ParserState);
 | |
|         break;
 | |
| 
 | |
|     case ARGP_FIELDLIST:
 | |
| 
 | |
|         if (ParserState->Aml < ParserState->PkgEnd)
 | |
|         {
 | |
|             /* Non-empty list */
 | |
| 
 | |
|             while (ParserState->Aml < ParserState->PkgEnd)
 | |
|             {
 | |
|                 Field = AcpiPsGetNextField (ParserState);
 | |
|                 if (!Field)
 | |
|                 {
 | |
|                     return_ACPI_STATUS (AE_NO_MEMORY);
 | |
|                 }
 | |
| 
 | |
|                 if (Prev)
 | |
|                 {
 | |
|                     Prev->Common.Next = Field;
 | |
|                 }
 | |
|                 else
 | |
|                 {
 | |
|                     Arg = Field;
 | |
|                 }
 | |
|                 Prev = Field;
 | |
|             }
 | |
| 
 | |
|             /* Skip to End of byte data */
 | |
| 
 | |
|             ParserState->Aml = ParserState->PkgEnd;
 | |
|         }
 | |
|         break;
 | |
| 
 | |
|     case ARGP_BYTELIST:
 | |
| 
 | |
|         if (ParserState->Aml < ParserState->PkgEnd)
 | |
|         {
 | |
|             /* Non-empty list */
 | |
| 
 | |
|             Arg = AcpiPsAllocOp (AML_INT_BYTELIST_OP);
 | |
|             if (!Arg)
 | |
|             {
 | |
|                 return_ACPI_STATUS (AE_NO_MEMORY);
 | |
|             }
 | |
| 
 | |
|             /* Fill in bytelist data */
 | |
| 
 | |
|             Arg->Common.Value.Size = (UINT32)
 | |
|                 ACPI_PTR_DIFF (ParserState->PkgEnd, ParserState->Aml);
 | |
|             Arg->Named.Data = ParserState->Aml;
 | |
| 
 | |
|             /* Skip to End of byte data */
 | |
| 
 | |
|             ParserState->Aml = ParserState->PkgEnd;
 | |
|         }
 | |
|         break;
 | |
| 
 | |
|     case ARGP_TARGET:
 | |
|     case ARGP_SUPERNAME:
 | |
|     case ARGP_SIMPLENAME:
 | |
| 
 | |
|         Subop = AcpiPsPeekOpcode (ParserState);
 | |
|         if (Subop == 0                  ||
 | |
|             AcpiPsIsLeadingChar (Subop) ||
 | |
|             ACPI_IS_ROOT_PREFIX (Subop) ||
 | |
|             ACPI_IS_PARENT_PREFIX (Subop))
 | |
|         {
 | |
|             /* NullName or NameString */
 | |
| 
 | |
|             Arg = AcpiPsAllocOp (AML_INT_NAMEPATH_OP);
 | |
|             if (!Arg)
 | |
|             {
 | |
|                 return_ACPI_STATUS (AE_NO_MEMORY);
 | |
|             }
 | |
| 
 | |
|             /* To support SuperName arg of Unload */
 | |
| 
 | |
|             if (WalkState->Opcode == AML_UNLOAD_OP)
 | |
|             {
 | |
|                 Status = AcpiPsGetNextNamepath (WalkState, ParserState, Arg, 1);
 | |
| 
 | |
|                 /*
 | |
|                  * If the SuperName arg of Unload is a method call,
 | |
|                  * we have restored the AML pointer, just free this Arg
 | |
|                  */
 | |
|                 if (Arg->Common.AmlOpcode == AML_INT_METHODCALL_OP)
 | |
|                 {
 | |
|                     AcpiPsFreeOp (Arg);
 | |
|                     Arg = NULL;
 | |
|                 }
 | |
|             }
 | |
|             else
 | |
|             {
 | |
|                 Status = AcpiPsGetNextNamepath (WalkState, ParserState, Arg, 0);
 | |
|             }
 | |
|         }
 | |
|         else
 | |
|         {
 | |
|             /* Single complex argument, nothing returned */
 | |
| 
 | |
|             WalkState->ArgCount = 1;
 | |
|         }
 | |
|         break;
 | |
| 
 | |
|     case ARGP_DATAOBJ:
 | |
|     case ARGP_TERMARG:
 | |
| 
 | |
|         /* Single complex argument, nothing returned */
 | |
| 
 | |
|         WalkState->ArgCount = 1;
 | |
|         break;
 | |
| 
 | |
|     case ARGP_DATAOBJLIST:
 | |
|     case ARGP_TERMLIST:
 | |
|     case ARGP_OBJLIST:
 | |
| 
 | |
|         if (ParserState->Aml < ParserState->PkgEnd)
 | |
|         {
 | |
|             /* Non-empty list of variable arguments, nothing returned */
 | |
| 
 | |
|             WalkState->ArgCount = ACPI_VAR_ARGS;
 | |
|         }
 | |
|         break;
 | |
| 
 | |
|     default:
 | |
| 
 | |
|         ACPI_ERROR ((AE_INFO, "Invalid ArgType: 0x%X", ArgType));
 | |
|         Status = AE_AML_OPERAND_TYPE;
 | |
|         break;
 | |
|     }
 | |
| 
 | |
|     *ReturnArg = Arg;
 | |
|     return_ACPI_STATUS (Status);
 | |
| }
 | 
