287 lines
8.3 KiB
C
287 lines
8.3 KiB
C
|
/******************************************************************************
|
||
|
|
*
|
||
|
|
* Module Name: exoparg3 - AML execution - opcodes with 3 arguments
|
||
|
|
*
|
||
|
|
*****************************************************************************/
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Copyright (C) 2000 - 2016, Intel Corp.
|
||
|
|
* All rights reserved.
|
||
|
|
*
|
||
|
|
* Redistribution and use in source and binary forms, with or without
|
||
|
|
* modification, are permitted provided that the following conditions
|
||
|
|
* are met:
|
||
|
|
* 1. Redistributions of source code must retain the above copyright
|
||
|
|
* notice, this list of conditions, and the following disclaimer,
|
||
|
|
* without modification.
|
||
|
|
* 2. Redistributions in binary form must reproduce at minimum a disclaimer
|
||
|
|
* substantially similar to the "NO WARRANTY" disclaimer below
|
||
|
|
* ("Disclaimer") and any redistribution must be conditioned upon
|
||
|
|
* including a substantially similar Disclaimer requirement for further
|
||
|
|
* binary redistribution.
|
||
|
|
* 3. Neither the names of the above-listed copyright holders nor the names
|
||
|
|
* of any contributors may be used to endorse or promote products derived
|
||
|
|
* from this software without specific prior written permission.
|
||
|
|
*
|
||
|
|
* Alternatively, this software may be distributed under the terms of the
|
||
|
|
* GNU General Public License ("GPL") version 2 as published by the Free
|
||
|
|
* Software Foundation.
|
||
|
|
*
|
||
|
|
* NO WARRANTY
|
||
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||
|
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||
|
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
|
||
|
|
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
||
|
|
* HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
||
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
||
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
||
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
|
||
|
|
* STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
|
||
|
|
* IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||
|
|
* POSSIBILITY OF SUCH DAMAGES.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <acpi/acpi.h>
|
||
|
|
#include "accommon.h"
|
||
|
|
#include "acinterp.h"
|
||
|
|
#include "acparser.h"
|
||
|
|
#include "amlcode.h"
|
||
|
|
|
||
|
|
#define _COMPONENT ACPI_EXECUTER
|
||
|
|
ACPI_MODULE_NAME("exoparg3")
|
||
|
|
|
||
|
|
/*!
|
||
|
|
* Naming convention for AML interpreter execution routines.
|
||
|
|
*
|
||
|
|
* The routines that begin execution of AML opcodes are named with a common
|
||
|
|
* convention based upon the number of arguments, the number of target operands,
|
||
|
|
* and whether or not a value is returned:
|
||
|
|
*
|
||
|
|
* AcpiExOpcode_xA_yT_zR
|
||
|
|
*
|
||
|
|
* Where:
|
||
|
|
*
|
||
|
|
* xA - ARGUMENTS: The number of arguments (input operands) that are
|
||
|
|
* required for this opcode type (1 through 6 args).
|
||
|
|
* yT - TARGETS: The number of targets (output operands) that are required
|
||
|
|
* for this opcode type (0, 1, or 2 targets).
|
||
|
|
* zR - RETURN VALUE: Indicates whether this opcode type returns a value
|
||
|
|
* as the function return (0 or 1).
|
||
|
|
*
|
||
|
|
* The AcpiExOpcode* functions are called via the Dispatcher component with
|
||
|
|
* fully resolved operands.
|
||
|
|
!*/
|
||
|
|
/*******************************************************************************
|
||
|
|
*
|
||
|
|
* FUNCTION: acpi_ex_opcode_3A_0T_0R
|
||
|
|
*
|
||
|
|
* PARAMETERS: walk_state - Current walk state
|
||
|
|
*
|
||
|
|
* RETURN: Status
|
||
|
|
*
|
||
|
|
* DESCRIPTION: Execute Triadic operator (3 operands)
|
||
|
|
*
|
||
|
|
******************************************************************************/
|
||
|
|
acpi_status acpi_ex_opcode_3A_0T_0R(struct acpi_walk_state *walk_state)
|
||
|
|
{
|
||
|
|
union acpi_operand_object **operand = &walk_state->operands[0];
|
||
|
|
struct acpi_signal_fatal_info *fatal;
|
||
|
|
acpi_status status = AE_OK;
|
||
|
|
|
||
|
|
ACPI_FUNCTION_TRACE_STR(ex_opcode_3A_0T_0R,
|
||
|
|
acpi_ps_get_opcode_name(walk_state->opcode));
|
||
|
|
|
||
|
|
switch (walk_state->opcode) {
|
||
|
|
case AML_FATAL_OP: /* Fatal (fatal_type fatal_code fatal_arg) */
|
||
|
|
|
||
|
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO,
|
||
|
|
"FatalOp: Type %X Code %X Arg %X "
|
||
|
|
"<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<\n",
|
||
|
|
(u32)operand[0]->integer.value,
|
||
|
|
(u32)operand[1]->integer.value,
|
||
|
|
(u32)operand[2]->integer.value));
|
||
|
|
|
||
|
|
fatal = ACPI_ALLOCATE(sizeof(struct acpi_signal_fatal_info));
|
||
|
|
if (fatal) {
|
||
|
|
fatal->type = (u32) operand[0]->integer.value;
|
||
|
|
fatal->code = (u32) operand[1]->integer.value;
|
||
|
|
fatal->argument = (u32) operand[2]->integer.value;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Always signal the OS! */
|
||
|
|
|
||
|
|
status = acpi_os_signal(ACPI_SIGNAL_FATAL, fatal);
|
||
|
|
|
||
|
|
/* Might return while OS is shutting down, just continue */
|
||
|
|
|
||
|
|
ACPI_FREE(fatal);
|
||
|
|
goto cleanup;
|
||
|
|
|
||
|
|
case AML_EXTERNAL_OP:
|
||
|
|
/*
|
||
|
|
* If the interpreter sees this opcode, just ignore it. The External
|
||
|
|
* op is intended for use by disassemblers in order to properly
|
||
|
|
* disassemble control method invocations. The opcode or group of
|
||
|
|
* opcodes should be surrounded by an "if (0)" clause to ensure that
|
||
|
|
* AML interpreters never see the opcode. Thus, something is
|
||
|
|
* wrong if an external opcode ever gets here.
|
||
|
|
*/
|
||
|
|
ACPI_ERROR((AE_INFO, "Executed External Op"));
|
||
|
|
status = AE_OK;
|
||
|
|
goto cleanup;
|
||
|
|
|
||
|
|
default:
|
||
|
|
|
||
|
|
ACPI_ERROR((AE_INFO, "Unknown AML opcode 0x%X",
|
||
|
|
walk_state->opcode));
|
||
|
|
|
||
|
|
status = AE_AML_BAD_OPCODE;
|
||
|
|
goto cleanup;
|
||
|
|
}
|
||
|
|
|
||
|
|
cleanup:
|
||
|
|
|
||
|
|
return_ACPI_STATUS(status);
|
||
|
|
}
|
||
|
|
|
||
|
|
/*******************************************************************************
|
||
|
|
*
|
||
|
|
* FUNCTION: acpi_ex_opcode_3A_1T_1R
|
||
|
|
*
|
||
|
|
* PARAMETERS: walk_state - Current walk state
|
||
|
|
*
|
||
|
|
* RETURN: Status
|
||
|
|
*
|
||
|
|
* DESCRIPTION: Execute Triadic operator (3 operands)
|
||
|
|
*
|
||
|
|
******************************************************************************/
|
||
|
|
|
||
|
|
acpi_status acpi_ex_opcode_3A_1T_1R(struct acpi_walk_state *walk_state)
|
||
|
|
{
|
||
|
|
union acpi_operand_object **operand = &walk_state->operands[0];
|
||
|
|
union acpi_operand_object *return_desc = NULL;
|
||
|
|
char *buffer = NULL;
|
||
|
|
acpi_status status = AE_OK;
|
||
|
|
u64 index;
|
||
|
|
acpi_size length;
|
||
|
|
|
||
|
|
ACPI_FUNCTION_TRACE_STR(ex_opcode_3A_1T_1R,
|
||
|
|
acpi_ps_get_opcode_name(walk_state->opcode));
|
||
|
|
|
||
|
|
switch (walk_state->opcode) {
|
||
|
|
case AML_MID_OP: /* Mid (Source[0], Index[1], Length[2], Result[3]) */
|
||
|
|
/*
|
||
|
|
* Create the return object. The Source operand is guaranteed to be
|
||
|
|
* either a String or a Buffer, so just use its type.
|
||
|
|
*/
|
||
|
|
return_desc = acpi_ut_create_internal_object((operand[0])->
|
||
|
|
common.type);
|
||
|
|
if (!return_desc) {
|
||
|
|
status = AE_NO_MEMORY;
|
||
|
|
goto cleanup;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Get the Integer values from the objects */
|
||
|
|
|
||
|
|
index = operand[1]->integer.value;
|
||
|
|
length = (acpi_size)operand[2]->integer.value;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* If the index is beyond the length of the String/Buffer, or if the
|
||
|
|
* requested length is zero, return a zero-length String/Buffer
|
||
|
|
*/
|
||
|
|
if (index >= operand[0]->string.length) {
|
||
|
|
length = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Truncate request if larger than the actual String/Buffer */
|
||
|
|
|
||
|
|
else if ((index + length) > operand[0]->string.length) {
|
||
|
|
length =
|
||
|
|
(acpi_size)operand[0]->string.length -
|
||
|
|
(acpi_size)index;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Strings always have a sub-pointer, not so for buffers */
|
||
|
|
|
||
|
|
switch ((operand[0])->common.type) {
|
||
|
|
case ACPI_TYPE_STRING:
|
||
|
|
|
||
|
|
/* Always allocate a new buffer for the String */
|
||
|
|
|
||
|
|
buffer = ACPI_ALLOCATE_ZEROED((acpi_size)length + 1);
|
||
|
|
if (!buffer) {
|
||
|
|
status = AE_NO_MEMORY;
|
||
|
|
goto cleanup;
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case ACPI_TYPE_BUFFER:
|
||
|
|
|
||
|
|
/* If the requested length is zero, don't allocate a buffer */
|
||
|
|
|
||
|
|
if (length > 0) {
|
||
|
|
|
||
|
|
/* Allocate a new buffer for the Buffer */
|
||
|
|
|
||
|
|
buffer = ACPI_ALLOCATE_ZEROED(length);
|
||
|
|
if (!buffer) {
|
||
|
|
status = AE_NO_MEMORY;
|
||
|
|
goto cleanup;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
default: /* Should not happen */
|
||
|
|
|
||
|
|
status = AE_AML_OPERAND_TYPE;
|
||
|
|
goto cleanup;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (buffer) {
|
||
|
|
|
||
|
|
/* We have a buffer, copy the portion requested */
|
||
|
|
|
||
|
|
memcpy(buffer,
|
||
|
|
operand[0]->string.pointer + index, length);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Set the length of the new String/Buffer */
|
||
|
|
|
||
|
|
return_desc->string.pointer = buffer;
|
||
|
|
return_desc->string.length = (u32) length;
|
||
|
|
|
||
|
|
/* Mark buffer initialized */
|
||
|
|
|
||
|
|
return_desc->buffer.flags |= AOPOBJ_DATA_VALID;
|
||
|
|
break;
|
||
|
|
|
||
|
|
default:
|
||
|
|
|
||
|
|
ACPI_ERROR((AE_INFO, "Unknown AML opcode 0x%X",
|
||
|
|
walk_state->opcode));
|
||
|
|
|
||
|
|
status = AE_AML_BAD_OPCODE;
|
||
|
|
goto cleanup;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Store the result in the target */
|
||
|
|
|
||
|
|
status = acpi_ex_store(return_desc, operand[3], walk_state);
|
||
|
|
|
||
|
|
cleanup:
|
||
|
|
|
||
|
|
/* Delete return object on error */
|
||
|
|
|
||
|
|
if (ACPI_FAILURE(status) || walk_state->result_obj) {
|
||
|
|
acpi_ut_remove_reference(return_desc);
|
||
|
|
walk_state->result_obj = NULL;
|
||
|
|
} else {
|
||
|
|
/* Set the return object and exit */
|
||
|
|
|
||
|
|
walk_state->result_obj = return_desc;
|
||
|
|
}
|
||
|
|
|
||
|
|
return_ACPI_STATUS(status);
|
||
|
|
}
|