Subversion Repositories Kolibri OS

Rev

Go to most recent revision | Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
6595 serge 1
/******************************************************************************
2
 *
3
 * Module Name: exoparg2 - AML execution - opcodes with 2 arguments
4
 *
5
 *****************************************************************************/
6
 
7
/*
8
 * Copyright (C) 2000 - 2015, Intel Corp.
9
 * All rights reserved.
10
 *
11
 * Redistribution and use in source and binary forms, with or without
12
 * modification, are permitted provided that the following conditions
13
 * are met:
14
 * 1. Redistributions of source code must retain the above copyright
15
 *    notice, this list of conditions, and the following disclaimer,
16
 *    without modification.
17
 * 2. Redistributions in binary form must reproduce at minimum a disclaimer
18
 *    substantially similar to the "NO WARRANTY" disclaimer below
19
 *    ("Disclaimer") and any redistribution must be conditioned upon
20
 *    including a substantially similar Disclaimer requirement for further
21
 *    binary redistribution.
22
 * 3. Neither the names of the above-listed copyright holders nor the names
23
 *    of any contributors may be used to endorse or promote products derived
24
 *    from this software without specific prior written permission.
25
 *
26
 * Alternatively, this software may be distributed under the terms of the
27
 * GNU General Public License ("GPL") version 2 as published by the Free
28
 * Software Foundation.
29
 *
30
 * NO WARRANTY
31
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
32
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
33
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
34
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
35
 * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
36
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
37
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
38
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
39
 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
40
 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
41
 * POSSIBILITY OF SUCH DAMAGES.
42
 */
43
 
44
#include 
45
#include "accommon.h"
46
#include "acparser.h"
47
#include "acinterp.h"
48
#include "acevents.h"
49
#include "amlcode.h"
50
 
51
#define _COMPONENT          ACPI_EXECUTER
52
ACPI_MODULE_NAME("exoparg2")
53
 
54
/*!
55
 * Naming convention for AML interpreter execution routines.
56
 *
57
 * The routines that begin execution of AML opcodes are named with a common
58
 * convention based upon the number of arguments, the number of target operands,
59
 * and whether or not a value is returned:
60
 *
61
 *      AcpiExOpcode_xA_yT_zR
62
 *
63
 * Where:
64
 *
65
 * xA - ARGUMENTS:    The number of arguments (input operands) that are
66
 *                    required for this opcode type (1 through 6 args).
67
 * yT - TARGETS:      The number of targets (output operands) that are required
68
 *                    for this opcode type (0, 1, or 2 targets).
69
 * zR - RETURN VALUE: Indicates whether this opcode type returns a value
70
 *                    as the function return (0 or 1).
71
 *
72
 * The AcpiExOpcode* functions are called via the Dispatcher component with
73
 * fully resolved operands.
74
!*/
75
/*******************************************************************************
76
 *
77
 * FUNCTION:    acpi_ex_opcode_2A_0T_0R
78
 *
79
 * PARAMETERS:  walk_state          - Current walk state
80
 *
81
 * RETURN:      Status
82
 *
83
 * DESCRIPTION: Execute opcode with two arguments, no target, and no return
84
 *              value.
85
 *
86
 * ALLOCATION:  Deletes both operands
87
 *
88
 ******************************************************************************/
