]> rtime.felk.cvut.cz Git - linux-imx.git/blob - drivers/acpi/acpica/exoparg2.c
cpufreq: Fix cpufreq regression after suspend/resume
[linux-imx.git] / drivers / acpi / acpica / exoparg2.c
1 /******************************************************************************
2  *
3  * Module Name: exoparg2 - AML execution - opcodes with 2 arguments
4  *
5  *****************************************************************************/
6
7 /*
8  * Copyright (C) 2000 - 2013, 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 <acpi/acpi.h>
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                 /*
309                  * Input object is guaranteed to be a buffer at this point (it may have
310                  * been converted.)  Copy the raw buffer data to a new object of
311                  * type String.
312                  */
313
314                 /*
315                  * Get the length of the new string. It is the smallest of:
316                  * 1) Length of the input buffer
317                  * 2) Max length as specified in the to_string operator
318                  * 3) Length of input buffer up to a zero byte (null terminator)
319                  *
320                  * NOTE: A length of zero is ok, and will create a zero-length, null
321                  *       terminated string.
322                  */
323                 while ((length < operand[0]->buffer.length) &&
324                        (length < operand[1]->integer.value) &&
325                        (operand[0]->buffer.pointer[length])) {
326                         length++;
327                 }
328
329                 /* Allocate a new string object */
330
331                 return_desc = acpi_ut_create_string_object(length);
332                 if (!return_desc) {
333                         status = AE_NO_MEMORY;
334                         goto cleanup;
335                 }
336
337                 /*
338                  * Copy the raw buffer data with no transform.
339                  * (NULL terminated already)
340                  */
341                 ACPI_MEMCPY(return_desc->string.pointer,
342                             operand[0]->buffer.pointer, length);
343                 break;
344
345         case AML_CONCAT_RES_OP:
346
347                 /* concatenate_res_template (Buffer, Buffer, Result) (ACPI 2.0) */
348
349                 status = acpi_ex_concat_template(operand[0], operand[1],
350                                                  &return_desc, walk_state);
351                 break;
352
353         case AML_INDEX_OP:      /* Index (Source Index Result) */
354
355                 /* Create the internal return object */
356
357                 return_desc =
358                     acpi_ut_create_internal_object(ACPI_TYPE_LOCAL_REFERENCE);
359                 if (!return_desc) {
360                         status = AE_NO_MEMORY;
361                         goto cleanup;
362                 }
363
364                 /* Initialize the Index reference object */
365
366                 index = operand[1]->integer.value;
367                 return_desc->reference.value = (u32) index;
368                 return_desc->reference.class = ACPI_REFCLASS_INDEX;
369
370                 /*
371                  * At this point, the Source operand is a String, Buffer, or Package.
372                  * Verify that the index is within range.
373                  */
374                 switch ((operand[0])->common.type) {
375                 case ACPI_TYPE_STRING:
376
377                         if (index >= operand[0]->string.length) {
378                                 length = operand[0]->string.length;
379                                 status = AE_AML_STRING_LIMIT;
380                         }
381
382                         return_desc->reference.target_type =
383                             ACPI_TYPE_BUFFER_FIELD;
384                         break;
385
386                 case ACPI_TYPE_BUFFER:
387
388                         if (index >= operand[0]->buffer.length) {
389                                 length = operand[0]->buffer.length;
390                                 status = AE_AML_BUFFER_LIMIT;
391                         }
392
393                         return_desc->reference.target_type =
394                             ACPI_TYPE_BUFFER_FIELD;
395                         break;
396
397                 case ACPI_TYPE_PACKAGE:
398
399                         if (index >= operand[0]->package.count) {
400                                 length = operand[0]->package.count;
401                                 status = AE_AML_PACKAGE_LIMIT;
402                         }
403
404                         return_desc->reference.target_type = ACPI_TYPE_PACKAGE;
405                         return_desc->reference.where =
406                             &operand[0]->package.elements[index];
407                         break;
408
409                 default:
410
411                         status = AE_AML_INTERNAL;
412                         goto cleanup;
413                 }
414
415                 /* Failure means that the Index was beyond the end of the object */
416
417                 if (ACPI_FAILURE(status)) {
418                         ACPI_EXCEPTION((AE_INFO, status,
419                                         "Index (0x%X%8.8X) is beyond end of object (length 0x%X)",
420                                         ACPI_FORMAT_UINT64(index),
421                                         (u32)length));
422                         goto cleanup;
423                 }
424
425                 /*
426                  * Save the target object and add a reference to it for the life
427                  * of the index
428                  */
429                 return_desc->reference.object = operand[0];
430                 acpi_ut_add_reference(operand[0]);
431
432                 /* Store the reference to the Target */
433
434                 status = acpi_ex_store(return_desc, operand[2], walk_state);
435
436                 /* Return the reference */
437
438                 walk_state->result_obj = return_desc;
439                 goto cleanup;
440
441         default:
442
443                 ACPI_ERROR((AE_INFO, "Unknown AML opcode 0x%X",
444                             walk_state->opcode));
445                 status = AE_AML_BAD_OPCODE;
446                 break;
447         }
448
449       store_result_to_target:
450
451         if (ACPI_SUCCESS(status)) {
452                 /*
453                  * Store the result of the operation (which is now in return_desc) into
454                  * the Target descriptor.
455                  */
456                 status = acpi_ex_store(return_desc, operand[2], walk_state);
457                 if (ACPI_FAILURE(status)) {
458                         goto cleanup;
459                 }
460
461                 if (!walk_state->result_obj) {
462                         walk_state->result_obj = return_desc;
463                 }
464         }
465
466       cleanup:
467
468         /* Delete return object on error */
469
470         if (ACPI_FAILURE(status)) {
471                 acpi_ut_remove_reference(return_desc);
472                 walk_state->result_obj = NULL;
473         }
474
475         return_ACPI_STATUS(status);
476 }
477
478 /*******************************************************************************
479  *
480  * FUNCTION:    acpi_ex_opcode_2A_0T_1R
481  *
482  * PARAMETERS:  walk_state          - Current walk state
483  *
484  * RETURN:      Status
485  *
486  * DESCRIPTION: Execute opcode with 2 arguments, no target, and a return value
487  *
488  ******************************************************************************/
489
490 acpi_status acpi_ex_opcode_2A_0T_1R(struct acpi_walk_state *walk_state)
491 {
492         union acpi_operand_object **operand = &walk_state->operands[0];
493         union acpi_operand_object *return_desc = NULL;
494         acpi_status status = AE_OK;
495         u8 logical_result = FALSE;
496
497         ACPI_FUNCTION_TRACE_STR(ex_opcode_2A_0T_1R,
498                                 acpi_ps_get_opcode_name(walk_state->opcode));
499
500         /* Create the internal return object */
501
502         return_desc = acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
503         if (!return_desc) {
504                 status = AE_NO_MEMORY;
505                 goto cleanup;
506         }
507
508         /* Execute the Opcode */
509
510         if (walk_state->op_info->flags & AML_LOGICAL_NUMERIC) {
511
512                 /* logical_op (Operand0, Operand1) */
513
514                 status = acpi_ex_do_logical_numeric_op(walk_state->opcode,
515                                                        operand[0]->integer.
516                                                        value,
517                                                        operand[1]->integer.
518                                                        value, &logical_result);
519                 goto store_logical_result;
520         } else if (walk_state->op_info->flags & AML_LOGICAL) {
521
522                 /* logical_op (Operand0, Operand1) */
523
524                 status = acpi_ex_do_logical_op(walk_state->opcode, operand[0],
525                                                operand[1], &logical_result);
526                 goto store_logical_result;
527         }
528
529         switch (walk_state->opcode) {
530         case AML_ACQUIRE_OP:    /* Acquire (mutex_object, Timeout) */
531
532                 status =
533                     acpi_ex_acquire_mutex(operand[1], operand[0], walk_state);
534                 if (status == AE_TIME) {
535                         logical_result = TRUE;  /* TRUE = Acquire timed out */
536                         status = AE_OK;
537                 }
538                 break;
539
540         case AML_WAIT_OP:       /* Wait (event_object, Timeout) */
541
542                 status = acpi_ex_system_wait_event(operand[1], operand[0]);
543                 if (status == AE_TIME) {
544                         logical_result = TRUE;  /* TRUE, Wait timed out */
545                         status = AE_OK;
546                 }
547                 break;
548
549         default:
550
551                 ACPI_ERROR((AE_INFO, "Unknown AML opcode 0x%X",
552                             walk_state->opcode));
553                 status = AE_AML_BAD_OPCODE;
554                 goto cleanup;
555         }
556
557       store_logical_result:
558         /*
559          * Set return value to according to logical_result. logical TRUE (all ones)
560          * Default is FALSE (zero)
561          */
562         if (logical_result) {
563                 return_desc->integer.value = ACPI_UINT64_MAX;
564         }
565
566       cleanup:
567
568         /* Delete return object on error */
569
570         if (ACPI_FAILURE(status)) {
571                 acpi_ut_remove_reference(return_desc);
572         }
573
574         /* Save return object on success */
575
576         else {
577                 walk_state->result_obj = return_desc;
578         }
579
580         return_ACPI_STATUS(status);
581 }