acpi_util.c revision 1.4.2.2 1 1.4.2.2 uebayasi /* $NetBSD: acpi_util.c,v 1.4.2.2 2010/04/30 14:43:06 uebayasi Exp $ */
2 1.4.2.2 uebayasi
3 1.4.2.2 uebayasi /*-
4 1.4.2.2 uebayasi * Copyright (c) 2003, 2007 The NetBSD Foundation, Inc.
5 1.4.2.2 uebayasi * All rights reserved.
6 1.4.2.2 uebayasi *
7 1.4.2.2 uebayasi * This code is derived from software contributed to The NetBSD Foundation
8 1.4.2.2 uebayasi * by Charles M. Hannum of By Noon Software, Inc.
9 1.4.2.2 uebayasi *
10 1.4.2.2 uebayasi * Redistribution and use in source and binary forms, with or without
11 1.4.2.2 uebayasi * modification, are permitted provided that the following conditions
12 1.4.2.2 uebayasi * are met:
13 1.4.2.2 uebayasi * 1. Redistributions of source code must retain the above copyright
14 1.4.2.2 uebayasi * notice, this list of conditions and the following disclaimer.
15 1.4.2.2 uebayasi * 2. Redistributions in binary form must reproduce the above copyright
16 1.4.2.2 uebayasi * notice, this list of conditions and the following disclaimer in the
17 1.4.2.2 uebayasi * documentation and/or other materials provided with the distribution.
18 1.4.2.2 uebayasi *
19 1.4.2.2 uebayasi * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.4.2.2 uebayasi * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.4.2.2 uebayasi * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.4.2.2 uebayasi * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.4.2.2 uebayasi * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.4.2.2 uebayasi * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.4.2.2 uebayasi * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.4.2.2 uebayasi * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.4.2.2 uebayasi * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.4.2.2 uebayasi * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.4.2.2 uebayasi * POSSIBILITY OF SUCH DAMAGE.
30 1.4.2.2 uebayasi */
31 1.4.2.2 uebayasi
32 1.4.2.2 uebayasi /*
33 1.4.2.2 uebayasi * Copyright 2001, 2003 Wasabi Systems, Inc.
34 1.4.2.2 uebayasi * All rights reserved.
35 1.4.2.2 uebayasi *
36 1.4.2.2 uebayasi * Written by Jason R. Thorpe for Wasabi Systems, Inc.
37 1.4.2.2 uebayasi *
38 1.4.2.2 uebayasi * Redistribution and use in source and binary forms, with or without
39 1.4.2.2 uebayasi * modification, are permitted provided that the following conditions
40 1.4.2.2 uebayasi * are met:
41 1.4.2.2 uebayasi * 1. Redistributions of source code must retain the above copyright
42 1.4.2.2 uebayasi * notice, this list of conditions and the following disclaimer.
43 1.4.2.2 uebayasi * 2. Redistributions in binary form must reproduce the above copyright
44 1.4.2.2 uebayasi * notice, this list of conditions and the following disclaimer in the
45 1.4.2.2 uebayasi * documentation and/or other materials provided with the distribution.
46 1.4.2.2 uebayasi * 3. All advertising materials mentioning features or use of this software
47 1.4.2.2 uebayasi * must display the following acknowledgement:
48 1.4.2.2 uebayasi * This product includes software developed for the NetBSD Project by
49 1.4.2.2 uebayasi * Wasabi Systems, Inc.
50 1.4.2.2 uebayasi * 4. The name of Wasabi Systems, Inc. may not be used to endorse
51 1.4.2.2 uebayasi * or promote products derived from this software without specific prior
52 1.4.2.2 uebayasi * written permission.
53 1.4.2.2 uebayasi *
54 1.4.2.2 uebayasi * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
55 1.4.2.2 uebayasi * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
56 1.4.2.2 uebayasi * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
57 1.4.2.2 uebayasi * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC
58 1.4.2.2 uebayasi * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
59 1.4.2.2 uebayasi * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
60 1.4.2.2 uebayasi * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
61 1.4.2.2 uebayasi * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
62 1.4.2.2 uebayasi * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
63 1.4.2.2 uebayasi * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
64 1.4.2.2 uebayasi * POSSIBILITY OF SUCH DAMAGE.
65 1.4.2.2 uebayasi */
66 1.4.2.2 uebayasi
67 1.4.2.2 uebayasi #include <sys/cdefs.h>
68 1.4.2.2 uebayasi __KERNEL_RCSID(0, "$NetBSD: acpi_util.c,v 1.4.2.2 2010/04/30 14:43:06 uebayasi Exp $");
69 1.4.2.2 uebayasi
70 1.4.2.2 uebayasi #include <sys/param.h>
71 1.4.2.2 uebayasi
72 1.4.2.2 uebayasi #include <dev/acpi/acpireg.h>
73 1.4.2.2 uebayasi #include <dev/acpi/acpivar.h>
74 1.4.2.2 uebayasi
75 1.4.2.2 uebayasi #define _COMPONENT ACPI_BUS_COMPONENT
76 1.4.2.2 uebayasi ACPI_MODULE_NAME ("acpi_util")
77 1.4.2.2 uebayasi
78 1.4.2.2 uebayasi /*
79 1.4.2.2 uebayasi * Evaluate an integer object.
80 1.4.2.2 uebayasi */
81 1.4.2.2 uebayasi ACPI_STATUS
82 1.4.2.2 uebayasi acpi_eval_integer(ACPI_HANDLE handle, const char *path, ACPI_INTEGER *valp)
83 1.4.2.2 uebayasi {
84 1.4.2.2 uebayasi ACPI_OBJECT obj;
85 1.4.2.2 uebayasi ACPI_BUFFER buf;
86 1.4.2.2 uebayasi ACPI_STATUS rv;
87 1.4.2.2 uebayasi
88 1.4.2.2 uebayasi if (handle == NULL)
89 1.4.2.2 uebayasi handle = ACPI_ROOT_OBJECT;
90 1.4.2.2 uebayasi
91 1.4.2.2 uebayasi buf.Pointer = &obj;
92 1.4.2.2 uebayasi buf.Length = sizeof(obj);
93 1.4.2.2 uebayasi
94 1.4.2.2 uebayasi rv = AcpiEvaluateObject(handle, path, NULL, &buf);
95 1.4.2.2 uebayasi
96 1.4.2.2 uebayasi if (ACPI_FAILURE(rv))
97 1.4.2.2 uebayasi return rv;
98 1.4.2.2 uebayasi
99 1.4.2.2 uebayasi if (obj.Type != ACPI_TYPE_INTEGER)
100 1.4.2.2 uebayasi return AE_TYPE;
101 1.4.2.2 uebayasi
102 1.4.2.2 uebayasi if (valp != NULL)
103 1.4.2.2 uebayasi *valp = obj.Integer.Value;
104 1.4.2.2 uebayasi
105 1.4.2.2 uebayasi return AE_OK;
106 1.4.2.2 uebayasi }
107 1.4.2.2 uebayasi
108 1.4.2.2 uebayasi /*
109 1.4.2.2 uebayasi * Evaluate an integer object with a single integer input parameter.
110 1.4.2.2 uebayasi */
111 1.4.2.2 uebayasi ACPI_STATUS
112 1.4.2.2 uebayasi acpi_eval_set_integer(ACPI_HANDLE handle, const char *path, ACPI_INTEGER val)
113 1.4.2.2 uebayasi {
114 1.4.2.2 uebayasi ACPI_OBJECT_LIST arg;
115 1.4.2.2 uebayasi ACPI_OBJECT obj;
116 1.4.2.2 uebayasi
117 1.4.2.2 uebayasi if (handle == NULL)
118 1.4.2.2 uebayasi handle = ACPI_ROOT_OBJECT;
119 1.4.2.2 uebayasi
120 1.4.2.2 uebayasi obj.Type = ACPI_TYPE_INTEGER;
121 1.4.2.2 uebayasi obj.Integer.Value = val;
122 1.4.2.2 uebayasi
123 1.4.2.2 uebayasi arg.Count = 1;
124 1.4.2.2 uebayasi arg.Pointer = &obj;
125 1.4.2.2 uebayasi
126 1.4.2.2 uebayasi return AcpiEvaluateObject(handle, path, &arg, NULL);
127 1.4.2.2 uebayasi }
128 1.4.2.2 uebayasi
129 1.4.2.2 uebayasi /*
130 1.4.2.2 uebayasi * Evaluate a (Unicode) string object.
131 1.4.2.2 uebayasi */
132 1.4.2.2 uebayasi ACPI_STATUS
133 1.4.2.2 uebayasi acpi_eval_string(ACPI_HANDLE handle, const char *path, char **stringp)
134 1.4.2.2 uebayasi {
135 1.4.2.2 uebayasi ACPI_OBJECT *obj;
136 1.4.2.2 uebayasi ACPI_BUFFER buf;
137 1.4.2.2 uebayasi ACPI_STATUS rv;
138 1.4.2.2 uebayasi
139 1.4.2.2 uebayasi rv = acpi_eval_struct(handle, path, &buf);
140 1.4.2.2 uebayasi
141 1.4.2.2 uebayasi if (ACPI_FAILURE(rv))
142 1.4.2.2 uebayasi return rv;
143 1.4.2.2 uebayasi
144 1.4.2.2 uebayasi obj = buf.Pointer;
145 1.4.2.2 uebayasi
146 1.4.2.2 uebayasi if (obj->Type != ACPI_TYPE_STRING) {
147 1.4.2.2 uebayasi rv = AE_TYPE;
148 1.4.2.2 uebayasi goto out;
149 1.4.2.2 uebayasi }
150 1.4.2.2 uebayasi
151 1.4.2.2 uebayasi if (obj->String.Length == 0) {
152 1.4.2.2 uebayasi rv = AE_BAD_DATA;
153 1.4.2.2 uebayasi goto out;
154 1.4.2.2 uebayasi }
155 1.4.2.2 uebayasi
156 1.4.2.2 uebayasi *stringp = ACPI_ALLOCATE(obj->String.Length + 1);
157 1.4.2.2 uebayasi
158 1.4.2.2 uebayasi if (*stringp == NULL) {
159 1.4.2.2 uebayasi rv = AE_NO_MEMORY;
160 1.4.2.2 uebayasi goto out;
161 1.4.2.2 uebayasi }
162 1.4.2.2 uebayasi
163 1.4.2.2 uebayasi (void)memcpy(*stringp, obj->String.Pointer, obj->String.Length);
164 1.4.2.2 uebayasi
165 1.4.2.2 uebayasi (*stringp)[obj->String.Length] = '\0';
166 1.4.2.2 uebayasi
167 1.4.2.2 uebayasi out:
168 1.4.2.2 uebayasi ACPI_FREE(buf.Pointer);
169 1.4.2.2 uebayasi
170 1.4.2.2 uebayasi return rv;
171 1.4.2.2 uebayasi }
172 1.4.2.2 uebayasi
173 1.4.2.2 uebayasi /*
174 1.4.2.2 uebayasi * Evaluate a structure. Caller must free buf.Pointer by ACPI_FREE().
175 1.4.2.2 uebayasi */
176 1.4.2.2 uebayasi ACPI_STATUS
177 1.4.2.2 uebayasi acpi_eval_struct(ACPI_HANDLE handle, const char *path, ACPI_BUFFER *buf)
178 1.4.2.2 uebayasi {
179 1.4.2.2 uebayasi
180 1.4.2.2 uebayasi if (handle == NULL)
181 1.4.2.2 uebayasi handle = ACPI_ROOT_OBJECT;
182 1.4.2.2 uebayasi
183 1.4.2.2 uebayasi buf->Pointer = NULL;
184 1.4.2.2 uebayasi buf->Length = ACPI_ALLOCATE_LOCAL_BUFFER;
185 1.4.2.2 uebayasi
186 1.4.2.2 uebayasi return AcpiEvaluateObject(handle, path, NULL, buf);
187 1.4.2.2 uebayasi }
188 1.4.2.2 uebayasi
189 1.4.2.2 uebayasi /*
190 1.4.2.2 uebayasi * Evaluate a reference handle from an element in a package.
191 1.4.2.2 uebayasi */
192 1.4.2.2 uebayasi ACPI_STATUS
193 1.4.2.2 uebayasi acpi_eval_reference_handle(ACPI_OBJECT *elm, ACPI_HANDLE *handle)
194 1.4.2.2 uebayasi {
195 1.4.2.2 uebayasi
196 1.4.2.2 uebayasi if (elm == NULL || handle == NULL)
197 1.4.2.2 uebayasi return AE_BAD_PARAMETER;
198 1.4.2.2 uebayasi
199 1.4.2.2 uebayasi switch (elm->Type) {
200 1.4.2.2 uebayasi
201 1.4.2.2 uebayasi case ACPI_TYPE_ANY:
202 1.4.2.2 uebayasi case ACPI_TYPE_LOCAL_REFERENCE:
203 1.4.2.2 uebayasi
204 1.4.2.2 uebayasi if (elm->Reference.Handle == NULL)
205 1.4.2.2 uebayasi return AE_NULL_ENTRY;
206 1.4.2.2 uebayasi
207 1.4.2.2 uebayasi *handle = elm->Reference.Handle;
208 1.4.2.2 uebayasi
209 1.4.2.2 uebayasi return AE_OK;
210 1.4.2.2 uebayasi
211 1.4.2.2 uebayasi case ACPI_TYPE_STRING:
212 1.4.2.2 uebayasi return AcpiGetHandle(NULL, elm->String.Pointer, handle);
213 1.4.2.2 uebayasi
214 1.4.2.2 uebayasi default:
215 1.4.2.2 uebayasi return AE_TYPE;
216 1.4.2.2 uebayasi }
217 1.4.2.2 uebayasi }
218 1.4.2.2 uebayasi
219 1.4.2.2 uebayasi /*
220 1.4.2.2 uebayasi * Iterate over all objects in a package, and pass them all
221 1.4.2.2 uebayasi * to a function. If the called function returns non-AE_OK,
222 1.4.2.2 uebayasi * the iteration is stopped and that value is returned.
223 1.4.2.2 uebayasi */
224 1.4.2.2 uebayasi ACPI_STATUS
225 1.4.2.2 uebayasi acpi_foreach_package_object(ACPI_OBJECT *pkg,
226 1.4.2.2 uebayasi ACPI_STATUS (*func)(ACPI_OBJECT *, void *), void *arg)
227 1.4.2.2 uebayasi {
228 1.4.2.2 uebayasi ACPI_STATUS rv = AE_OK;
229 1.4.2.2 uebayasi uint32_t i;
230 1.4.2.2 uebayasi
231 1.4.2.2 uebayasi if (pkg == NULL)
232 1.4.2.2 uebayasi return AE_BAD_PARAMETER;
233 1.4.2.2 uebayasi
234 1.4.2.2 uebayasi if (pkg->Type != ACPI_TYPE_PACKAGE)
235 1.4.2.2 uebayasi return AE_TYPE;
236 1.4.2.2 uebayasi
237 1.4.2.2 uebayasi for (i = 0; i < pkg->Package.Count; i++) {
238 1.4.2.2 uebayasi
239 1.4.2.2 uebayasi rv = (*func)(&pkg->Package.Elements[i], arg);
240 1.4.2.2 uebayasi
241 1.4.2.2 uebayasi if (ACPI_FAILURE(rv))
242 1.4.2.2 uebayasi break;
243 1.4.2.2 uebayasi }
244 1.4.2.2 uebayasi
245 1.4.2.2 uebayasi return rv;
246 1.4.2.2 uebayasi }
247 1.4.2.2 uebayasi
248 1.4.2.2 uebayasi /*
249 1.4.2.2 uebayasi * Fetch data info the specified (empty) ACPI buffer.
250 1.4.2.2 uebayasi * Caller must free buf.Pointer by ACPI_FREE().
251 1.4.2.2 uebayasi */
252 1.4.2.2 uebayasi ACPI_STATUS
253 1.4.2.2 uebayasi acpi_get(ACPI_HANDLE handle, ACPI_BUFFER *buf,
254 1.4.2.2 uebayasi ACPI_STATUS (*getit)(ACPI_HANDLE, ACPI_BUFFER *))
255 1.4.2.2 uebayasi {
256 1.4.2.2 uebayasi
257 1.4.2.2 uebayasi buf->Pointer = NULL;
258 1.4.2.2 uebayasi buf->Length = ACPI_ALLOCATE_LOCAL_BUFFER;
259 1.4.2.2 uebayasi
260 1.4.2.2 uebayasi return (*getit)(handle, buf);
261 1.4.2.2 uebayasi }
262 1.4.2.2 uebayasi
263 1.4.2.2 uebayasi /*
264 1.4.2.2 uebayasi * Get a device node from a handle.
265 1.4.2.2 uebayasi */
266 1.4.2.2 uebayasi struct acpi_devnode *
267 1.4.2.2 uebayasi acpi_get_node(ACPI_HANDLE handle)
268 1.4.2.2 uebayasi {
269 1.4.2.2 uebayasi struct acpi_softc *sc = acpi_softc; /* XXX. */
270 1.4.2.2 uebayasi struct acpi_devnode *ad;
271 1.4.2.2 uebayasi
272 1.4.2.2 uebayasi if (sc == NULL || handle == NULL)
273 1.4.2.2 uebayasi return NULL;
274 1.4.2.2 uebayasi
275 1.4.2.2 uebayasi SIMPLEQ_FOREACH(ad, &sc->ad_head, ad_list) {
276 1.4.2.2 uebayasi
277 1.4.2.2 uebayasi if (ad->ad_handle == handle)
278 1.4.2.2 uebayasi return ad;
279 1.4.2.2 uebayasi }
280 1.4.2.2 uebayasi
281 1.4.2.2 uebayasi aprint_debug_dev(sc->sc_dev, "%s: failed to "
282 1.4.2.2 uebayasi "find node %s\n", __func__, acpi_name(handle));
283 1.4.2.2 uebayasi
284 1.4.2.2 uebayasi return NULL;
285 1.4.2.2 uebayasi }
286 1.4.2.2 uebayasi
287 1.4.2.2 uebayasi /*
288 1.4.2.2 uebayasi * Return a complete pathname from a handle.
289 1.4.2.2 uebayasi *
290 1.4.2.2 uebayasi * Note that the function uses static data storage;
291 1.4.2.2 uebayasi * if the data is needed for future use, it should be
292 1.4.2.2 uebayasi * copied before any subsequent calls overwrite it.
293 1.4.2.2 uebayasi */
294 1.4.2.2 uebayasi const char *
295 1.4.2.2 uebayasi acpi_name(ACPI_HANDLE handle)
296 1.4.2.2 uebayasi {
297 1.4.2.2 uebayasi static char name[80];
298 1.4.2.2 uebayasi ACPI_BUFFER buf;
299 1.4.2.2 uebayasi ACPI_STATUS rv;
300 1.4.2.2 uebayasi
301 1.4.2.2 uebayasi if (handle == NULL)
302 1.4.2.2 uebayasi handle = ACPI_ROOT_OBJECT;
303 1.4.2.2 uebayasi
304 1.4.2.2 uebayasi buf.Pointer = name;
305 1.4.2.2 uebayasi buf.Length = sizeof(name);
306 1.4.2.2 uebayasi
307 1.4.2.2 uebayasi rv = AcpiGetName(handle, ACPI_FULL_PATHNAME, &buf);
308 1.4.2.2 uebayasi
309 1.4.2.2 uebayasi if (ACPI_FAILURE(rv))
310 1.4.2.2 uebayasi return "UNKNOWN";
311 1.4.2.2 uebayasi
312 1.4.2.2 uebayasi return name;
313 1.4.2.2 uebayasi }
314 1.4.2.2 uebayasi
315 1.4.2.2 uebayasi /*
316 1.4.2.2 uebayasi * Match given IDs against _HID and _CIDs.
317 1.4.2.2 uebayasi */
318 1.4.2.2 uebayasi int
319 1.4.2.2 uebayasi acpi_match_hid(ACPI_DEVICE_INFO *ad, const char * const *ids)
320 1.4.2.2 uebayasi {
321 1.4.2.2 uebayasi uint32_t i, n;
322 1.4.2.2 uebayasi char *id;
323 1.4.2.2 uebayasi
324 1.4.2.2 uebayasi while (*ids) {
325 1.4.2.2 uebayasi
326 1.4.2.2 uebayasi if ((ad->Valid & ACPI_VALID_HID) != 0) {
327 1.4.2.2 uebayasi
328 1.4.2.2 uebayasi if (pmatch(ad->HardwareId.String, *ids, NULL) == 2)
329 1.4.2.2 uebayasi return 1;
330 1.4.2.2 uebayasi }
331 1.4.2.2 uebayasi
332 1.4.2.2 uebayasi if ((ad->Valid & ACPI_VALID_CID) != 0) {
333 1.4.2.2 uebayasi
334 1.4.2.2 uebayasi n = ad->CompatibleIdList.Count;
335 1.4.2.2 uebayasi
336 1.4.2.2 uebayasi for (i = 0; i < n; i++) {
337 1.4.2.2 uebayasi
338 1.4.2.2 uebayasi id = ad->CompatibleIdList.Ids[i].String;
339 1.4.2.2 uebayasi
340 1.4.2.2 uebayasi if (pmatch(id, *ids, NULL) == 2)
341 1.4.2.2 uebayasi return 1;
342 1.4.2.2 uebayasi }
343 1.4.2.2 uebayasi }
344 1.4.2.2 uebayasi
345 1.4.2.2 uebayasi ids++;
346 1.4.2.2 uebayasi }
347 1.4.2.2 uebayasi
348 1.4.2.2 uebayasi return 0;
349 1.4.2.2 uebayasi }
350 1.4.2.2 uebayasi
351