89
acpi_status acpi_ex_opcode_2A_0T_0R(struct acpi_walk_state *walk_state)
90
{
91
	union acpi_operand_object **operand = &walk_state->operands[0];
92
	struct acpi_namespace_node *node;
93
	u32 value;
94
	acpi_status status = AE_OK;
95
 
96
	ACPI_FUNCTION_TRACE_STR(ex_opcode_2A_0T_0R,
97
				acpi_ps_get_opcode_name(walk_state->opcode));
98
 
99
	/* Examine the opcode */
100
 
101
	switch (walk_state->opcode) {
102
	case AML_NOTIFY_OP:	/* Notify (notify_object, notify_value) */
103
 
104
		/* The first operand is a namespace node */
105
 
106
		node = (struct acpi_namespace_node *)operand[0];
107
 
108
		/* Second value is the notify value */
109
 
110
		value = (u32) operand[1]->integer.value;
111
 
112
		/* Are notifies allowed on this object? */
113
 
114
		if (!acpi_ev_is_notify_object(node)) {
115
			ACPI_ERROR((AE_INFO,
116
				    "Unexpected notify object type [%s]",
117
				    acpi_ut_get_type_name(node->type)));
118
 
119
			status = AE_AML_OPERAND_TYPE;
120
			break;
121
		}
122
 
123
		/*
124
		 * Dispatch the notify to the appropriate handler
125
		 * NOTE: the request is queued for execution after this method
126
		 * completes. The notify handlers are NOT invoked synchronously
127
		 * from this thread -- because handlers may in turn run other
128
		 * control methods.
129
		 */
130
		status = acpi_ev_queue_notify_request(node, value);
131
		break;
132
 
133
	default:
134
 
135
		ACPI_ERROR((AE_INFO, "Unknown AML opcode 0x%X",
136
			    walk_state->opcode));
137
		status = AE_AML_BAD_OPCODE;
138
	}
139
 
140
	return_ACPI_STATUS(status);
141
}
142
 
143
/*******************************************************************************
144
 *
145
 * FUNCTION:    acpi_ex_opcode_2A_2T_1R
146
 *
147
 * PARAMETERS:  walk_state          - Current walk state
148
 *
149
 * RETURN:      Status
150
 *
151
 * DESCRIPTION: Execute a dyadic operator (2 operands) with 2 output targets
152
 *              and one implicit return value.
153
 *
154
 ******************************************************************************/
155
 
156
acpi_status acpi_ex_opcode_2A_2T_1R(struct acpi_walk_state *walk_state)
157
{
158
	union acpi_operand_object **operand = &walk_state->operands[0];
159
	union acpi_operand_object *return_desc1 = NULL;
160
	union acpi_operand_object *return_desc2 = NULL;
161
	acpi_status status;
162
 
163
	ACPI_FUNCTION_TRACE_STR(ex_opcode_2A_2T_1R,
164
				acpi_ps_get_opcode_name(walk_state->opcode));
165
 
166
	/* Execute the opcode */
167
 
168
	switch (walk_state->opcode) {
169
	case AML_DIVIDE_OP:
170
 
171
		/* Divide (Dividend, Divisor, remainder_result quotient_result) */
172
 
173
		return_desc1 =
174
		    acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
175
		if (!return_desc1) {
176
			status = AE_NO_MEMORY;
177
			goto cleanup;
178
		}
179
 
180
		return_desc2 =
181
		    acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
182
		if (!return_desc2) {
183
			status = AE_NO_MEMORY;
184
			goto cleanup;
185
		}
186
 
187
		/* Quotient to return_desc1, remainder to return_desc2 */
188
 
189
		status = acpi_ut_divide(operand[0]->integer.value,
190
					operand[1]->integer.value,
191
					&return_desc1->integer.value,
192
					&return_desc2->integer.value);
193
		if (ACPI_FAILURE(status)) {
194
			goto cleanup;
195
		}
196
		break;
197
 
198
	default:
199
 
200
		ACPI_ERROR((AE_INFO, "Unknown AML opcode 0x%X",
201
			    walk_state->opcode));
202
		status = AE_AML_BAD_OPCODE;
203
		goto cleanup;
204
	}
205
 
206
	/* Store the results to the target reference operands */
207
 
208
	status = acpi_ex_store(return_desc2, operand[2], walk_state);
209
	if (ACPI_FAILURE(status)) {
210
		goto cleanup;
211
	}
212
 
213
	status = acpi_ex_store(return_desc1, operand[3], walk_state);
214
	if (ACPI_FAILURE(status)) {
215
		goto cleanup;
216
	}
217
 
218
cleanup:
219
	/*
220
	 * Since the remainder is not returned indirectly, remove a reference to
221
	 * it. Only the quotient is returned indirectly.
222
	 */
223
	acpi_ut_remove_reference(return_desc2);
224
 
225
	if (ACPI_FAILURE(status)) {
226
 
227
		/* Delete the return object */
228
 
229
		acpi_ut_remove_reference(return_desc1);
230
	}
231
 
232
	/* Save return object (the remainder) on success */
233
 
234
	else {
235
		walk_state->result_obj = return_desc1;
236
	}
237
 
238
	return_ACPI_STATUS(status);
239
}
240
 
