bnx2: Reinsert VLAN tag when necessary.
[linux-2.6] / drivers / acpi / executer / exoparg2.c
1 /******************************************************************************
2  *
3  * Module Name: exoparg2 - AML execution - opcodes with 2 arguments
4  *
5  *****************************************************************************/
6
7 /*
8  * Copyright (C) 2000 - 2008, 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 <acpi/acparser.h>
46 #include <acpi/acinterp.h>
47 #include <acpi/acevents.h>
48 #include <acpi/amlcode.h>
49
50 #define _COMPONENT          ACPI_EXECUTER
51 ACPI_MODULE_NAME("exoparg2")
52
53 /*!
54  * Naming convention for AML interpreter execution routines.
55  *
56  * The routines that begin execution of AML opcodes are named with a common
57  * convention based upon the number of arguments, the number of target operands,
58  * and whether or not a value is returned:
59  *
60  *      AcpiExOpcode_xA_yT_zR
61  *
62  * Where:
63  *
64  * xA - ARGUMENTS:    The number of arguments (input operands) that are
65  *                    required for this opcode type (1 through 6 args).
66  * yT - TARGETS:      The number of targets (output operands) that are required
67  *                    for this opcode type (0, 1, or 2 targets).
68  * zR - RETURN VALUE: Indicates whether this opcode type returns a value
69  *                    as the function return (0 or 1).
70  *
71  * The AcpiExOpcode* functions are called via the Dispatcher component with
72  * fully resolved operands.
73 !*/
74 /*******************************************************************************
75  *
76  * FUNCTION:    acpi_ex_opcode_2A_0T_0R
77  *
78  * PARAMETERS:  walk_state          - Current walk state
79  *
80  * RETURN:      Status
81  *
82  * DESCRIPTION: Execute opcode with two arguments, no target, and no return
83  *              value.
84  *
85  * ALLOCATION:  Deletes both operands
86  *
87  ******************************************************************************/
88 acpi_status acpi_ex_opcode_2A_0T_0R(struct acpi_walk_state *walk_state)
89 {
90         union acpi_operand_object **operand = &walk_state->operands[0];
91         struct acpi_namespace_node *node;
92         u32 value;
93         acpi_status status = AE_OK;
94
95         ACPI_FUNCTION_TRACE_STR(ex_opcode_2A_0T_0R,
96                                 acpi_ps_get_opcode_name(walk_state->opcode));
97
98         /* Examine the opcode */
99
100         switch (walk_state->opcode) {
101         case AML_NOTIFY_OP:     /* Notify (notify_object, notify_value) */
102
103                 /* The first operand is a namespace node */
104
105                 node = (struct acpi_namespace_node *)operand[0];
106
107                 /* Second value is the notify value */
108
109                 value = (u32) operand[1]->integer.value;
110
111                 /* Are notifies allowed on this object? */
112
113                 if (!acpi_ev_is_notify_object(node)) {
114                         ACPI_ERROR((AE_INFO,
115                                     "Unexpected notify object type [%s]",
116                                     acpi_ut_get_type_name(node->type)));
117
118                         status = AE_AML_OPERAND_TYPE;
119                         break;
120                 }
121 #ifdef ACPI_GPE_NOTIFY_CHECK
122                 /*
123                  * GPE method wake/notify check.  Here, we want to ensure that we
124                  * don't receive any "DeviceWake" Notifies from a GPE _Lxx or _Exx
125                  * GPE method during system runtime.  If we do, the GPE is marked
126                  * as "wake-only" and disabled.
127                  *
128                  * 1) Is the Notify() value == device_wake?
129                  * 2) Is this a GPE deferred method?  (An _Lxx or _Exx method)
130                  * 3) Did the original GPE happen at system runtime?
131                  *    (versus during wake)
132                  *
133                  * If all three cases are true, this is a wake-only GPE that should
134                  * be disabled at runtime.
135                  */
136                 if (value == 2) {       /* device_wake */
137                         status =
138                             acpi_ev_check_for_wake_only_gpe(walk_state->
139                                                             gpe_event_info);
140                         if (ACPI_FAILURE(status)) {
141
142                                 /* AE_WAKE_ONLY_GPE only error, means ignore this notify */
143
144                                 return_ACPI_STATUS(AE_OK)
145                         }
146                 }
147 #endif
148
149                 /*
150                  * Dispatch the notify to the appropriate handler
151                  * NOTE: the request is queued for execution after this method
152                  * completes.  The notify handlers are NOT invoked synchronously
153                  * from this thread -- because handlers may in turn run other
154                  * control methods.
155                  */
156                 status = acpi_ev_queue_notify_request(node, value);
157                 break;
158
159         default:
160
161                 ACPI_ERROR((AE_INFO, "Unknown AML opcode %X",
162                             walk_state->opcode));
163                 status = AE_AML_BAD_OPCODE;
164         }
165
166         return_ACPI_STATUS(status);
167 }
168
169 /*******************************************************************************
170  *
171  * FUNCTION:    acpi_ex_opcode_2A_2T_1R
172  *
173  * PARAMETERS:  walk_state          - Current walk state
174  *
175  * RETURN:      Status
176  *
177  * DESCRIPTION: Execute a dyadic operator (2 operands) with 2 output targets
178  *              and one implicit return value.
179  *
180  ******************************************************************************/
181
182 acpi_status acpi_ex_opcode_2A_2T_1R(struct acpi_walk_state *walk_state)
183 {
184         union acpi_operand_object **operand = &walk_state->operands[0];
185         union acpi_operand_object *return_desc1 = NULL;
186         union acpi_operand_object *return_desc2 = NULL;
187         acpi_status status;
188
189         ACPI_FUNCTION_TRACE_STR(ex_opcode_2A_2T_1R,
190                                 acpi_ps_get_opcode_name(walk_state->opcode));
191
192         /* Execute the opcode */
193
194         switch (walk_state->opcode) {
195         case AML_DIVIDE_OP:
196
197                 /* Divide (Dividend, Divisor, remainder_result quotient_result) */
198
199                 return_desc1 =
200                     acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
201                 if (!return_desc1) {
202                         status = AE_NO_MEMORY;
203                         goto cleanup;
204                 }
205
206                 return_desc2 =
207                     acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
208                 if (!return_desc2) {
209                         status = AE_NO_MEMORY;
210                         goto cleanup;
211                 }
212
213                 /* Quotient to return_desc1, remainder to return_desc2 */
214
215                 status = acpi_ut_divide(operand[0]->integer.value,
216                                         operand[1]->integer.value,
217                                         &return_desc1->integer.value,
218                                         &return_desc2->integer.value);
219                 if (ACPI_FAILURE(status)) {
220                         goto cleanup;
221                 }
222                 break;
223
224         default:
225
226                 ACPI_ERROR((AE_INFO, "Unknown AML opcode %X",
227                             walk_state->opcode));
228                 status = AE_AML_BAD_OPCODE;
229                 goto cleanup;
230         }
231
232         /* Store the results to the target reference operands */
233
234         status = acpi_ex_store(return_desc2, operand[2], walk_state);
235         if (ACPI_FAILURE(status)) {
236                 goto cleanup;
237         }
238
239         status = acpi_ex_store(return_desc1, operand[3], walk_state);
240         if (ACPI_FAILURE(status)) {
241                 goto cleanup;
242         }
243
244       cleanup:
245         /*
246          * Since the remainder is not returned indirectly, remove a reference to
247          * it. Only the quotient is returned indirectly.
248          */
249         acpi_ut_remove_reference(return_desc2);
250
251         if (ACPI_FAILURE(status)) {
252
253                 /* Delete the return object */
254
255                 acpi_ut_remove_reference(return_desc1);
256         }
257
258         /* Save return object (the remainder) on success */
259
260         else {
261                 walk_state->result_obj = return_desc1;
262         }
263
264         return_ACPI_STATUS(status);
265 }
266
267 /*******************************************************************************
268  *
269  * FUNCTION:    acpi_ex_opcode_2A_1T_1R
270  *
271  * PARAMETERS:  walk_state          - Current walk state
272  *
273  * RETURN:      Status
274  *
275  * DESCRIPTION: Execute opcode with two arguments, one target, and a return
276  *              value.
277  *
278  ******************************************************************************/
279
280 acpi_status acpi_ex_opcode_2A_1T_1R(struct acpi_walk_state *walk_state)
281 {
282         union acpi_operand_object **operand = &walk_state->operands[0];
283         union acpi_operand_object *return_desc = NULL;
284         acpi_integer index;
285         acpi_status status = AE_OK;
286         acpi_size length;
287
288         ACPI_FUNCTION_TRACE_STR(ex_opcode_2A_1T_1R,
289                                 acpi_ps_get_opcode_name(walk_state->opcode));
290
291         /* Execute the opcode */
292
293         if (walk_state->op_info->flags & AML_MATH) {
294
295                 /* All simple math opcodes (add, etc.) */
296
297                 return_desc = acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
298                 if (!return_desc) {
299                         status = AE_NO_MEMORY;
300                         goto cleanup;
301                 }
302
303                 return_desc->integer.value =
304                     acpi_ex_do_math_op(walk_state->opcode,
305                                        operand[0]->integer.value,
306                                        operand[1]->integer.value);
307                 goto store_result_to_target;
308         }
309
310         switch (walk_state->opcode) {
311         case AML_MOD_OP:        /* Mod (Dividend, Divisor, remainder_result (ACPI 2.0) */
312
313                 return_desc = acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
314                 if (!return_desc) {
315                         status = AE_NO_MEMORY;
316                         goto cleanup;
317                 }
318
319                 /* return_desc will contain the remainder */
320
321                 status = acpi_ut_divide(operand[0]->integer.value,
322                                         operand[1]->integer.value,
323                                         NULL, &return_desc->integer.value);
324                 break;
325
326         case AML_CONCAT_OP:     /* Concatenate (Data1, Data2, Result) */
327
328                 status = acpi_ex_do_concatenate(operand[0], operand[1],
329                                                 &return_desc, walk_state);
330                 break;
331
332         case AML_TO_STRING_OP:  /* to_string (Buffer, Length, Result) (ACPI 2.0) */
333
334                 /*
335                  * Input object is guaranteed to be a buffer at this point (it may have
336                  * been converted.)  Copy the raw buffer data to a new object of
337                  * type String.
338                  */
339
340                 /*
341                  * Get the length of the new string. It is the smallest of:
342                  * 1) Length of the input buffer
343                  * 2) Max length as specified in the to_string operator
344                  * 3) Length of input buffer up to a zero byte (null terminator)
345                  *
346                  * NOTE: A length of zero is ok, and will create a zero-length, null
347                  *       terminated string.
348                  */
349                 length = 0;
350                 while ((length < operand[0]->buffer.length) &&
351                        (length < operand[1]->integer.value) &&
352                        (operand[0]->buffer.pointer[length])) {
353                         length++;
354                 }
355
356                 /* Allocate a new string object */
357
358                 return_desc = acpi_ut_create_string_object(length);
359                 if (!return_desc) {
360                         status = AE_NO_MEMORY;
361                         goto cleanup;
362                 }
363
364                 /*
365                  * Copy the raw buffer data with no transform.
366                  * (NULL terminated already)
367                  */
368                 ACPI_MEMCPY(return_desc->string.pointer,
369                             operand[0]->buffer.pointer, length);
370                 break;
371
372         case AML_CONCAT_RES_OP:
373
374                 /* concatenate_res_template (Buffer, Buffer, Result) (ACPI 2.0) */
375
376                 status = acpi_ex_concat_template(operand[0], operand[1],
377                                                  &return_desc, walk_state);
378                 break;
379
380         case AML_INDEX_OP:      /* Index (Source Index Result) */
381
382                 /* Create the internal return object */
383
384                 return_desc =
385                     acpi_ut_create_internal_object(ACPI_TYPE_LOCAL_REFERENCE);
386                 if (!return_desc) {
387                         status = AE_NO_MEMORY;
388                         goto cleanup;
389                 }
390
391                 /* Initialize the Index reference object */
392
393                 index = operand[1]->integer.value;
394                 return_desc->reference.offset = (u32) index;
395                 return_desc->reference.opcode = AML_INDEX_OP;
396
397                 /*
398                  * At this point, the Source operand is a String, Buffer, or Package.
399                  * Verify that the index is within range.
400                  */
401                 switch (ACPI_GET_OBJECT_TYPE(operand[0])) {
402                 case ACPI_TYPE_STRING:
403
404                         if (index >= operand[0]->string.length) {
405                                 status = AE_AML_STRING_LIMIT;
406                         }
407
408                         return_desc->reference.target_type =
409                             ACPI_TYPE_BUFFER_FIELD;
410                         break;
411
412                 case ACPI_TYPE_BUFFER:
413
414                         if (index >= operand[0]->buffer.length) {
415                                 status = AE_AML_BUFFER_LIMIT;
416                         }
417
418                         return_desc->reference.target_type =
419                             ACPI_TYPE_BUFFER_FIELD;
420                         break;
421
422                 case ACPI_TYPE_PACKAGE:
423
424                         if (index >= operand[0]->package.count) {
425                                 status = AE_AML_PACKAGE_LIMIT;
426                         }
427
428                         return_desc->reference.target_type = ACPI_TYPE_PACKAGE;
429                         return_desc->reference.where =
430                             &operand[0]->package.elements[index];
431                         break;
432
433                 default:
434
435                         status = AE_AML_INTERNAL;
436                         goto cleanup;
437                 }
438
439                 /* Failure means that the Index was beyond the end of the object */
440
441                 if (ACPI_FAILURE(status)) {
442                         ACPI_EXCEPTION((AE_INFO, status,
443                                         "Index (%X%8.8X) is beyond end of object",
444                                         ACPI_FORMAT_UINT64(index)));
445                         goto cleanup;
446                 }
447
448                 /*
449                  * Save the target object and add a reference to it for the life
450                  * of the index
451                  */
452                 return_desc->reference.object = operand[0];
453                 acpi_ut_add_reference(operand[0]);
454
455                 /* Store the reference to the Target */
456
457                 status = acpi_ex_store(return_desc, operand[2], walk_state);
458
459                 /* Return the reference */
460
461                 walk_state->result_obj = return_desc;
462                 goto cleanup;
463
464         default:
465
466                 ACPI_ERROR((AE_INFO, "Unknown AML opcode %X",
467                             walk_state->opcode));
468                 status = AE_AML_BAD_OPCODE;
469                 break;
470         }
471
472       store_result_to_target:
473
474         if (ACPI_SUCCESS(status)) {
475                 /*
476                  * Store the result of the operation (which is now in return_desc) into
477                  * the Target descriptor.
478                  */
479                 status = acpi_ex_store(return_desc, operand[2], walk_state);
480                 if (ACPI_FAILURE(status)) {
481                         goto cleanup;
482                 }
483
484                 if (!walk_state->result_obj) {
485                         walk_state->result_obj = return_desc;
486                 }
487         }
488
489       cleanup:
490
491         /* Delete return object on error */
492
493         if (ACPI_FAILURE(status)) {
494                 acpi_ut_remove_reference(return_desc);
495                 walk_state->result_obj = NULL;
496         }
497
498         return_ACPI_STATUS(status);
499 }
500
501 /*******************************************************************************
502  *
503  * FUNCTION:    acpi_ex_opcode_2A_0T_1R
504  *
505  * PARAMETERS:  walk_state          - Current walk state
506  *
507  * RETURN:      Status
508  *
509  * DESCRIPTION: Execute opcode with 2 arguments, no target, and a return value
510  *
511  ******************************************************************************/
512
513 acpi_status acpi_ex_opcode_2A_0T_1R(struct acpi_walk_state *walk_state)
514 {
515         union acpi_operand_object **operand = &walk_state->operands[0];
516         union acpi_operand_object *return_desc = NULL;
517         acpi_status status = AE_OK;
518         u8 logical_result = FALSE;
519
520         ACPI_FUNCTION_TRACE_STR(ex_opcode_2A_0T_1R,
521                                 acpi_ps_get_opcode_name(walk_state->opcode));
522
523         /* Create the internal return object */
524
525         return_desc = acpi_ut_create_internal_object(ACPI_TYPE_INTEGER);
526         if (!return_desc) {
527                 status = AE_NO_MEMORY;
528                 goto cleanup;
529         }
530
531         /* Execute the Opcode */
532
533         if (walk_state->op_info->flags & AML_LOGICAL_NUMERIC) {
534
535                 /* logical_op (Operand0, Operand1) */
536
537                 status = acpi_ex_do_logical_numeric_op(walk_state->opcode,
538                                                        operand[0]->integer.
539                                                        value,
540                                                        operand[1]->integer.
541                                                        value, &logical_result);
542                 goto store_logical_result;
543         } else if (walk_state->op_info->flags & AML_LOGICAL) {
544
545                 /* logical_op (Operand0, Operand1) */
546
547                 status = acpi_ex_do_logical_op(walk_state->opcode, operand[0],
548                                                operand[1], &logical_result);
549                 goto store_logical_result;
550         }
551
552         switch (walk_state->opcode) {
553         case AML_ACQUIRE_OP:    /* Acquire (mutex_object, Timeout) */
554
555                 status =
556                     acpi_ex_acquire_mutex(operand[1], operand[0], walk_state);
557                 if (status == AE_TIME) {
558                         logical_result = TRUE;  /* TRUE = Acquire timed out */
559                         status = AE_OK;
560                 }
561                 break;
562
563         case AML_WAIT_OP:       /* Wait (event_object, Timeout) */
564
565                 status = acpi_ex_system_wait_event(operand[1], operand[0]);
566                 if (status == AE_TIME) {
567                         logical_result = TRUE;  /* TRUE, Wait timed out */
568                         status = AE_OK;
569                 }
570                 break;
571
572         default:
573
574                 ACPI_ERROR((AE_INFO, "Unknown AML opcode %X",
575                             walk_state->opcode));
576                 status = AE_AML_BAD_OPCODE;
577                 goto cleanup;
578         }
579
580       store_logical_result:
581         /*
582          * Set return value to according to logical_result. logical TRUE (all ones)
583          * Default is FALSE (zero)
584          */
585         if (logical_result) {
586                 return_desc->integer.value = ACPI_INTEGER_MAX;
587         }
588
589       cleanup:
590
591         /* Delete return object on error */
592
593         if (ACPI_FAILURE(status)) {
594                 acpi_ut_remove_reference(return_desc);
595         }
596
597         /* Save return object on success */
598
599         else {
600                 walk_state->result_obj = return_desc;
601         }
602
603         return_ACPI_STATUS(status);
604 }