xref: /openbsd-src/sys/dev/acpi/acpipwrres.c (revision 3374c67d44f9b75b98444cbf63020f777792342e) 
1 /* $OpenBSD: acpipwrres.c,v 1.12 2022/08/10 16:58:16 patrick Exp $ */
2 
3 /*
4  * Copyright (c) 2013 Martin Pieuchot <mpi@openbsd.org>
5  * Copyright (c) 2009 Paul Irofti <paul@irofti.net>
6  *
7  * Permission to use, copy, modify, and distribute this software for any
8  * purpose with or without fee is hereby granted, provided that the above
9  * copyright notice and this permission notice appear in all copies.
10  *
11  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
12  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
13  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
14  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
15  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
16  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
17  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18  */
19 
20 #include <sys/param.h>
21 #include <sys/signalvar.h>
22 #include <sys/systm.h>
23 #include <sys/device.h>
24 #include <sys/malloc.h>
25 
26 #include <machine/bus.h>
27 
28 #include <dev/acpi/acpireg.h>
29 #include <dev/acpi/acpivar.h>
30 #include <dev/acpi/acpidev.h>
31 #include <dev/acpi/amltypes.h>
32 #include <dev/acpi/dsdt.h>
33 
34 int	acpipwrres_match(struct device *, void *, void *);
35 void	acpipwrres_attach(struct device *, struct device *, void *);
36 
37 #ifdef ACPIPWRRES_DEBUG
38 #define DPRINTF(x)	printf x
39 #else
40 #define DPRINTF(x)
41 #endif
42 
43 struct acpipwrres_softc {
44 	struct device		sc_dev;
45 
46 	bus_space_tag_t		sc_iot;
47 	bus_space_handle_t	sc_ioh;
48 
49 	struct acpi_softc	*sc_acpi;
50 	struct aml_node		*sc_devnode;
51 
52 	SIMPLEQ_HEAD(, acpipwrres_consumer)	sc_cons;
53 	int					sc_cons_ref;
54 
55 	int	sc_level;
56 	int	sc_order;
57 	int	sc_state;
58 #define ACPIPWRRES_OFF		0
59 #define ACPIPWRRES_ON		1
60 #define ACPIPWRRES_UNK		-1
61 };
62 
63 struct acpipwrres_consumer {
64 	struct aml_node				*cs_node;
65 	SIMPLEQ_ENTRY(acpipwrres_consumer)	cs_next;
66 };
67 
68 const struct cfattach acpipwrres_ca = {
69 	sizeof(struct acpipwrres_softc), acpipwrres_match, acpipwrres_attach
70 };
71 
72 struct cfdriver acpipwrres_cd = {
73 	NULL, "acpipwrres", DV_DULL
74 };
75 
76 int	acpipwrres_hascons(struct acpipwrres_softc *, struct aml_node *);
77 int	acpipwrres_addcons(struct acpipwrres_softc *, struct aml_node *);
78 int	acpipwrres_foundcons(struct aml_node *, void *);
79 
80 int
81 acpipwrres_match(struct device *parent, void *match, void *aux)
82 {
83 	struct acpi_attach_args *aaa = aux;
84 	struct cfdata		*cf = match;
85 
86 	if (aaa->aaa_name == NULL || strcmp(aaa->aaa_name,
87 	    cf->cf_driver->cd_name) != 0 || aaa->aaa_table != NULL)
88 		return (0);
89 
90 	return (1);
91 }
92 
93 void
94 acpipwrres_attach(struct device *parent, struct device *self, void *aux)
95 {
96 	struct acpipwrres_softc		*sc = (struct acpipwrres_softc *)self;
97 	struct acpi_attach_args		*aaa = aux;
98 	struct aml_value		res;
99 	struct acpipwrres_consumer	*cons;
100 
101 	sc->sc_acpi = (struct acpi_softc *)parent;
102 	sc->sc_devnode = aaa->aaa_node;
103 	memset(&res, 0, sizeof res);
104 
105 	printf(": %s", sc->sc_devnode->name);
106 
107 	if (!aml_evalname(sc->sc_acpi, sc->sc_devnode, "_STA", 0, NULL, &res)) {
108 		sc->sc_state = (int)aml_val2int(&res);
109 		if (sc->sc_state != ACPIPWRRES_ON &&
110 		    sc->sc_state != ACPIPWRRES_OFF)
111 			sc->sc_state = ACPIPWRRES_UNK;
112 	} else
113 		sc->sc_state = ACPIPWRRES_UNK;
114 	DPRINTF(("\n%s: state = %d\n", DEVNAME(sc), sc->sc_state));
115 	if (aml_evalnode(sc->sc_acpi, aaa->aaa_node, 0, NULL, &res) == 0) {
116 		sc->sc_level = res.v_powerrsrc.pwr_level;
117 		sc->sc_order = res.v_powerrsrc.pwr_order;
118 		DPRINTF(("%s: level = %d, order %d\n", DEVNAME(sc),
119 		    sc->sc_level, sc->sc_order));
120 		aml_freevalue(&res);
121 	}
122 
123 	/* Get the list of consumers */
124 	SIMPLEQ_INIT(&sc->sc_cons);
125 #if notyet
126 	aml_find_node(sc->sc_acpi->sc_root, "_PRW", acpipwrres_foundcons, sc);
127 #endif
128 	aml_find_node(sc->sc_acpi->sc_root, "_PR0", acpipwrres_foundcons, sc);
129 	aml_find_node(sc->sc_acpi->sc_root, "_PR1", acpipwrres_foundcons, sc);
130 	aml_find_node(sc->sc_acpi->sc_root, "_PR2", acpipwrres_foundcons, sc);
131 	aml_find_node(sc->sc_acpi->sc_root, "_PR3", acpipwrres_foundcons, sc);
132 
133 	DPRINTF(("%s", DEVNAME(sc)));
134 	if (!SIMPLEQ_EMPTY(&sc->sc_cons)) {
135 		printf(", resource for");
136 		SIMPLEQ_FOREACH(cons, &sc->sc_cons, cs_next)
137 			printf(" %s%s", cons->cs_node->name,
138 			   (SIMPLEQ_NEXT(cons, cs_next) == NULL) ? "" : ",");
139 	}
140 	printf("\n");
141 }
142 
143 int
144 acpipwrres_ref_incr(struct acpipwrres_softc *sc, struct aml_node *node)
145 {
146 	struct aml_value		res;
147 
148 	if (!acpipwrres_hascons(sc, node))
149 		return (1);
150 
151 	DPRINTF(("%s: dev %s ON %d\n", DEVNAME(sc), node->name,
152 	    sc->sc_cons_ref));
153 
154 	if (sc->sc_cons_ref++ == 0) {
155 		memset(&res, 0, sizeof(res));
156 		aml_evalname(sc->sc_acpi, sc->sc_devnode, "_ON", 0,
157 		    NULL, &res);
158 		aml_freevalue(&res);
159 	}
160 
161 	return (0);
162 }
163 
164 int
165 acpipwrres_ref_decr(struct acpipwrres_softc *sc, struct aml_node *node)
166 {
167 	struct aml_value		res;
168 
169 	if (!acpipwrres_hascons(sc, node))
170 		return (1);
171 
172 	DPRINTF(("%s: dev %s OFF %d\n", DEVNAME(sc), node->name,
173 	    sc->sc_cons_ref));
174 
175 	if (--sc->sc_cons_ref == 0) {
176 		memset(&res, 0, sizeof(res));
177 		aml_evalname(sc->sc_acpi, sc->sc_devnode, "_OFF", 0,
178 		    NULL, &res);
179 		aml_freevalue(&res);
180 	}
181 
182 	return (0);
183 }
184 
185 int
186 acpipwrres_hascons(struct acpipwrres_softc *sc, struct aml_node *node)
187 {
188 	struct acpipwrres_consumer	*cons;
189 
190 	SIMPLEQ_FOREACH(cons, &sc->sc_cons, cs_next) {
191 		if (cons->cs_node == node)
192 			return (1);
193 	}
194 
195 	return (0);
196 }
197 
198 int
199 acpipwrres_addcons(struct acpipwrres_softc *sc, struct aml_node *node)
200 {
201 	struct acpipwrres_consumer	*cons;
202 	struct acpi_pwrres		*pr;
203 	int				state;
204 
205 	/*
206 	 * Add handlers to put the device into Dx states.
207 	 *
208 	 * XXX What about PRW?
209 	 */
210 	if (strcmp(node->name, "_PR0") == 0) {
211 		state = ACPI_STATE_D0;
212 	} else if (strcmp(node->name, "_PR1") == 0) {
213 		state = ACPI_STATE_D1;
214 	} else if (strcmp(node->name, "_PR2") == 0) {
215 		state = ACPI_STATE_D2;
216 	} else if (strcmp(node->name, "_PR3") == 0) {
217 		state = ACPI_STATE_D3;
218 	} else {
219 		return (0);
220 	}
221 
222 	if (!acpipwrres_hascons(sc, node->parent)) {
223 		cons = malloc(sizeof(*cons), M_DEVBUF, M_NOWAIT | M_ZERO);
224 		if (cons == NULL)
225 			return (ENOMEM);
226 
227 		cons->cs_node = node->parent;
228 		SIMPLEQ_INSERT_TAIL(&sc->sc_cons, cons, cs_next);
229 	}
230 
231 	DPRINTF(("%s: resource for %s (D%d) \n", DEVNAME(sc),
232 	    node->parent->name, state));
233 
234 	/*
235 	 * Make sure we attach only once the same Power Resource for a
236 	 * given state.
237 	 */
238 	SIMPLEQ_FOREACH(pr, &sc->sc_acpi->sc_pwrresdevs, p_next) {
239 		if (pr->p_node == node->parent &&
240 		    pr->p_res_state == state &&
241 		    pr->p_res_sc == sc) {
242 			DPRINTF(("error: pr for %s already set\n",
243 			   aml_nodename(pr->p_node)));
244 			return (EINVAL);
245 		}
246 	}
247 
248 	pr = malloc(sizeof(struct acpi_pwrres), M_DEVBUF, M_NOWAIT | M_ZERO);
249 	if (pr == NULL)
250 		return (ENOMEM);
251 
252 	pr->p_node = node->parent;
253 	pr->p_state = -1;
254 	pr->p_res_state = state;
255 	pr->p_res_sc = sc;
256 
257 	SIMPLEQ_INSERT_TAIL(&sc->sc_acpi->sc_pwrresdevs, pr, p_next);
258 
259 	return (0);
260 }
261 
262 int
263 acpipwrres_foundcons(struct aml_node *node, void *arg)
264 {
265 	struct acpipwrres_softc		*sc = (struct acpipwrres_softc *)arg;
266 	struct aml_value		res, *ref;
267 	int				i = 0;
268 
269 	memset(&res, 0, sizeof(res));
270 
271 	if (aml_evalnode(sc->sc_acpi, node, 0, NULL, &res) == -1) {
272 		DPRINTF(("pwr: consumer not found\n"));
273 		return (1);
274 	}
275 
276 	if (res.type != AML_OBJTYPE_PACKAGE) {
277 		DPRINTF(("%s: %s is not a package\n", DEVNAME(sc),
278 		    aml_nodename(node)));
279 		aml_freevalue(&res);
280 		return (1);
281 	}
282 
283 	DPRINTF(("%s: node name %s\n", DEVNAME(sc), aml_nodename(node)));
284 	if (!strcmp(node->name, "_PRW"))
285 		i = 2;          /* _PRW first two values are ints */
286 
287 	for (; i < res.length; i++) {
288 		ref = res.v_package[i];
289 
290 		if (ref->type == AML_OBJTYPE_NAMEREF) {
291 			struct aml_node	*pnode;
292 
293 			pnode = aml_searchrel(sc->sc_acpi->sc_root,
294 			    aml_getname(ref->v_nameref));
295 			if (pnode == NULL) {
296 				DPRINTF(("%s: device %s not found\n",
297 				    DEVNAME(sc), ref->v_string));
298 				continue;
299 			}
300 			ref = pnode->value;
301 		}
302 
303 		if (ref->type == AML_OBJTYPE_OBJREF)
304 			ref = ref->v_objref.ref;
305 
306 		if (ref->type != AML_OBJTYPE_POWERRSRC) {
307 			DPRINTF(("%s: object reference has a wrong type (%d)\n",
308 			    DEVNAME(sc), ref->type));
309 			continue;
310 		}
311 
312 		if (ref->node == sc->sc_devnode)
313 			(void)acpipwrres_addcons(sc, node);
314 	}
315 	aml_freevalue(&res);
316 
317 	return (0);
318 }
319