241
/*******************************************************************************
242
 *
243
 * FUNCTION:    acpi_ex_opcode_2A_1T_1R
244
 *
245
 * PARAMETERS:  walk_state          - Current walk state
246
 *
247
 * RETURN:      Status
248
 *
249
 * DESCRIPTION: Execute opcode with two arguments, one target, and a return
250
 *              value.
251
 *
252
 ******************************************************************************/
253
 
254
acpi_status acpi_ex_opcode_2A_1T_1R(struct acpi_walk_state *walk_state)
255
{
256
	union acpi_operand_object **operand = &walk_state->operands[0];
257
	union acpi_operand_object *return_desc = NULL;
258
	u64 index;
259
	acpi_status status = AE_OK;
260
	acpi_size length = 0;
261
 
262
	ACPI_FUNCTION_TRACE_STR(ex_opcode_2A_1T_1R,
263
				acpi_ps_get_opcode_name(walk_state->opcode));
264
 
265
	/* Execute the opcode */
266
 
267
	if (walk_state->op_info->flags & AML_MATH) {
268
 
269
		/* All simple math opcodes (add, etc.) */
270
 
271
		return_desc = acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
272
		if (!return_desc) {
273
			status = AE_NO_MEMORY;
274
			goto cleanup;
275
		}
276
 
277
		return_desc->integer.value =
278
		    acpi_ex_do_math_op(walk_state->opcode,
279
				       operand[0]->integer.value,
280
				       operand[1]->integer.value);
281
		goto store_result_to_target;
282
	}
283
 
284
	switch (walk_state->opcode) {
285
	case AML_MOD_OP:	/* Mod (Dividend, Divisor, remainder_result (ACPI 2.0) */
286
 
287
		return_desc = acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
288
		if (!return_desc) {
289
			status = AE_NO_MEMORY;
290
			goto cleanup;
291
		}
292
 
293
		/* return_desc will contain the remainder */
294
 
295
		status = acpi_ut_divide(operand[0]->integer.value,
296
					operand[1]->integer.value,
297
					NULL, &return_desc->integer.value);
298
		break;
299
 
300
	case AML_CONCAT_OP:	/* Concatenate (Data1, Data2, Result) */
301
 
302
		status = acpi_ex_do_concatenate(operand[0], operand[1],
303
						&return_desc, walk_state);
304
		break;
305
 
306
	case AML_TO_STRING_OP:	/* to_string (Buffer, Length, Result) (ACPI 2.0) */
307
		/*
308
		 * Input object is guaranteed to be a buffer at this point (it may have
309
		 * been converted.)  Copy the raw buffer data to a new object of
310
		 * type String.
311
		 */
312
 
313
		/*
314
		 * Get the length of the new string. It is the smallest of:
315
		 * 1) Length of the input buffer
316
		 * 2) Max length as specified in the to_string operator
317
		 * 3) Length of input buffer up to a zero byte (null terminator)
318
		 *
319
		 * NOTE: A length of zero is ok, and will create a zero-length, null
320
		 *       terminated string.
321
		 */
322
		while ((length < operand[0]->buffer.length) &&
323
		       (length < operand[1]->integer.value) &&
324
		       (operand[0]->buffer.pointer[length])) {
325
			length++;
326
		}
327
 
328
		/* Allocate a new string object */
329
 
330
		return_desc = acpi_ut_create_string_object(length);
331
		if (!return_desc) {
332
			status = AE_NO_MEMORY;
333
			goto cleanup;
334
		}
335
 
336
		/*
337
		 * Copy the raw buffer data with no transform.
338
		 * (NULL terminated already)
339
		 */
340
		memcpy(return_desc->string.pointer,
341
		       operand[0]->buffer.pointer, length);
342
		break;
343
 
344
	case AML_CONCAT_RES_OP:
345
 
346
		/* concatenate_res_template (Buffer, Buffer, Result) (ACPI 2.0) */
347
 
348
		status = acpi_ex_concat_template(operand[0], operand[1],
349
						 &return_desc, walk_state);
350
		break;
351
 
352
	case AML_INDEX_OP:	/* Index (Source Index Result) */
353
 
354
		/* Create the internal return object */
355
 
356
		return_desc =
357
		    acpi_ut_create_internal_object(ACPI_TYPE_LOCAL_REFERENCE);
358
		if (!return_desc) {
359
			status = AE_NO_MEMORY;
360
			goto cleanup;
361
		}
362
 
363
		/* Initialize the Index reference object */
364
 
365
		index = operand[1]->integer.value;
366
		return_desc->reference.value = (u32) index;
367
		return_desc->reference.class = ACPI_REFCLASS_INDEX;
368
 
369
		/*
370
		 * At this point, the Source operand is a String, Buffer, or Package.
371
		 * Verify that the index is within range.
372
		 */
373
		switch ((operand[0])->common.type) {
374
		case ACPI_TYPE_STRING:
375
 
376
			if (index >= operand[0]->string.length) {
377
				length = operand[0]->string.length;
378
				status = AE_AML_STRING_LIMIT;
379
			}
380
 
381
			return_desc->reference.target_type =
382
			    ACPI_TYPE_BUFFER_FIELD;
383
			return_desc->reference.index_pointer =
384
			    &(operand[0]->buffer.pointer[index]);
385
			break;
386
 
387
		case ACPI_TYPE_BUFFER:
388
 
389
			if (index >= operand[0]->buffer.length) {
390
				length = operand[0]->buffer.length;
391
				status = AE_AML_BUFFER_LIMIT;
392
			}
393
 
394
			return_desc->reference.target_type =
395
			    ACPI_TYPE_BUFFER_FIELD;
396
			return_desc->reference.index_pointer =
397
			    &(operand[0]->buffer.pointer[index]);
398
			break;
399
 
400
		case ACPI_TYPE_PACKAGE:
401
 
402
			if (index >= operand[0]->package.count) {
403
				length = operand[0]->package.count;
404
				status = AE_AML_PACKAGE_LIMIT;
405
			}
406
 
407
			return_desc->reference.target_type = ACPI_TYPE_PACKAGE;
408
			return_desc->reference.where =
409
			    &operand[0]->package.elements[index];
410
			break;
411
 
412
		default:
413
 
414
			status = AE_AML_INTERNAL;
415
			goto cleanup;
416
		}
417
 
418
		/* Failure means that the Index was beyond the end of the object */
419
 
420
		if (ACPI_FAILURE(status)) {
421
			ACPI_EXCEPTION((AE_INFO, status,
422
					"Index (0x%X%8.8X) is beyond end of object (length 0x%X)",
423
					ACPI_FORMAT_UINT64(index),
424
					(u32)length));
425
			goto cleanup;
426
		}
427
 
428
		/*
429
		 * Save the target object and add a reference to it for the life
430
		 * of the index
431
		 */
432
		return_desc->reference.object = operand[0];
433
		acpi_ut_add_reference(operand[0]);
434
 
435
		/* Store the reference to the Target */
436
 
437
		status = acpi_ex_store(return_desc, operand[2], walk_state);
438
 
439
		/* Return the reference */
440
 
441
		walk_state->result_obj = return_desc;
442
		goto cleanup;
443
 
444
	default:
445
 
446
		ACPI_ERROR((AE_INFO, "Unknown AML opcode 0x%X",
447
			    walk_state->opcode));
448
		status = AE_AML_BAD_OPCODE;
449
		break;
450
	}
451
 
452
store_result_to_target:
453
 
454
	if (ACPI_SUCCESS(status)) {
455
		/*
456
		 * Store the result of the operation (which is now in return_desc) into
457
		 * the Target descriptor.
458
		 */
459
		status = acpi_ex_store(return_desc, operand[2], walk_state);
460
		if (ACPI_FAILURE(status)) {
461
			goto cleanup;
462
		}
463
 
464
		if (!walk_state->result_obj) {
465
			walk_state->result_obj = return_desc;
466
		}
467
	}
468
 
469
cleanup:
470
 
471
	/* Delete return object on error */
472
 
473
	if (ACPI_FAILURE(status)) {
474
		acpi_ut_remove_reference(return_desc);
475
		walk_state->result_obj = NULL;
476
	}
477
 
478
	return_ACPI_STATUS(status);
479
}
480
 
