4123c4477c9927f7565fdffd559fd2083dcb3c9e
[dragonfly.git] / sys / dev / acpica5 / acpi_package.c
1 /*-
2  * Copyright (c) 2003 Nate Lawson
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  *
14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24  * SUCH DAMAGE.
25  * __FBSDID("$FreeBSD: src/sys/dev/acpica/acpi_package.c,v 1.9.8.1 2009/04/15 03:14:26 kensmith Exp $");
26  */
27
28 #include <sys/cdefs.h>
29
30 #include <sys/param.h>
31 #include <sys/kernel.h>
32 #include <sys/bus.h>
33 #include <sys/sbuf.h>
34
35 #include <sys/rman.h>
36
37 #include "acpi.h"
38 #include <dev/acpica5/acpivar.h>
39
40 /*
41  * Package manipulation convenience functions
42  */
43
44 int
45 acpi_PkgInt(ACPI_OBJECT *res, int idx, ACPI_INTEGER *dst)
46 {
47     ACPI_OBJECT         *obj;
48
49     obj = &res->Package.Elements[idx];
50     if (obj == NULL || obj->Type != ACPI_TYPE_INTEGER)
51         return (EINVAL);
52     *dst = obj->Integer.Value;
53
54     return (0);
55 }
56
57 int
58 acpi_PkgInt32(ACPI_OBJECT *res, int idx, uint32_t *dst)
59 {
60     ACPI_INTEGER        tmp;
61     int                 error;
62
63     error = acpi_PkgInt(res, idx, &tmp);
64     if (error == 0)
65         *dst = (uint32_t)tmp;
66
67     return (error);
68 }
69
70 int
71 acpi_PkgStr(ACPI_OBJECT *res, int idx, void *dst, size_t size)
72 {
73     ACPI_OBJECT         *obj;
74     void                *ptr;
75     size_t               length;
76
77     obj = &res->Package.Elements[idx];
78     if (obj == NULL)
79         return (EINVAL);
80     bzero(dst, sizeof(dst));
81
82     switch (obj->Type) {
83     case ACPI_TYPE_STRING:
84         ptr = obj->String.Pointer;
85         length = obj->String.Length;
86         break;
87     case ACPI_TYPE_BUFFER:
88         ptr = obj->Buffer.Pointer;
89         length = obj->Buffer.Length;
90         break;
91     default:
92         return (EINVAL);
93     }
94
95     /* Make sure string will fit, including terminating NUL */
96     if (++length > size)
97         return (E2BIG);
98
99     strlcpy(dst, ptr, length);
100     return (0);
101 }
102
103 int
104 acpi_PkgGas(device_t dev, ACPI_OBJECT *res, int idx, int *type, int *rid,
105     struct resource **dst, u_int flags)
106 {
107     ACPI_GENERIC_ADDRESS gas;
108     ACPI_OBJECT *obj;
109
110     obj = &res->Package.Elements[idx];
111     if (obj == NULL || obj->Type != ACPI_TYPE_BUFFER ||
112         obj->Buffer.Length < sizeof(ACPI_GENERIC_ADDRESS) + 3)
113         return (EINVAL);
114
115     memcpy(&gas, obj->Buffer.Pointer + 3, sizeof(gas));
116
117     return (acpi_bus_alloc_gas(dev, type, rid, &gas, dst, flags));
118 }
119
120 int
121 acpi_PkgRawGas(ACPI_OBJECT *res, int idx, ACPI_GENERIC_ADDRESS *gas)
122 {
123     ACPI_OBJECT         *obj;
124     obj = &res->Package.Elements[idx];
125     if (obj == NULL || obj->Type != ACPI_TYPE_BUFFER ||
126         obj->Buffer.Length < sizeof(ACPI_GENERIC_ADDRESS) + 3)
127         return (EINVAL);
128     memcpy(gas, obj->Buffer.Pointer + 3, sizeof(*gas));
129     return (0);
130 }
131
132 ACPI_HANDLE
133 acpi_GetReference(ACPI_HANDLE scope, ACPI_OBJECT *obj)
134 {
135     ACPI_HANDLE h;
136
137     if (obj == NULL)
138         return (NULL);
139
140     switch (obj->Type) {
141     case ACPI_TYPE_LOCAL_REFERENCE:
142     case ACPI_TYPE_ANY:
143         h = obj->Reference.Handle;
144         break;
145     case ACPI_TYPE_STRING:
146         /*
147          * The String object usually contains a fully-qualified path, so
148          * scope can be NULL.
149          *
150          * XXX This may not always be the case.
151          */
152         if (ACPI_FAILURE(AcpiGetHandle(scope, obj->String.Pointer, &h)))
153             h = NULL;
154         break;
155     default:
156         h = NULL;
157         break;
158     }
159
160     return (h);
161 }