pmu.c revision 1.1 1 1.1 macallan /* $NetBSD: pmu.c,v 1.1 2007/01/17 23:25:45 macallan Exp $ */
2 1.1 macallan
3 1.1 macallan /*-
4 1.1 macallan * Copyright (c) 2006 Michael Lorenz
5 1.1 macallan * All rights reserved.
6 1.1 macallan *
7 1.1 macallan * Redistribution and use in source and binary forms, with or without
8 1.1 macallan * modification, are permitted provided that the following conditions
9 1.1 macallan * are met:
10 1.1 macallan * 1. Redistributions of source code must retain the above copyright
11 1.1 macallan * notice, this list of conditions and the following disclaimer.
12 1.1 macallan * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 macallan * notice, this list of conditions and the following disclaimer in the
14 1.1 macallan * documentation and/or other materials provided with the distribution.
15 1.1 macallan * 3. Neither the name of The NetBSD Foundation nor the names of its
16 1.1 macallan * contributors may be used to endorse or promote products derived
17 1.1 macallan * from this software without specific prior written permission.
18 1.1 macallan *
19 1.1 macallan * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 macallan * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 macallan * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 macallan * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 macallan * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 macallan * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 macallan * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 macallan * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 macallan * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 macallan * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 macallan * POSSIBILITY OF SUCH DAMAGE.
30 1.1 macallan */
31 1.1 macallan
32 1.1 macallan #include <sys/cdefs.h>
33 1.1 macallan __KERNEL_RCSID(0, "$NetBSD: pmu.c,v 1.1 2007/01/17 23:25:45 macallan Exp $");
34 1.1 macallan
35 1.1 macallan #include <sys/param.h>
36 1.1 macallan #include <sys/systm.h>
37 1.1 macallan #include <sys/kernel.h>
38 1.1 macallan #include <sys/device.h>
39 1.1 macallan #include <sys/proc.h>
40 1.1 macallan #include <sys/kthread.h>
41 1.1 macallan
42 1.1 macallan #include <machine/bus.h>
43 1.1 macallan #include <machine/autoconf.h>
44 1.1 macallan #include <dev/clock_subr.h>
45 1.1 macallan #include <dev/i2c/i2cvar.h>
46 1.1 macallan
47 1.1 macallan #include <macppc/dev/viareg.h>
48 1.1 macallan #include <macppc/dev/pmuvar.h>
49 1.1 macallan
50 1.1 macallan #include <dev/ofw/openfirm.h>
51 1.1 macallan #include <dev/adb/adbvar.h>
52 1.1 macallan #include "opt_pmu.h"
53 1.1 macallan #include "nadb.h"
54 1.1 macallan
55 1.1 macallan #ifdef PMU_DEBUG
56 1.1 macallan #define DPRINTF printf
57 1.1 macallan #else
58 1.1 macallan #define DPRINTF while (0) printf
59 1.1 macallan #endif
60 1.1 macallan
61 1.1 macallan #define PMU_NOTREADY 0x1 /* has not been initialized yet */
62 1.1 macallan #define PMU_IDLE 0x2 /* the bus is currently idle */
63 1.1 macallan #define PMU_OUT 0x3 /* sending out a command */
64 1.1 macallan #define PMU_IN 0x4 /* receiving data */
65 1.1 macallan
66 1.1 macallan static void pmu_attach(struct device *, struct device *, void *);
67 1.1 macallan static int pmu_match(struct device *, struct cfdata *, void *);
68 1.1 macallan static void pmu_autopoll(void *, int);
69 1.1 macallan
70 1.1 macallan static int pmu_intr(void *);
71 1.1 macallan
72 1.1 macallan struct pmu_softc {
73 1.1 macallan struct device sc_dev;
74 1.1 macallan void *sc_ih;
75 1.1 macallan struct todr_chip_handle sc_todr;
76 1.1 macallan struct adb_bus_accessops sc_adbops;
77 1.1 macallan struct i2c_controller sc_i2c;
78 1.1 macallan struct lock sc_buslock;
79 1.1 macallan bus_space_tag_t sc_memt;
80 1.1 macallan bus_space_handle_t sc_memh;
81 1.1 macallan uint32_t sc_flags;
82 1.1 macallan #define PMU_HAS_BACKLIGHT_CONTROL 1
83 1.1 macallan int sc_node;
84 1.1 macallan int sc_iic_done;
85 1.1 macallan int sc_error;
86 1.1 macallan int sc_autopoll;
87 1.1 macallan int sc_pending_eject;
88 1.1 macallan int sc_brightness, sc_brightness_wanted;
89 1.1 macallan int sc_volume, sc_volume_wanted;
90 1.1 macallan /* deferred processing */
91 1.1 macallan struct proc *sc_thread;
92 1.1 macallan /* signalling the event thread */
93 1.1 macallan int sc_event;
94 1.1 macallan /* ADB */
95 1.1 macallan void (*sc_adb_handler)(void *, int, uint8_t *);
96 1.1 macallan void *sc_adb_cookie;
97 1.1 macallan };
98 1.1 macallan
99 1.1 macallan CFATTACH_DECL(pmu, sizeof(struct pmu_softc),
100 1.1 macallan pmu_match, pmu_attach, NULL, NULL);
101 1.1 macallan
102 1.1 macallan static inline void pmu_write_reg(struct pmu_softc *, int, uint8_t);
103 1.1 macallan static inline uint8_t pmu_read_reg(struct pmu_softc *, int);
104 1.1 macallan static void pmu_in(struct pmu_softc *);
105 1.1 macallan static void pmu_out(struct pmu_softc *);
106 1.1 macallan static void pmu_ack_off(struct pmu_softc *);
107 1.1 macallan static void pmu_ack_on(struct pmu_softc *);
108 1.1 macallan static int pmu_intr_state(struct pmu_softc *);
109 1.1 macallan
110 1.1 macallan static void pmu_init(struct pmu_softc *);
111 1.1 macallan static void pmu_create_thread(void *);
112 1.1 macallan static void pmu_thread(void *);
113 1.1 macallan static void pmu_eject_card(struct pmu_softc *, int);
114 1.1 macallan static void pmu_update_brightness(struct pmu_softc *);
115 1.1 macallan
116 1.1 macallan /*
117 1.1 macallan * send a message to Cuda.
118 1.1 macallan */
119 1.1 macallan /* cookie, flags, length, data */
120 1.1 macallan static int pmu_send(struct pmu_softc *, int, int, uint8_t *, uint8_t *);
121 1.1 macallan #if notyet
122 1.1 macallan static void pmu_poll(void *);
123 1.1 macallan #endif
124 1.1 macallan static void pmu_adb_poll(void *);
125 1.1 macallan #if notyet
126 1.1 macallan static int pmu_error_handler(void *, int, uint8_t *);
127 1.1 macallan
128 1.1 macallan static int pmu_todr_handler(void *, int, uint8_t *);
129 1.1 macallan #endif
130 1.1 macallan static int pmu_todr_set(todr_chip_handle_t, volatile struct timeval *);
131 1.1 macallan static int pmu_todr_get(todr_chip_handle_t, volatile struct timeval *);
132 1.1 macallan
133 1.1 macallan static int pmu_adb_handler(void *, int, uint8_t *);
134 1.1 macallan static void pmu_final(struct device *);
135 1.1 macallan
136 1.1 macallan static struct pmu_softc *pmu0 = NULL;
137 1.1 macallan
138 1.1 macallan /* ADB bus attachment stuff */
139 1.1 macallan static int pmu_adb_send(void *, int, int, int, uint8_t *);
140 1.1 macallan static int pmu_adb_set_handler(void *, void (*)(void *, int, uint8_t *), void *);
141 1.1 macallan
142 1.1 macallan /* i2c stuff */
143 1.1 macallan #if 0
144 1.1 macallan static int pmu_i2c_acquire_bus(void *, int);
145 1.1 macallan static void pmu_i2c_release_bus(void *, int);
146 1.1 macallan static int pmu_i2c_exec(void *, i2c_op_t, i2c_addr_t, const void *, size_t,
147 1.1 macallan void *, size_t, int);
148 1.1 macallan #endif
149 1.1 macallan
150 1.1 macallan /* these values shows that number of data returned after 'send' cmd is sent */
151 1.1 macallan signed char pm_send_cmd_type[] = {
152 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
153 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
154 1.1 macallan 0x01, 0x01, -1, -1, -1, -1, -1, -1,
155 1.1 macallan 0x00, 0x00, -1, -1, -1, -1, -1, 0x00,
156 1.1 macallan -1, 0x00, 0x02, 0x01, 0x01, -1, -1, -1,
157 1.1 macallan 0x00, -1, -1, -1, -1, -1, -1, -1,
158 1.1 macallan 0x04, 0x14, -1, 0x03, -1, -1, -1, -1,
159 1.1 macallan 0x00, 0x00, 0x02, 0x02, -1, -1, -1, -1,
160 1.1 macallan 0x01, 0x01, -1, -1, -1, -1, -1, -1,
161 1.1 macallan 0x00, 0x00, -1, -1, 0x01, -1, -1, -1,
162 1.1 macallan 0x01, 0x00, 0x02, 0x02, -1, 0x01, 0x03, 0x01,
163 1.1 macallan 0x00, 0x01, 0x00, 0x00, 0x00, -1, -1, -1,
164 1.1 macallan 0x02, -1, -1, -1, -1, -1, -1, -1,
165 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -1, -1,
166 1.1 macallan 0x01, 0x01, 0x01, -1, -1, -1, -1, -1,
167 1.1 macallan 0x00, 0x00, -1, -1, -1, -1, 0x04, 0x04,
168 1.1 macallan 0x04, -1, 0x00, -1, -1, -1, -1, -1,
169 1.1 macallan 0x00, -1, -1, -1, -1, -1, -1, -1,
170 1.1 macallan 0x01, 0x02, -1, -1, -1, -1, -1, -1,
171 1.1 macallan 0x00, 0x00, -1, -1, -1, -1, -1, -1,
172 1.1 macallan 0x02, 0x02, 0x02, 0x04, -1, 0x00, -1, -1,
173 1.1 macallan 0x01, 0x01, 0x03, 0x02, -1, -1, -1, -1,
174 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
175 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
176 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
177 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
178 1.1 macallan 0x00, -1, -1, -1, -1, -1, -1, -1,
179 1.1 macallan 0x01, 0x01, -1, -1, 0x00, 0x00, -1, -1,
180 1.1 macallan -1, 0x04, 0x00, -1, -1, -1, -1, -1,
181 1.1 macallan 0x03, -1, 0x00, -1, 0x00, -1, -1, 0x00,
182 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
183 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1
184 1.1 macallan };
185 1.1 macallan
186 1.1 macallan /* these values shows that number of data returned after 'receive' cmd is sent */
187 1.1 macallan signed char pm_receive_cmd_type[] = {
188 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
189 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
190 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
191 1.1 macallan 0x02, 0x02, -1, -1, -1, -1, -1, 0x00,
192 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
193 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
194 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
195 1.1 macallan 0x05, 0x15, -1, 0x02, -1, -1, -1, -1,
196 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
197 1.1 macallan 0x02, 0x02, -1, -1, -1, -1, -1, -1,
198 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
199 1.1 macallan 0x02, 0x00, 0x03, 0x03, -1, -1, -1, -1,
200 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
201 1.1 macallan 0x04, 0x04, 0x03, 0x09, -1, -1, -1, -1,
202 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
203 1.1 macallan -1, -1, -1, -1, -1, -1, 0x01, 0x01,
204 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
205 1.1 macallan 0x06, -1, -1, -1, -1, -1, -1, -1,
206 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
207 1.1 macallan 0x02, 0x02, -1, -1, -1, -1, -1, -1,
208 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
209 1.1 macallan 0x02, 0x00, 0x00, 0x00, -1, -1, -1, -1,
210 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
211 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
212 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
213 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
214 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
215 1.1 macallan 0x02, 0x02, -1, -1, 0x02, -1, -1, -1,
216 1.1 macallan 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
217 1.1 macallan -1, -1, 0x02, -1, -1, -1, -1, 0x00,
218 1.1 macallan 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
219 1.1 macallan -1, -1, -1, -1, -1, -1, -1, -1,
220 1.1 macallan };
221 1.1 macallan
222 1.1 macallan static int
223 1.1 macallan pmu_match(struct device *parent, struct cfdata *cf, void *aux)
224 1.1 macallan {
225 1.1 macallan struct confargs *ca = aux;
226 1.1 macallan
227 1.1 macallan if (ca->ca_nreg < 8)
228 1.1 macallan return 0;
229 1.1 macallan
230 1.1 macallan if (ca->ca_nintr < 4)
231 1.1 macallan return 0;
232 1.1 macallan
233 1.1 macallan if (strcmp(ca->ca_name, "via-pmu") == 0) {
234 1.1 macallan return 10;
235 1.1 macallan }
236 1.1 macallan
237 1.1 macallan return 0;
238 1.1 macallan }
239 1.1 macallan
240 1.1 macallan static void
241 1.1 macallan pmu_attach(struct device *parent, struct device *dev, void *aux)
242 1.1 macallan {
243 1.1 macallan struct confargs *ca = aux;
244 1.1 macallan struct pmu_softc *sc = (struct pmu_softc *)dev;
245 1.1 macallan #if notyet
246 1.1 macallan struct i2cbus_attach_args iba;
247 1.1 macallan #endif
248 1.1 macallan int irq = ca->ca_intr[0];
249 1.1 macallan int node, extint_node;
250 1.1 macallan uint8_t cmd[2] = {2, 0};
251 1.1 macallan uint8_t resp[8];
252 1.1 macallan char name[32];
253 1.1 macallan
254 1.1 macallan extint_node = getnodebyname(OF_parent(ca->ca_node), "extint-gpio1");
255 1.1 macallan if (extint_node)
256 1.1 macallan OF_getprop(extint_node, "interrupts", &irq, 4);
257 1.1 macallan
258 1.1 macallan printf(" irq %d: ", irq);
259 1.1 macallan
260 1.1 macallan sc->sc_node = ca->ca_node;
261 1.1 macallan sc->sc_memt = ca->ca_tag;
262 1.1 macallan
263 1.1 macallan sc->sc_error = 0;
264 1.1 macallan sc->sc_autopoll = 0;
265 1.1 macallan sc->sc_pending_eject = 0;
266 1.1 macallan sc->sc_brightness = sc->sc_brightness_wanted = 0x80;
267 1.1 macallan sc->sc_volume = sc->sc_volume_wanted = 0x80;
268 1.1 macallan sc->sc_flags = 0;
269 1.1 macallan
270 1.1 macallan if (bus_space_map(sc->sc_memt, ca->ca_reg[0] + ca->ca_baseaddr,
271 1.1 macallan ca->ca_reg[1], 0, &sc->sc_memh) != 0) {
272 1.1 macallan
273 1.1 macallan printf("%s: unable to map registers\n", dev->dv_xname);
274 1.1 macallan return;
275 1.1 macallan }
276 1.1 macallan sc->sc_ih = intr_establish(irq, IST_LEVEL, IPL_HIGH, pmu_intr, sc);
277 1.1 macallan
278 1.1 macallan pmu_init(sc);
279 1.1 macallan
280 1.1 macallan if (pmu0 == NULL)
281 1.1 macallan pmu0 = sc;
282 1.1 macallan
283 1.1 macallan pmu_send(sc, PMU_SYSTEM_READY, 1, cmd, resp);
284 1.1 macallan
285 1.1 macallan /* check what kind of PMU we're talking to */
286 1.1 macallan if (pmu_send(sc, PMU_GET_VERSION, 0, cmd, resp) > 1)
287 1.1 macallan printf(" rev. %d", resp[1]);
288 1.1 macallan printf("\n");
289 1.1 macallan
290 1.1 macallan config_interrupts(dev, pmu_final);
291 1.1 macallan
292 1.1 macallan node = OF_child(ca->ca_node);
293 1.1 macallan while (node != 0) {
294 1.1 macallan
295 1.1 macallan if (OF_getprop(node, "name", name, 32) == 0)
296 1.1 macallan continue;
297 1.1 macallan if (strncmp(name, "adb", 4) == 0) {
298 1.1 macallan
299 1.1 macallan printf("%s: initializing ADB\n", sc->sc_dev.dv_xname);
300 1.1 macallan sc->sc_adbops.cookie = sc;
301 1.1 macallan sc->sc_adbops.send = pmu_adb_send;
302 1.1 macallan sc->sc_adbops.poll = pmu_adb_poll;
303 1.1 macallan sc->sc_adbops.autopoll = pmu_autopoll;
304 1.1 macallan sc->sc_adbops.set_handler = pmu_adb_set_handler;
305 1.1 macallan #if NNADB > 0
306 1.1 macallan config_found_ia(dev, "adb_bus", &sc->sc_adbops,
307 1.1 macallan nadb_print);
308 1.1 macallan #endif
309 1.1 macallan goto next;
310 1.1 macallan }
311 1.1 macallan if (strncmp(name, "rtc", 4) == 0) {
312 1.1 macallan
313 1.1 macallan printf("%s: initializing RTC\n", sc->sc_dev.dv_xname);
314 1.1 macallan sc->sc_todr.todr_gettime = pmu_todr_get;
315 1.1 macallan sc->sc_todr.todr_settime = pmu_todr_set;
316 1.1 macallan sc->sc_todr.cookie = sc;
317 1.1 macallan todr_attach(&sc->sc_todr);
318 1.1 macallan goto next;
319 1.1 macallan }
320 1.1 macallan printf("%s: %s not configured\n", sc->sc_dev.dv_xname, name);
321 1.1 macallan next:
322 1.1 macallan node = OF_peer(node);
323 1.1 macallan }
324 1.1 macallan
325 1.1 macallan if (OF_finddevice("/bandit/ohare") != -1) {
326 1.1 macallan printf("%s: enabling ohare backlight control\n",
327 1.1 macallan device_xname(dev));
328 1.1 macallan sc->sc_flags |= PMU_HAS_BACKLIGHT_CONTROL;
329 1.1 macallan }
330 1.1 macallan
331 1.1 macallan #if notyet
332 1.1 macallan iba.iba_tag = &sc->sc_i2c;
333 1.1 macallan sc->sc_i2c.ic_cookie = sc;
334 1.1 macallan sc->sc_i2c.ic_acquire_bus = pmu_i2c_acquire_bus;
335 1.1 macallan sc->sc_i2c.ic_release_bus = pmu_i2c_release_bus;
336 1.1 macallan sc->sc_i2c.ic_send_start = NULL;
337 1.1 macallan sc->sc_i2c.ic_send_stop = NULL;
338 1.1 macallan sc->sc_i2c.ic_initiate_xfer = NULL;
339 1.1 macallan sc->sc_i2c.ic_read_byte = NULL;
340 1.1 macallan sc->sc_i2c.ic_write_byte = NULL;
341 1.1 macallan sc->sc_i2c.ic_exec = pmu_i2c_exec;
342 1.1 macallan config_found_ia(&sc->sc_dev, "i2cbus", &iba, iicbus_print);
343 1.1 macallan #endif
344 1.1 macallan kthread_create(pmu_create_thread, sc);
345 1.1 macallan }
346 1.1 macallan
347 1.1 macallan static void
348 1.1 macallan pmu_init(struct pmu_softc *sc)
349 1.1 macallan {
350 1.1 macallan uint8_t pmu_imask, resp[16];
351 1.1 macallan
352 1.1 macallan pmu_imask =
353 1.1 macallan PMU_INT_PCEJECT | PMU_INT_SNDBRT | PMU_INT_ADB/* | PMU_INT_TICK*/;
354 1.1 macallan pmu_imask |= PMU_INT_BATTERY;
355 1.1 macallan pmu_imask |= PMU_INT_ENVIRONMENT;
356 1.1 macallan pmu_send(sc, PMU_SET_IMASK, 1, &pmu_imask, resp);
357 1.1 macallan
358 1.1 macallan pmu_write_reg(sc, vIER, 0x90); /* enable VIA interrupts */
359 1.1 macallan }
360 1.1 macallan
361 1.1 macallan static void
362 1.1 macallan pmu_final(struct device *dev)
363 1.1 macallan {
364 1.1 macallan //struct pmu_softc *sc = (struct pmu_softc *)dev;
365 1.1 macallan
366 1.1 macallan // pmu_write_reg(sc, vIER, 0x90); /* enable VIA interrupts */
367 1.1 macallan }
368 1.1 macallan
369 1.1 macallan static inline void
370 1.1 macallan pmu_write_reg(struct pmu_softc *sc, int offset, uint8_t value)
371 1.1 macallan {
372 1.1 macallan
373 1.1 macallan bus_space_write_1(sc->sc_memt, sc->sc_memh, offset, value);
374 1.1 macallan }
375 1.1 macallan
376 1.1 macallan static inline uint8_t
377 1.1 macallan pmu_read_reg(struct pmu_softc *sc, int offset)
378 1.1 macallan {
379 1.1 macallan
380 1.1 macallan return bus_space_read_1(sc->sc_memt, sc->sc_memh, offset);
381 1.1 macallan }
382 1.1 macallan
383 1.1 macallan static inline int
384 1.1 macallan pmu_send_byte(struct pmu_softc *sc, uint8_t data)
385 1.1 macallan {
386 1.1 macallan
387 1.1 macallan pmu_out(sc);
388 1.1 macallan pmu_write_reg(sc, vSR, data);
389 1.1 macallan pmu_ack_off(sc);
390 1.1 macallan /* wait for intr to come up */
391 1.1 macallan /* XXX should add a timeout and bail if it expires */
392 1.1 macallan do {} while (pmu_intr_state(sc) == 0);
393 1.1 macallan pmu_ack_on(sc);
394 1.1 macallan do {} while (pmu_intr_state(sc));
395 1.1 macallan pmu_ack_on(sc);
396 1.1 macallan DPRINTF(" %02x>", data);
397 1.1 macallan return 0;
398 1.1 macallan }
399 1.1 macallan
400 1.1 macallan static inline int
401 1.1 macallan pmu_read_byte(struct pmu_softc *sc, uint8_t *data)
402 1.1 macallan {
403 1.1 macallan volatile uint8_t scratch;
404 1.1 macallan pmu_in(sc);
405 1.1 macallan scratch = pmu_read_reg(sc, vSR);
406 1.1 macallan pmu_ack_off(sc);
407 1.1 macallan /* wait for intr to come up */
408 1.1 macallan do {} while (pmu_intr_state(sc) == 0);
409 1.1 macallan pmu_ack_on(sc);
410 1.1 macallan do {} while (pmu_intr_state(sc));
411 1.1 macallan *data = pmu_read_reg(sc, vSR);
412 1.1 macallan DPRINTF(" <%02x", *data);
413 1.1 macallan return 0;
414 1.1 macallan }
415 1.1 macallan
416 1.1 macallan static int
417 1.1 macallan pmu_send(struct pmu_softc *sc, int cmd, int length, uint8_t *in_msg,
418 1.1 macallan uint8_t *out_msg)
419 1.1 macallan {
420 1.1 macallan int i, rcv_len = -1, s;
421 1.1 macallan uint8_t out_len, intreg;
422 1.1 macallan
423 1.1 macallan DPRINTF("pmu_send: ");
424 1.1 macallan
425 1.1 macallan s = splhigh();
426 1.1 macallan intreg = pmu_read_reg(sc, vIER);
427 1.1 macallan intreg &= 0x10;
428 1.1 macallan pmu_write_reg(sc, vIER, intreg);
429 1.1 macallan
430 1.1 macallan /* wait idle */
431 1.1 macallan do {} while (pmu_intr_state(sc));
432 1.1 macallan sc->sc_error = 0;
433 1.1 macallan
434 1.1 macallan /* send command */
435 1.1 macallan pmu_send_byte(sc, cmd);
436 1.1 macallan
437 1.1 macallan /* send length if necessary */
438 1.1 macallan if (pm_send_cmd_type[cmd] < 0) {
439 1.1 macallan pmu_send_byte(sc, length);
440 1.1 macallan }
441 1.1 macallan
442 1.1 macallan for (i = 0; i < length; i++) {
443 1.1 macallan pmu_send_byte(sc, in_msg[i]);
444 1.1 macallan DPRINTF(" next ");
445 1.1 macallan }
446 1.1 macallan DPRINTF("done sending\n");
447 1.1 macallan
448 1.1 macallan /* see if there's data to read */
449 1.1 macallan rcv_len = pm_receive_cmd_type[cmd];
450 1.1 macallan if (rcv_len == 0)
451 1.1 macallan goto done;
452 1.1 macallan
453 1.1 macallan /* read command */
454 1.1 macallan if (rcv_len == 1) {
455 1.1 macallan pmu_read_byte(sc, out_msg);
456 1.1 macallan goto done;
457 1.1 macallan } else
458 1.1 macallan out_msg[0] = cmd;
459 1.1 macallan if (rcv_len < 0) {
460 1.1 macallan pmu_read_byte(sc, &out_len);
461 1.1 macallan rcv_len = out_len + 1;
462 1.1 macallan }
463 1.1 macallan for (i = 1; i < rcv_len; i++)
464 1.1 macallan pmu_read_byte(sc, &out_msg[i]);
465 1.1 macallan
466 1.1 macallan done:
467 1.1 macallan DPRINTF("\n");
468 1.1 macallan pmu_write_reg(sc, vIER, (intreg == 0) ? 0 : 0x90);
469 1.1 macallan splx(s);
470 1.1 macallan
471 1.1 macallan return rcv_len;
472 1.1 macallan }
473 1.1 macallan
474 1.1 macallan #if notyet
475 1.1 macallan static void
476 1.1 macallan pmu_poll(void *cookie)
477 1.1 macallan {
478 1.1 macallan struct pmu_softc *sc = cookie;
479 1.1 macallan
480 1.1 macallan while ((pmu_read_reg(sc, vIFR) & vSR_INT) == vSR_INT) {
481 1.1 macallan pmu_intr(sc);
482 1.1 macallan }
483 1.1 macallan }
484 1.1 macallan #endif
485 1.1 macallan
486 1.1 macallan static void
487 1.1 macallan pmu_adb_poll(void *cookie)
488 1.1 macallan {
489 1.1 macallan struct pmu_softc *sc = cookie;
490 1.1 macallan
491 1.1 macallan pmu_intr(sc);
492 1.1 macallan }
493 1.1 macallan
494 1.1 macallan static void
495 1.1 macallan pmu_in(struct pmu_softc *sc)
496 1.1 macallan {
497 1.1 macallan uint8_t reg;
498 1.1 macallan
499 1.1 macallan reg = pmu_read_reg(sc, vACR);
500 1.1 macallan reg &= ~vSR_OUT;
501 1.1 macallan reg |= 0x0c;
502 1.1 macallan pmu_write_reg(sc, vACR, reg);
503 1.1 macallan }
504 1.1 macallan
505 1.1 macallan static void
506 1.1 macallan pmu_out(struct pmu_softc *sc)
507 1.1 macallan {
508 1.1 macallan uint8_t reg;
509 1.1 macallan
510 1.1 macallan reg = pmu_read_reg(sc, vACR);
511 1.1 macallan reg |= vSR_OUT;
512 1.1 macallan reg |= 0x0c;
513 1.1 macallan pmu_write_reg(sc, vACR, reg);
514 1.1 macallan }
515 1.1 macallan
516 1.1 macallan static void
517 1.1 macallan pmu_ack_off(struct pmu_softc *sc)
518 1.1 macallan {
519 1.1 macallan uint8_t reg;
520 1.1 macallan
521 1.1 macallan reg = pmu_read_reg(sc, vBufB);
522 1.1 macallan reg &= ~vPB4;
523 1.1 macallan pmu_write_reg(sc, vBufB, reg);
524 1.1 macallan }
525 1.1 macallan
526 1.1 macallan static void
527 1.1 macallan pmu_ack_on(struct pmu_softc *sc)
528 1.1 macallan {
529 1.1 macallan uint8_t reg;
530 1.1 macallan
531 1.1 macallan reg = pmu_read_reg(sc, vBufB);
532 1.1 macallan reg |= vPB4;
533 1.1 macallan pmu_write_reg(sc, vBufB, reg);
534 1.1 macallan }
535 1.1 macallan
536 1.1 macallan static int
537 1.1 macallan pmu_intr_state(struct pmu_softc *sc)
538 1.1 macallan {
539 1.1 macallan return ((pmu_read_reg(sc, vBufB) & vPB3) == 0);
540 1.1 macallan }
541 1.1 macallan
542 1.1 macallan static int
543 1.1 macallan pmu_intr(void *arg)
544 1.1 macallan {
545 1.1 macallan struct pmu_softc *sc = arg;
546 1.1 macallan unsigned int s, len, i;
547 1.1 macallan uint8_t resp[16];
548 1.1 macallan
549 1.1 macallan s = splhigh(); /* can't be too careful - might be called */
550 1.1 macallan /* from a routine, NOT an interrupt */
551 1.1 macallan
552 1.1 macallan DPRINTF(":");
553 1.1 macallan
554 1.1 macallan pmu_write_reg(sc, vIFR, 0x90); /* Clear 'em */
555 1.1 macallan len = pmu_send(sc, PMU_INT_ACK, 0, NULL, resp);
556 1.1 macallan if ((len < 1) || (resp[1] == 0))
557 1.1 macallan goto done;
558 1.1 macallan #ifdef PMU_DEBUG
559 1.1 macallan {
560 1.1 macallan DPRINTF("intr: %02x", resp[0]);
561 1.1 macallan for (i = 1; i < len; i++)
562 1.1 macallan DPRINTF(" %02x", resp[i]);
563 1.1 macallan DPRINTF("\n");
564 1.1 macallan }
565 1.1 macallan #endif
566 1.1 macallan if (resp[1] & PMU_INT_ADB) {
567 1.1 macallan pmu_adb_handler(sc, len - 1, &resp[1]);
568 1.1 macallan goto done;
569 1.1 macallan }
570 1.1 macallan if (resp[1] & PMU_INT_SNDBRT) {
571 1.1 macallan /* deal with the brightness / volume control buttons */
572 1.1 macallan DPRINTF("brightness: %d volume %d\n", resp[2], resp[3]);
573 1.1 macallan sc->sc_brightness_wanted = resp[2];
574 1.1 macallan sc->sc_volume_wanted = resp[3];
575 1.1 macallan wakeup(&sc->sc_event);
576 1.1 macallan goto done;
577 1.1 macallan }
578 1.1 macallan if (resp[1] & PMU_INT_PCEJECT) {
579 1.1 macallan /* deal with PCMCIA eject buttons */
580 1.1 macallan DPRINTF("card eject %d\n", resp[3]);
581 1.1 macallan sc->sc_pending_eject |= (resp[3] & 3);
582 1.1 macallan wakeup(&sc->sc_event);
583 1.1 macallan goto done;
584 1.1 macallan }
585 1.1 macallan if (resp[1] & PMU_INT_BATTERY) {
586 1.1 macallan /* deal with battery messages */
587 1.1 macallan printf("battery:");
588 1.1 macallan for (i = 2; i < len; i++)
589 1.1 macallan printf(" %02x", resp[i]);
590 1.1 macallan printf("\n");
591 1.1 macallan goto done;
592 1.1 macallan }
593 1.1 macallan if (resp[1] & PMU_INT_ENVIRONMENT) {
594 1.1 macallan #ifdef PMU_VERBOSE
595 1.1 macallan /* deal with environment messages */
596 1.1 macallan printf("environment:");
597 1.1 macallan for (i = 2; i < len; i++)
598 1.1 macallan printf(" %02x", resp[i]);
599 1.1 macallan printf("\n");
600 1.1 macallan #endif
601 1.1 macallan goto done;
602 1.1 macallan }
603 1.1 macallan if (resp[1] & PMU_INT_TICK) {
604 1.1 macallan /* don't bother */
605 1.1 macallan goto done;
606 1.1 macallan }
607 1.1 macallan
608 1.1 macallan /* unknown interrupt code?! */
609 1.1 macallan #ifdef PMU_DEBUG
610 1.1 macallan printf("pmu intr: %02x:", resp[1]);
611 1.1 macallan for (i = 2; i < len; i++)
612 1.1 macallan printf(" %02x", resp[i]);
613 1.1 macallan printf("\n");
614 1.1 macallan #endif
615 1.1 macallan done:
616 1.1 macallan splx(s);
617 1.1 macallan return 1;
618 1.1 macallan }
619 1.1 macallan
620 1.1 macallan #if 0
621 1.1 macallan static int
622 1.1 macallan pmu_error_handler(void *cookie, int len, uint8_t *data)
623 1.1 macallan {
624 1.1 macallan struct pmu_softc *sc = cookie;
625 1.1 macallan
626 1.1 macallan /*
627 1.1 macallan * something went wrong
628 1.1 macallan * byte 3 seems to be the failed command
629 1.1 macallan */
630 1.1 macallan sc->sc_error = 1;
631 1.1 macallan wakeup(&sc->sc_todev);
632 1.1 macallan return 0;
633 1.1 macallan }
634 1.1 macallan #endif
635 1.1 macallan #define DIFF19041970 2082844800
636 1.1 macallan
637 1.1 macallan static int
638 1.1 macallan pmu_todr_get(todr_chip_handle_t tch, volatile struct timeval *tvp)
639 1.1 macallan {
640 1.1 macallan struct pmu_softc *sc = tch->cookie;
641 1.1 macallan uint32_t sec;
642 1.1 macallan uint8_t resp[16];
643 1.1 macallan
644 1.1 macallan DPRINTF("pmu_todr_get\n");
645 1.1 macallan pmu_send(sc, PMU_READ_RTC, 0, NULL, resp);
646 1.1 macallan
647 1.1 macallan memcpy(&sec, &resp[1], 4);
648 1.1 macallan tvp->tv_sec = sec - DIFF19041970;
649 1.1 macallan DPRINTF("tod: %ld\n", tvp->tv_sec);
650 1.1 macallan tvp->tv_usec = 0;
651 1.1 macallan return 0;
652 1.1 macallan }
653 1.1 macallan
654 1.1 macallan static int
655 1.1 macallan pmu_todr_set(todr_chip_handle_t tch, volatile struct timeval *tvp)
656 1.1 macallan {
657 1.1 macallan struct pmu_softc *sc = tch->cookie;
658 1.1 macallan uint32_t sec;
659 1.1 macallan uint8_t resp[16];
660 1.1 macallan
661 1.1 macallan sec = tvp->tv_sec + DIFF19041970;
662 1.1 macallan if (pmu_send(sc, PMU_SET_RTC, 4, (uint8_t *)&sec, resp) >= 0)
663 1.1 macallan return 0;
664 1.1 macallan return -1;
665 1.1 macallan }
666 1.1 macallan
667 1.1 macallan void
668 1.1 macallan pmu_poweroff()
669 1.1 macallan {
670 1.1 macallan struct pmu_softc *sc;
671 1.1 macallan uint8_t cmd[] = {'M', 'A', 'T', 'T'};
672 1.1 macallan uint8_t resp[16];
673 1.1 macallan
674 1.1 macallan if (pmu0 == NULL)
675 1.1 macallan return;
676 1.1 macallan sc = pmu0;
677 1.1 macallan if (pmu_send(sc, PMU_POWER_OFF, 4, cmd, resp) >= 0)
678 1.1 macallan while (1);
679 1.1 macallan }
680 1.1 macallan
681 1.1 macallan void
682 1.1 macallan pmu_restart()
683 1.1 macallan {
684 1.1 macallan struct pmu_softc *sc;
685 1.1 macallan uint8_t resp[16];
686 1.1 macallan
687 1.1 macallan if (pmu0 == NULL)
688 1.1 macallan return;
689 1.1 macallan sc = pmu0;
690 1.1 macallan if (pmu_send(sc, PMU_RESET_CPU, 0, NULL, resp) >= 0)
691 1.1 macallan while (1);
692 1.1 macallan }
693 1.1 macallan
694 1.1 macallan static void
695 1.1 macallan pmu_autopoll(void *cookie, int flag)
696 1.1 macallan {
697 1.1 macallan struct pmu_softc *sc = cookie;
698 1.1 macallan /* magical incantation to re-enable autopolling */
699 1.1 macallan uint8_t cmd[] = {0, 0x86, (flag >> 8) & 0xff, flag & 0xff};
700 1.1 macallan uint8_t resp[16];
701 1.1 macallan
702 1.1 macallan if (sc->sc_autopoll == flag)
703 1.1 macallan return;
704 1.1 macallan
705 1.1 macallan if (flag) {
706 1.1 macallan pmu_send(sc, PMU_ADB_CMD, 4, cmd, resp);
707 1.1 macallan } else {
708 1.1 macallan pmu_send(sc, PMU_ADB_POLL_OFF, 0, NULL, resp);
709 1.1 macallan }
710 1.1 macallan sc->sc_autopoll = flag & 0xffff;
711 1.1 macallan }
712 1.1 macallan
713 1.1 macallan static int
714 1.1 macallan pmu_adb_handler(void *cookie, int len, uint8_t *data)
715 1.1 macallan {
716 1.1 macallan struct pmu_softc *sc = cookie;
717 1.1 macallan uint8_t resp[16];
718 1.1 macallan
719 1.1 macallan if (sc->sc_adb_handler != NULL) {
720 1.1 macallan sc->sc_adb_handler(sc->sc_adb_cookie, len, data);
721 1.1 macallan /*
722 1.1 macallan * the PMU will turn off autopolling after each LISTEN so we
723 1.1 macallan * need to re-enable it here whenever we receive an ACK for a
724 1.1 macallan * LISTEN command
725 1.1 macallan */
726 1.1 macallan if ((data[1] & 0x0c) == 0x08) {
727 1.1 macallan uint8_t cmd[] = {0, 0x86, (sc->sc_autopoll >> 8) & 0xff,
728 1.1 macallan sc->sc_autopoll & 0xff};
729 1.1 macallan pmu_send(sc, PMU_ADB_CMD, 4, cmd, resp);
730 1.1 macallan }
731 1.1 macallan return 0;
732 1.1 macallan }
733 1.1 macallan return -1;
734 1.1 macallan }
735 1.1 macallan
736 1.1 macallan static int
737 1.1 macallan pmu_adb_send(void *cookie, int poll, int command, int len, uint8_t *data)
738 1.1 macallan {
739 1.1 macallan struct pmu_softc *sc = cookie;
740 1.1 macallan int i, replen;
741 1.1 macallan uint8_t packet[16], resp[16];
742 1.1 macallan
743 1.1 macallan /* construct an ADB command packet and send it */
744 1.1 macallan packet[0] = command;
745 1.1 macallan packet[1] = 0;
746 1.1 macallan packet[2] = len;
747 1.1 macallan for (i = 0; i < len; i++)
748 1.1 macallan packet[i + 3] = data[i];
749 1.1 macallan replen = pmu_send(sc, PMU_ADB_CMD, len + 3, packet, resp);
750 1.1 macallan
751 1.1 macallan return 0;
752 1.1 macallan }
753 1.1 macallan
754 1.1 macallan static int
755 1.1 macallan pmu_adb_set_handler(void *cookie, void (*handler)(void *, int, uint8_t *),
756 1.1 macallan void *hcookie)
757 1.1 macallan {
758 1.1 macallan struct pmu_softc *sc = cookie;
759 1.1 macallan
760 1.1 macallan /* register a callback for incoming ADB messages */
761 1.1 macallan sc->sc_adb_handler = handler;
762 1.1 macallan sc->sc_adb_cookie = hcookie;
763 1.1 macallan return 0;
764 1.1 macallan }
765 1.1 macallan #if 0
766 1.1 macallan static int
767 1.1 macallan pmu_i2c_acquire_bus(void *cookie, int flags)
768 1.1 macallan {
769 1.1 macallan /* nothing yet */
770 1.1 macallan return 0;
771 1.1 macallan }
772 1.1 macallan
773 1.1 macallan static void
774 1.1 macallan pmu_i2c_release_bus(void *cookie, int flags)
775 1.1 macallan {
776 1.1 macallan /* nothing here either */
777 1.1 macallan }
778 1.1 macallan
779 1.1 macallan static int
780 1.1 macallan pmu_i2c_exec(void *cookie, i2c_op_t op, i2c_addr_t addr, const void *_send,
781 1.1 macallan size_t send_len, void *_recv, size_t recv_len, int flags)
782 1.1 macallan {
783 1.1 macallan #if 0
784 1.1 macallan struct pmu_softc *sc = cookie;
785 1.1 macallan const uint8_t *send = _send;
786 1.1 macallan uint8_t *recv = _recv;
787 1.1 macallan uint8_t command[16] = {PMU_POWERMGR, PMGR_IIC};
788 1.1 macallan
789 1.1 macallan DPRINTF("pmu_i2c_exec(%02x)\n", addr);
790 1.1 macallan command[2] = addr;
791 1.1 macallan
792 1.1 macallan memcpy(&command[3], send, min((int)send_len, 12));
793 1.1 macallan
794 1.1 macallan sc->sc_iic_done = 0;
795 1.1 macallan pmu_send(sc, sc->sc_polling, send_len + 3, command);
796 1.1 macallan
797 1.1 macallan while ((sc->sc_iic_done == 0) && (sc->sc_error == 0)) {
798 1.1 macallan if (sc->sc_polling) {
799 1.1 macallan pmu_poll(sc);
800 1.1 macallan } else
801 1.1 macallan tsleep(&sc->sc_todev, 0, "i2c", 1000);
802 1.1 macallan }
803 1.1 macallan
804 1.1 macallan if (sc->sc_error) {
805 1.1 macallan sc->sc_error = 0;
806 1.1 macallan return -1;
807 1.1 macallan }
808 1.1 macallan
809 1.1 macallan /* see if we're supposed to do a read */
810 1.1 macallan if (recv_len > 0) {
811 1.1 macallan sc->sc_iic_done = 0;
812 1.1 macallan command[2] |= 1;
813 1.1 macallan command[3] = 0;
814 1.1 macallan
815 1.1 macallan /*
816 1.1 macallan * XXX we need to do something to limit the size of the answer
817 1.1 macallan * - apparently the chip keeps sending until we tell it to stop
818 1.1 macallan */
819 1.1 macallan pmu_send(sc, sc->sc_polling, 3, command);
820 1.1 macallan while ((sc->sc_iic_done == 0) && (sc->sc_error == 0)) {
821 1.1 macallan if (sc->sc_polling) {
822 1.1 macallan pmu_poll(sc);
823 1.1 macallan } else
824 1.1 macallan tsleep(&sc->sc_todev, 0, "i2c", 1000);
825 1.1 macallan }
826 1.1 macallan
827 1.1 macallan if (sc->sc_error) {
828 1.1 macallan printf("error trying to read\n");
829 1.1 macallan sc->sc_error = 0;
830 1.1 macallan return -1;
831 1.1 macallan }
832 1.1 macallan }
833 1.1 macallan
834 1.1 macallan if ((sc->sc_iic_done > 3) && (recv_len > 0)) {
835 1.1 macallan /* we got an answer */
836 1.1 macallan recv[0] = sc->sc_iic_val;
837 1.1 macallan printf("ret: %02x\n", sc->sc_iic_val);
838 1.1 macallan return 1;
839 1.1 macallan }
840 1.1 macallan #endif
841 1.1 macallan return 0;
842 1.1 macallan }
843 1.1 macallan #endif
844 1.1 macallan
845 1.1 macallan static void
846 1.1 macallan pmu_eject_card(struct pmu_softc *sc, int socket)
847 1.1 macallan {
848 1.1 macallan int s;
849 1.1 macallan uint8_t buf[] = {socket | 4};
850 1.1 macallan uint8_t res[4];
851 1.1 macallan
852 1.1 macallan s = splhigh();
853 1.1 macallan sc->sc_pending_eject &= ~socket;
854 1.1 macallan splx(s);
855 1.1 macallan pmu_send(sc, PMU_EJECT_PCMCIA, 1, buf, res);
856 1.1 macallan }
857 1.1 macallan
858 1.1 macallan static void
859 1.1 macallan pmu_update_brightness(struct pmu_softc *sc)
860 1.1 macallan {
861 1.1 macallan int val;
862 1.1 macallan uint8_t cmd[2], resp[16];
863 1.1 macallan
864 1.1 macallan if (sc->sc_brightness == sc->sc_brightness_wanted)
865 1.1 macallan return;
866 1.1 macallan
867 1.1 macallan if ((sc->sc_flags & PMU_HAS_BACKLIGHT_CONTROL) == 0) {
868 1.1 macallan
869 1.1 macallan printf("%s: this PMU doesn't support backlight control\n",
870 1.1 macallan sc->sc_dev.dv_xname);
871 1.1 macallan sc->sc_brightness = sc->sc_brightness_wanted;
872 1.1 macallan return;
873 1.1 macallan }
874 1.1 macallan
875 1.1 macallan if (sc->sc_brightness_wanted == 0) {
876 1.1 macallan
877 1.1 macallan /* turn backlight off completely */
878 1.1 macallan cmd[0] = PMU_POW_OFF | PMU_POW_BACKLIGHT;
879 1.1 macallan pmu_send(sc, PMU_POWER_CTRL, 1, cmd, resp);
880 1.1 macallan sc->sc_brightness = sc->sc_brightness_wanted;
881 1.1 macallan
882 1.1 macallan /* don't bother with brightness */
883 1.1 macallan return;
884 1.1 macallan }
885 1.1 macallan
886 1.1 macallan /* turn backlight on if needed */
887 1.1 macallan if (sc->sc_brightness == 0) {
888 1.1 macallan cmd[0] = PMU_POW_ON | PMU_POW_BACKLIGHT;
889 1.1 macallan pmu_send(sc, PMU_POWER_CTRL, 1, cmd, resp);
890 1.1 macallan }
891 1.1 macallan
892 1.1 macallan DPRINTF("pmu_update_brightness: %d -> %d\n", sc->sc_brightness,
893 1.1 macallan sc->sc_brightness_wanted);
894 1.1 macallan
895 1.1 macallan val = 0x7f - (sc->sc_brightness_wanted >> 1);
896 1.1 macallan if (val < 0x08)
897 1.1 macallan val = 0x08;
898 1.1 macallan if (val > 0x78)
899 1.1 macallan val = 0x78;
900 1.1 macallan cmd[0] = val;
901 1.1 macallan pmu_send(sc, PMU_SET_BRIGHTNESS, 1, cmd, resp);
902 1.1 macallan
903 1.1 macallan sc->sc_brightness = sc->sc_brightness_wanted;
904 1.1 macallan }
905 1.1 macallan
906 1.1 macallan static void
907 1.1 macallan pmu_create_thread(void *cookie)
908 1.1 macallan {
909 1.1 macallan struct pmu_softc *sc = cookie;
910 1.1 macallan
911 1.1 macallan if (kthread_create1(pmu_thread, sc, &sc->sc_thread, "%s",
912 1.1 macallan "pmu") != 0) {
913 1.1 macallan printf("pmu: unable to create event kthread");
914 1.1 macallan }
915 1.1 macallan }
916 1.1 macallan
917 1.1 macallan static void
918 1.1 macallan pmu_thread(void *cookie)
919 1.1 macallan {
920 1.1 macallan struct pmu_softc *sc = cookie;
921 1.1 macallan //time_t time_bat = time_second;
922 1.1 macallan int ticks = hz, i;
923 1.1 macallan
924 1.1 macallan while (1) {
925 1.1 macallan tsleep(&sc->sc_event, PWAIT, "pmu_wait", ticks);
926 1.1 macallan if (sc->sc_pending_eject != 0) {
927 1.1 macallan DPRINTF("eject %d\n", sc->sc_pending_eject);
928 1.1 macallan for (i = 1; i < 3; i++) {
929 1.1 macallan if (i & sc->sc_pending_eject)
930 1.1 macallan pmu_eject_card(sc, i);
931 1.1 macallan }
932 1.1 macallan }
933 1.1 macallan #if NLWPM > 0
934 1.1 macallan lwpm_poll();
935 1.1 macallan #endif
936 1.1 macallan /* see if we need to update brightness */
937 1.1 macallan if (sc->sc_brightness_wanted != sc->sc_brightness) {
938 1.1 macallan pmu_update_brightness(sc);
939 1.1 macallan }
940 1.1 macallan
941 1.1 macallan /* see if we need to update audio volume */
942 1.1 macallan if (sc->sc_volume_wanted != sc->sc_volume) {
943 1.1 macallan //set_volume(sc->sc_volume_wanted);
944 1.1 macallan sc->sc_volume = sc->sc_volume_wanted;
945 1.1 macallan }
946 1.1 macallan }
947 1.1 macallan }
948