481
/*******************************************************************************
482
 *
483
 * FUNCTION:    acpi_ex_opcode_2A_0T_1R
484
 *
485
 * PARAMETERS:  walk_state          - Current walk state
486
 *
487
 * RETURN:      Status
488
 *
489
 * DESCRIPTION: Execute opcode with 2 arguments, no target, and a return value
490
 *
491
 ******************************************************************************/
492
 
493
acpi_status acpi_ex_opcode_2A_0T_1R(struct acpi_walk_state *walk_state)
494
{
495
	union acpi_operand_object **operand = &walk_state->operands[0];
496
	union acpi_operand_object *return_desc = NULL;
497
	acpi_status status = AE_OK;
498
	u8 logical_result = FALSE;
499
 
500
	ACPI_FUNCTION_TRACE_STR(ex_opcode_2A_0T_1R,
501
				acpi_ps_get_opcode_name(walk_state->opcode));
502
 
503
	/* Create the internal return object */
504
 
505
	return_desc = acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
506
	if (!return_desc) {
507
		status = AE_NO_MEMORY;
508
		goto cleanup;
509
	}
510
 
511
	/* Execute the Opcode */
512
 
513
	if (walk_state->op_info->flags & AML_LOGICAL_NUMERIC) {
514
 
515
		/* logical_op (Operand0, Operand1) */
516
 
517
		status = acpi_ex_do_logical_numeric_op(walk_state->opcode,
518
						       operand[0]->integer.
519
						       value,
520
						       operand[1]->integer.
521
						       value, &logical_result);
522
		goto store_logical_result;
523
	} else if (walk_state->op_info->flags & AML_LOGICAL) {
524
 
525
		/* logical_op (Operand0, Operand1) */
526
 
527
		status = acpi_ex_do_logical_op(walk_state->opcode, operand[0],
528
					       operand[1], &logical_result);
529
		goto store_logical_result;
530
	}
531
 
532
	switch (walk_state->opcode) {
533
	case AML_ACQUIRE_OP:	/* Acquire (mutex_object, Timeout) */
534
 
535
		status =
536
		    acpi_ex_acquire_mutex(operand[1], operand[0], walk_state);
537
		if (status == AE_TIME) {
538
			logical_result = TRUE;	/* TRUE = Acquire timed out */
539
			status = AE_OK;
540
		}
541
		break;
542
 
543
	case AML_WAIT_OP:	/* Wait (event_object, Timeout) */
544
 
545
		status = acpi_ex_system_wait_event(operand[1], operand[0]);
546
		if (status == AE_TIME) {
547
			logical_result = TRUE;	/* TRUE, Wait timed out */
548
			status = AE_OK;
549
		}
550
		break;
551
 
552
	default:
553
 
554
		ACPI_ERROR((AE_INFO, "Unknown AML opcode 0x%X",
555
			    walk_state->opcode));
556
		status = AE_AML_BAD_OPCODE;
557
		goto cleanup;
558
	}
559
 
560
store_logical_result:
561
	/*
562
	 * Set return value to according to logical_result. logical TRUE (all ones)
563
	 * Default is FALSE (zero)
564
	 */
565
	if (logical_result) {
566
		return_desc->integer.value = ACPI_UINT64_MAX;
567
	}
568
 
569
cleanup:
570
 
571
	/* Delete return object on error */
572
 
573
	if (ACPI_FAILURE(status)) {
574
		acpi_ut_remove_reference(return_desc);
575
	}
576
 
577
	/* Save return object on success */
578
 
579
	else {
580
		walk_state->result_obj = return_desc;
581
	}
582
 
583
	return_ACPI_STATUS(status);
584
}