psm.c revision 1.2.4.3 1 1.2.4.3 yamt /* $NetBSD: psm.c,v 1.2.4.3 2006/09/03 15:23:32 yamt Exp $ */
2 1.2.4.2 yamt /*
3 1.2.4.2 yamt * Copyright (c) 2006 Itronix Inc.
4 1.2.4.2 yamt * All rights reserved.
5 1.2.4.2 yamt *
6 1.2.4.2 yamt * Ported from Tadpole Solaris sources by Garrett D'Amore for Itronix Inc.
7 1.2.4.2 yamt *
8 1.2.4.2 yamt * Redistribution and use in source and binary forms, with or without
9 1.2.4.2 yamt * modification, are permitted provided that the following conditions
10 1.2.4.2 yamt * are met:
11 1.2.4.2 yamt * 1. Redistributions of source code must retain the above copyright
12 1.2.4.2 yamt * notice, this list of conditions and the following disclaimer.
13 1.2.4.2 yamt * 2. Redistributions in binary form must reproduce the above copyright
14 1.2.4.2 yamt * notice, this list of conditions and the following disclaimer in the
15 1.2.4.2 yamt * documentation and/or other materials provided with the distribution.
16 1.2.4.2 yamt * 3. The name of Itronix Inc. may not be used to endorse
17 1.2.4.2 yamt * or promote products derived from this software without specific
18 1.2.4.2 yamt * prior written permission.
19 1.2.4.2 yamt *
20 1.2.4.2 yamt * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
21 1.2.4.2 yamt * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22 1.2.4.2 yamt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23 1.2.4.2 yamt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
24 1.2.4.2 yamt * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
25 1.2.4.2 yamt * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
26 1.2.4.2 yamt * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
27 1.2.4.2 yamt * ON ANY THEORY OF LIABILITY, WHETHER IN
28 1.2.4.2 yamt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 1.2.4.2 yamt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 1.2.4.2 yamt * POSSIBILITY OF SUCH DAMAGE.
31 1.2.4.2 yamt */
32 1.2.4.2 yamt /*
33 1.2.4.2 yamt * Tadpole-RDI Ultrabook IIi (huxley) power management. Note that
34 1.2.4.2 yamt * there is a lot of stuff still missing here, due in part to the confusion
35 1.2.4.2 yamt * that exists with the NetBSD power management framework. I'm not wasting
36 1.2.4.2 yamt * time with APM at this point, and some of sysmon seems "lacking".
37 1.2.4.2 yamt */
38 1.2.4.2 yamt #include <sys/cdefs.h>
39 1.2.4.3 yamt __KERNEL_RCSID(0, "$NetBSD: psm.c,v 1.2.4.3 2006/09/03 15:23:32 yamt Exp $");
40 1.2.4.2 yamt
41 1.2.4.2 yamt #include <sys/param.h>
42 1.2.4.2 yamt #include <sys/systm.h>
43 1.2.4.2 yamt #include <sys/proc.h>
44 1.2.4.2 yamt #include <sys/kernel.h>
45 1.2.4.2 yamt #include <sys/kthread.h>
46 1.2.4.2 yamt #include <sys/types.h>
47 1.2.4.2 yamt #include <sys/device.h>
48 1.2.4.2 yamt #include <sys/poll.h>
49 1.2.4.2 yamt #include <sys/kauth.h>
50 1.2.4.2 yamt
51 1.2.4.2 yamt #include <machine/autoconf.h>
52 1.2.4.2 yamt #include <machine/bus.h>
53 1.2.4.2 yamt #include <machine/intr.h>
54 1.2.4.2 yamt
55 1.2.4.2 yamt #include <dev/ebus/ebusreg.h>
56 1.2.4.2 yamt #include <dev/ebus/ebusvar.h>
57 1.2.4.2 yamt
58 1.2.4.2 yamt #include <dev/sysmon/sysmonvar.h>
59 1.2.4.2 yamt
60 1.2.4.2 yamt #include <sparc64/dev/psmreg.h>
61 1.2.4.2 yamt
62 1.2.4.2 yamt struct psm_softc {
63 1.2.4.2 yamt struct device sc_dev;
64 1.2.4.2 yamt bus_space_tag_t sc_memt;
65 1.2.4.2 yamt bus_space_handle_t sc_memh;
66 1.2.4.2 yamt
67 1.2.4.2 yamt int sc_event;
68 1.2.4.2 yamt int sc_flags;
69 1.2.4.2 yamt struct sysmon_pswitch sc_sm_pbutton;
70 1.2.4.2 yamt struct sysmon_pswitch sc_sm_lid;
71 1.2.4.2 yamt struct sysmon_pswitch sc_sm_ac;
72 1.2.4.2 yamt struct evcnt sc_intrcnt;
73 1.2.4.2 yamt struct proc *sc_thread;
74 1.2.4.2 yamt };
75 1.2.4.2 yamt
76 1.2.4.2 yamt #define PUT8(sc, r, v) \
77 1.2.4.2 yamt bus_space_write_1(sc->sc_memt, sc->sc_memh, r, v)
78 1.2.4.2 yamt #define GET8(sc, r) \
79 1.2.4.2 yamt bus_space_read_1(sc->sc_memt, sc->sc_memh, r)
80 1.2.4.2 yamt
81 1.2.4.2 yamt #define WAIT_DELAY 1000
82 1.2.4.2 yamt #define WAIT_RETRIES 1000
83 1.2.4.2 yamt
84 1.2.4.2 yamt #define RESET_DELAY 200
85 1.2.4.2 yamt #define CMD_DELAY 10
86 1.2.4.2 yamt #define CMD_RETRIES 5
87 1.2.4.2 yamt
88 1.2.4.2 yamt #ifdef DEBUG
89 1.2.4.2 yamt #define STATIC
90 1.2.4.2 yamt #else
91 1.2.4.2 yamt #define STATIC static
92 1.2.4.2 yamt #endif
93 1.2.4.2 yamt
94 1.2.4.2 yamt /* flags indicating state */
95 1.2.4.2 yamt #define PSM_FLAG_ACPWR 0x1
96 1.2.4.2 yamt #define PSM_FLAG_LIDCLOSED 0x2
97 1.2.4.2 yamt #define PSM_FLAG_DOCKED 0x4
98 1.2.4.2 yamt
99 1.2.4.2 yamt /* system events -- causes activity in the event thread */
100 1.2.4.2 yamt #define PSM_EV_PBUTTON 0x1
101 1.2.4.2 yamt #define PSM_EV_LID 0x2
102 1.2.4.2 yamt #define PSM_EV_ACPWR 0x4
103 1.2.4.2 yamt #define PSM_EV_BATT 0x8
104 1.2.4.2 yamt #define PSM_EV_TEMP 0x10
105 1.2.4.2 yamt
106 1.2.4.2 yamt STATIC void psm_sysmon_setup(struct psm_softc *);
107 1.2.4.2 yamt STATIC void psm_create_event_thread(void *);
108 1.2.4.2 yamt STATIC void psm_event_thread(void *);
109 1.2.4.2 yamt STATIC int psm_init(struct psm_softc *);
110 1.2.4.2 yamt STATIC void psm_reset(struct psm_softc *);
111 1.2.4.2 yamt STATIC void psm_poll_acpower(struct psm_softc *);
112 1.2.4.2 yamt STATIC int psm_intr(void *);
113 1.2.4.2 yamt STATIC int psm_misc_rd(struct psm_softc *, uint8_t, uint8_t *);
114 1.2.4.2 yamt STATIC int psm_misc_wr(struct psm_softc *, uint8_t, uint8_t);
115 1.2.4.2 yamt STATIC int psm_wait(struct psm_softc *, uint8_t);
116 1.2.4.2 yamt #if 0
117 1.2.4.2 yamt STATIC int psm_ecmd_rd16(struct psm_softc *, uint16_t *, uint8_t, uint8_t,
118 1.2.4.2 yamt uint8_t);
119 1.2.4.2 yamt #endif
120 1.2.4.2 yamt STATIC int psm_ecmd_rd8(struct psm_softc *, uint8_t *, uint8_t, uint8_t,
121 1.2.4.2 yamt uint8_t);
122 1.2.4.2 yamt STATIC int psm_ecmd_wr8(struct psm_softc *, uint8_t, uint8_t, uint8_t,
123 1.2.4.2 yamt uint8_t);
124 1.2.4.2 yamt STATIC int psm_match(struct device *, struct cfdata *, void *);
125 1.2.4.2 yamt STATIC void psm_attach(struct device *, struct device *, void *);
126 1.2.4.2 yamt
127 1.2.4.2 yamt CFATTACH_DECL(psm, sizeof(struct psm_softc),
128 1.2.4.2 yamt psm_match, psm_attach, NULL, NULL);
129 1.2.4.2 yamt
130 1.2.4.2 yamt
131 1.2.4.3 yamt int
132 1.2.4.2 yamt psm_match(struct device *parent, struct cfdata *cf, void *aux)
133 1.2.4.2 yamt {
134 1.2.4.2 yamt struct ebus_attach_args *ea = aux;
135 1.2.4.2 yamt
136 1.2.4.2 yamt if (strcmp(ea->ea_name, "psm") != 0)
137 1.2.4.2 yamt return (0);
138 1.2.4.2 yamt return (1);
139 1.2.4.2 yamt }
140 1.2.4.2 yamt
141 1.2.4.3 yamt void
142 1.2.4.2 yamt psm_attach(struct device *parent, struct device *self, void *aux)
143 1.2.4.2 yamt {
144 1.2.4.2 yamt struct psm_softc *sc = (struct psm_softc *)self;
145 1.2.4.2 yamt struct ebus_attach_args *ea = aux;
146 1.2.4.2 yamt bus_addr_t devaddr;
147 1.2.4.2 yamt char *xname;
148 1.2.4.2 yamt
149 1.2.4.2 yamt xname = sc->sc_dev.dv_xname;
150 1.2.4.2 yamt
151 1.2.4.2 yamt sc->sc_memt = ea->ea_bustag;
152 1.2.4.2 yamt devaddr = EBUS_ADDR_FROM_REG(&ea->ea_reg[0]);
153 1.2.4.2 yamt
154 1.2.4.2 yamt if (bus_space_map(sc->sc_memt, devaddr, ea->ea_reg[0].size,
155 1.2.4.2 yamt 0, &sc->sc_memh) != 0) {
156 1.2.4.2 yamt printf(": unable to map device registers\n");
157 1.2.4.2 yamt return;
158 1.2.4.2 yamt }
159 1.2.4.2 yamt if (psm_init(sc) != 0) {
160 1.2.4.2 yamt printf(": unable to initialize device\n");
161 1.2.4.2 yamt return;
162 1.2.4.2 yamt }
163 1.2.4.2 yamt
164 1.2.4.2 yamt printf(": UltraBook IIi power control\n");
165 1.2.4.2 yamt
166 1.2.4.2 yamt psm_sysmon_setup(sc);
167 1.2.4.2 yamt
168 1.2.4.2 yamt /* create the event thread */
169 1.2.4.2 yamt kthread_create(psm_create_event_thread, sc);
170 1.2.4.2 yamt
171 1.2.4.2 yamt /*
172 1.2.4.2 yamt * Establish device interrupts
173 1.2.4.2 yamt */
174 1.2.4.2 yamt (void) bus_intr_establish(sc->sc_memt, ea->ea_intr[0], IPL_HIGH,
175 1.2.4.2 yamt psm_intr, sc);
176 1.2.4.2 yamt evcnt_attach_dynamic(&sc->sc_intrcnt, EVCNT_TYPE_INTR, NULL,
177 1.2.4.2 yamt sc->sc_dev.dv_xname, "intr");
178 1.2.4.2 yamt }
179 1.2.4.2 yamt
180 1.2.4.2 yamt /*
181 1.2.4.2 yamt * Register sensors and events with sysmon.
182 1.2.4.2 yamt */
183 1.2.4.2 yamt void
184 1.2.4.2 yamt psm_sysmon_setup(struct psm_softc *sc)
185 1.2.4.2 yamt {
186 1.2.4.2 yamt const char *xname = sc->sc_dev.dv_xname;
187 1.2.4.2 yamt
188 1.2.4.2 yamt
189 1.2.4.2 yamt /*
190 1.2.4.2 yamt * XXX: Register sysmon environment.
191 1.2.4.2 yamt */
192 1.2.4.2 yamt
193 1.2.4.2 yamt /*
194 1.2.4.2 yamt * Register sysmon events
195 1.2.4.2 yamt */
196 1.2.4.2 yamt sc->sc_sm_pbutton.smpsw_name = xname;
197 1.2.4.2 yamt sc->sc_sm_pbutton.smpsw_type = PSWITCH_TYPE_POWER;
198 1.2.4.2 yamt if (sysmon_pswitch_register(&sc->sc_sm_pbutton) != 0)
199 1.2.4.2 yamt printf("%s: unable to register power button\n", xname);
200 1.2.4.2 yamt
201 1.2.4.2 yamt sc->sc_sm_lid.smpsw_name = xname;
202 1.2.4.2 yamt sc->sc_sm_lid.smpsw_type = PSWITCH_TYPE_LID;
203 1.2.4.2 yamt if (sysmon_pswitch_register(&sc->sc_sm_lid) != 0)
204 1.2.4.2 yamt printf("%s: unable to register lid switch\n", xname);
205 1.2.4.2 yamt
206 1.2.4.2 yamt sc->sc_sm_ac.smpsw_name = xname;
207 1.2.4.2 yamt sc->sc_sm_ac.smpsw_type = PSWITCH_TYPE_ACADAPTER;
208 1.2.4.2 yamt if (sysmon_pswitch_register(&sc->sc_sm_ac) != 0)
209 1.2.4.2 yamt printf("%s: unable to register AC adapter\n", xname);
210 1.2.4.2 yamt }
211 1.2.4.2 yamt
212 1.2.4.2 yamt void
213 1.2.4.2 yamt psm_create_event_thread(void *arg)
214 1.2.4.2 yamt {
215 1.2.4.2 yamt struct psm_softc *sc = arg;
216 1.2.4.2 yamt
217 1.2.4.2 yamt if (kthread_create1(psm_event_thread, sc, &sc->sc_thread, "%s",
218 1.2.4.2 yamt sc->sc_dev.dv_xname) != 0) {
219 1.2.4.2 yamt printf("%s: unable to create event kthread\n",
220 1.2.4.2 yamt sc->sc_dev.dv_xname);
221 1.2.4.2 yamt }
222 1.2.4.2 yamt }
223 1.2.4.2 yamt
224 1.2.4.2 yamt void
225 1.2.4.2 yamt psm_event_thread(void *arg)
226 1.2.4.2 yamt {
227 1.2.4.2 yamt struct psm_softc *sc = arg;
228 1.2.4.2 yamt int x;
229 1.2.4.2 yamt int event;
230 1.2.4.2 yamt int flags;
231 1.2.4.2 yamt
232 1.2.4.2 yamt for (;;) {
233 1.2.4.2 yamt x = splhigh();
234 1.2.4.2 yamt /* check for AC power. sets event if there is a change */
235 1.2.4.2 yamt psm_poll_acpower(sc);
236 1.2.4.2 yamt
237 1.2.4.2 yamt /* read and clear events */
238 1.2.4.2 yamt event = sc->sc_event;
239 1.2.4.2 yamt flags = sc->sc_flags;
240 1.2.4.2 yamt sc->sc_event = 0;
241 1.2.4.2 yamt splx(x);
242 1.2.4.2 yamt
243 1.2.4.2 yamt if (event & PSM_EV_PBUTTON) {
244 1.2.4.2 yamt sysmon_pswitch_event(&sc->sc_sm_pbutton,
245 1.2.4.2 yamt PSWITCH_EVENT_PRESSED);
246 1.2.4.2 yamt }
247 1.2.4.2 yamt
248 1.2.4.2 yamt if (event & PSM_EV_LID) {
249 1.2.4.2 yamt sysmon_pswitch_event(&sc->sc_sm_lid,
250 1.2.4.2 yamt flags & PSM_FLAG_LIDCLOSED ?
251 1.2.4.2 yamt PSWITCH_STATE_PRESSED : PSWITCH_STATE_RELEASED);
252 1.2.4.2 yamt }
253 1.2.4.2 yamt
254 1.2.4.2 yamt if (event & PSM_EV_ACPWR) {
255 1.2.4.2 yamt sysmon_pswitch_event(&sc->sc_sm_ac,
256 1.2.4.2 yamt flags & PSM_FLAG_ACPWR ?
257 1.2.4.2 yamt PSWITCH_STATE_PRESSED : PSWITCH_STATE_RELEASED);
258 1.2.4.2 yamt }
259 1.2.4.2 yamt
260 1.2.4.2 yamt /* XXX: handle PSM_EV_TEMP */
261 1.2.4.2 yamt
262 1.2.4.2 yamt /* one second interval between probes of power */
263 1.2.4.2 yamt tsleep(&sc, PWAIT, "psm", hz);
264 1.2.4.2 yamt }
265 1.2.4.2 yamt }
266 1.2.4.2 yamt
267 1.2.4.2 yamt int
268 1.2.4.2 yamt psm_init(struct psm_softc *sc)
269 1.2.4.2 yamt {
270 1.2.4.2 yamt int x;
271 1.2.4.2 yamt uint8_t batt = 0xff; /* keep GCC 4.x happy */
272 1.2.4.2 yamt
273 1.2.4.2 yamt /* clear interrupts */
274 1.2.4.2 yamt x = splhigh();
275 1.2.4.2 yamt PUT8(sc, PSM_ICR, 0xff);
276 1.2.4.2 yamt splx(x);
277 1.2.4.2 yamt
278 1.2.4.2 yamt /* enable interrupts */
279 1.2.4.2 yamt if (psm_misc_wr(sc, PSM_MISC_IMR, PSM_IMR_ALL))
280 1.2.4.2 yamt return (-1);
281 1.2.4.2 yamt
282 1.2.4.2 yamt /* make sure that UPS battery is reasonable */
283 1.2.4.2 yamt if (psm_misc_rd(sc, PSM_MISC_UPS, &batt) || (batt > PSM_MAX_BATTERIES))
284 1.2.4.2 yamt if (psm_misc_wr(sc, PSM_MISC_UPS, batt))
285 1.2.4.2 yamt printf("%s: cannot set UPS battery",
286 1.2.4.2 yamt sc->sc_dev.dv_xname);
287 1.2.4.2 yamt
288 1.2.4.2 yamt return (0);
289 1.2.4.2 yamt }
290 1.2.4.2 yamt
291 1.2.4.2 yamt void
292 1.2.4.2 yamt psm_reset(struct psm_softc *sc)
293 1.2.4.2 yamt {
294 1.2.4.2 yamt
295 1.2.4.2 yamt PUT8(sc, PSM_MCR, PSM_MCR_RST);
296 1.2.4.2 yamt delay(RESET_DELAY);
297 1.2.4.2 yamt }
298 1.2.4.2 yamt
299 1.2.4.2 yamt void
300 1.2.4.2 yamt psm_poll_acpower(struct psm_softc *sc)
301 1.2.4.2 yamt {
302 1.2.4.2 yamt int flags = sc->sc_flags;
303 1.2.4.2 yamt
304 1.2.4.2 yamt if (GET8(sc, PSM_STAT) & PSM_STAT_AC) {
305 1.2.4.2 yamt sc->sc_flags |= PSM_FLAG_ACPWR;
306 1.2.4.2 yamt } else {
307 1.2.4.2 yamt sc->sc_flags &= ~PSM_FLAG_ACPWR;
308 1.2.4.2 yamt }
309 1.2.4.2 yamt if (flags != sc->sc_flags)
310 1.2.4.2 yamt sc->sc_event |= PSM_EV_ACPWR;
311 1.2.4.2 yamt }
312 1.2.4.2 yamt
313 1.2.4.2 yamt int
314 1.2.4.2 yamt psm_misc_rd(struct psm_softc *sc, uint8_t mreg, uint8_t *data)
315 1.2.4.2 yamt {
316 1.2.4.2 yamt
317 1.2.4.2 yamt return (psm_ecmd_rd8(sc, data, mreg, PSM_MODE_MISC, 0));
318 1.2.4.2 yamt }
319 1.2.4.2 yamt
320 1.2.4.2 yamt int
321 1.2.4.2 yamt psm_misc_wr(struct psm_softc *sc, uint8_t mreg, uint8_t data)
322 1.2.4.2 yamt {
323 1.2.4.2 yamt
324 1.2.4.2 yamt return (psm_ecmd_wr8(sc, data, mreg, PSM_MODE_MISC, 0));
325 1.2.4.2 yamt }
326 1.2.4.2 yamt
327 1.2.4.2 yamt int
328 1.2.4.2 yamt psm_wait(struct psm_softc *sc, uint8_t flag)
329 1.2.4.2 yamt {
330 1.2.4.2 yamt int retr = WAIT_RETRIES;
331 1.2.4.2 yamt
332 1.2.4.2 yamt while (GET8(sc, PSM_STAT) & flag) {
333 1.2.4.2 yamt if (!(retr--)) {
334 1.2.4.2 yamt return (-1);
335 1.2.4.2 yamt }
336 1.2.4.2 yamt delay(WAIT_DELAY);
337 1.2.4.2 yamt }
338 1.2.4.2 yamt return (0);
339 1.2.4.2 yamt }
340 1.2.4.2 yamt
341 1.2.4.2 yamt #if 0
342 1.2.4.2 yamt int
343 1.2.4.2 yamt psm_ecmd_rd16(struct psm_softc *sc, uint16_t *data, uint8_t iar, uint8_t mode,
344 1.2.4.2 yamt uint8_t addr)
345 1.2.4.2 yamt {
346 1.2.4.2 yamt uint8_t cmr = PSM_CMR_DATA(mode, PSM_L_16, PSM_D_RD, addr);
347 1.2.4.2 yamt int x, rc, retr = CMD_RETRIES;
348 1.2.4.2 yamt
349 1.2.4.2 yamt x = splhigh();
350 1.2.4.2 yamt
351 1.2.4.2 yamt do {
352 1.2.4.2 yamt if ((rc = psm_wait(sc, PSM_STAT_RDA)) != 0) {
353 1.2.4.2 yamt psm_reset(sc);
354 1.2.4.2 yamt continue;
355 1.2.4.2 yamt }
356 1.2.4.2 yamt
357 1.2.4.2 yamt PUT8(sc, PSM_IAR, iar);
358 1.2.4.2 yamt PUT8(sc, PSM_CMR, cmr);
359 1.2.4.2 yamt
360 1.2.4.2 yamt delay(CMD_DELAY);
361 1.2.4.2 yamt
362 1.2.4.2 yamt if ((rc = psm_wait(sc, PSM_STAT_RDA)) == 0) {
363 1.2.4.2 yamt *data = GET8(sc, PSM_PWDL) | (GET8(sc, PSM_PWDU) << 8);
364 1.2.4.2 yamt break;
365 1.2.4.2 yamt }
366 1.2.4.2 yamt
367 1.2.4.2 yamt psm_reset(sc);
368 1.2.4.2 yamt
369 1.2.4.2 yamt } while (--retr);
370 1.2.4.2 yamt
371 1.2.4.2 yamt splx(x);
372 1.2.4.2 yamt return (rc);
373 1.2.4.2 yamt }
374 1.2.4.2 yamt #endif
375 1.2.4.2 yamt
376 1.2.4.2 yamt int
377 1.2.4.2 yamt psm_ecmd_rd8(struct psm_softc *sc, uint8_t *data, uint8_t iar, uint8_t mode,
378 1.2.4.2 yamt uint8_t addr)
379 1.2.4.2 yamt {
380 1.2.4.2 yamt uint8_t cmr = PSM_CMR_DATA(mode, PSM_L_8, PSM_D_RD, addr);
381 1.2.4.2 yamt int x, rc, retr = CMD_RETRIES;
382 1.2.4.2 yamt
383 1.2.4.2 yamt x = splhigh();
384 1.2.4.2 yamt
385 1.2.4.2 yamt do {
386 1.2.4.2 yamt if ((rc = psm_wait(sc, PSM_STAT_RDA)) != 0) {
387 1.2.4.2 yamt psm_reset(sc);
388 1.2.4.2 yamt continue;
389 1.2.4.2 yamt }
390 1.2.4.2 yamt
391 1.2.4.2 yamt PUT8(sc, PSM_IAR, iar);
392 1.2.4.2 yamt PUT8(sc, PSM_CMR, cmr);
393 1.2.4.2 yamt
394 1.2.4.2 yamt delay(CMD_DELAY);
395 1.2.4.2 yamt
396 1.2.4.2 yamt if ((rc = psm_wait(sc, PSM_STAT_RDA)) == 0) {
397 1.2.4.2 yamt (void) GET8(sc, PSM_PWDU);
398 1.2.4.2 yamt *data = GET8(sc, PSM_PWDL);
399 1.2.4.2 yamt break;
400 1.2.4.2 yamt }
401 1.2.4.2 yamt
402 1.2.4.2 yamt psm_reset(sc);
403 1.2.4.2 yamt
404 1.2.4.2 yamt } while (--retr);
405 1.2.4.2 yamt
406 1.2.4.2 yamt splx(x);
407 1.2.4.2 yamt return (rc);
408 1.2.4.2 yamt }
409 1.2.4.2 yamt
410 1.2.4.2 yamt int
411 1.2.4.2 yamt psm_ecmd_wr8(struct psm_softc *sc, uint8_t data, uint8_t iar, uint8_t mode,
412 1.2.4.2 yamt uint8_t addr)
413 1.2.4.2 yamt {
414 1.2.4.2 yamt uint8_t cmr = PSM_CMR_DATA(mode, PSM_L_8, PSM_D_WR, addr);
415 1.2.4.2 yamt int x, rc, retr = CMD_RETRIES;
416 1.2.4.2 yamt
417 1.2.4.2 yamt x = splhigh();
418 1.2.4.2 yamt
419 1.2.4.2 yamt do {
420 1.2.4.2 yamt if ((rc = psm_wait(sc, PSM_STAT_WBF)) != 0) {
421 1.2.4.2 yamt psm_reset(sc);
422 1.2.4.2 yamt continue;
423 1.2.4.2 yamt }
424 1.2.4.2 yamt
425 1.2.4.2 yamt PUT8(sc, PSM_PWDU, 0);
426 1.2.4.2 yamt PUT8(sc, PSM_PWDL, data);
427 1.2.4.2 yamt PUT8(sc, PSM_IAR, iar);
428 1.2.4.2 yamt PUT8(sc, PSM_CMR, cmr);
429 1.2.4.2 yamt
430 1.2.4.2 yamt delay(CMD_DELAY);
431 1.2.4.2 yamt
432 1.2.4.2 yamt if ((rc = psm_wait(sc, PSM_STAT_WBF)) == 0) {
433 1.2.4.2 yamt break;
434 1.2.4.2 yamt }
435 1.2.4.2 yamt
436 1.2.4.2 yamt psm_reset(sc);
437 1.2.4.2 yamt } while (--retr);
438 1.2.4.2 yamt
439 1.2.4.2 yamt splx(x);
440 1.2.4.2 yamt
441 1.2.4.2 yamt return (rc);
442 1.2.4.2 yamt }
443 1.2.4.2 yamt
444 1.2.4.2 yamt int
445 1.2.4.2 yamt psm_intr(void *arg)
446 1.2.4.2 yamt {
447 1.2.4.2 yamt struct psm_softc *sc = arg;
448 1.2.4.2 yamt uint8_t isr;
449 1.2.4.2 yamt
450 1.2.4.2 yamt isr = GET8(sc, PSM_ISR);
451 1.2.4.2 yamt if (isr & PSM_ISR_PO) {
452 1.2.4.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_PO);
453 1.2.4.2 yamt sc->sc_event |= PSM_EV_PBUTTON;
454 1.2.4.2 yamt }
455 1.2.4.2 yamt if (isr & PSM_ISR_DK) {
456 1.2.4.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_DK);
457 1.2.4.2 yamt sc->sc_flags |= PSM_FLAG_DOCKED;
458 1.2.4.2 yamt }
459 1.2.4.2 yamt if (isr & PSM_ISR_UDK) {
460 1.2.4.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_UDK);
461 1.2.4.2 yamt sc->sc_flags &= ~PSM_FLAG_DOCKED;
462 1.2.4.2 yamt }
463 1.2.4.2 yamt if (isr & PSM_ISR_LIDC) {
464 1.2.4.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_LIDC);
465 1.2.4.2 yamt sc->sc_flags |= PSM_FLAG_LIDCLOSED;
466 1.2.4.2 yamt sc->sc_event |= PSM_EV_LID;
467 1.2.4.2 yamt }
468 1.2.4.2 yamt if (isr & PSM_ISR_LIDO) {
469 1.2.4.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_LIDO);
470 1.2.4.2 yamt sc->sc_flags &= ~PSM_FLAG_LIDCLOSED;
471 1.2.4.2 yamt sc->sc_event |= PSM_EV_LID;
472 1.2.4.2 yamt }
473 1.2.4.2 yamt if (isr & PSM_ISR_TMP) {
474 1.2.4.2 yamt /* Over temperature */
475 1.2.4.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_TMP);
476 1.2.4.2 yamt sc->sc_event |= PSM_EV_TEMP;
477 1.2.4.2 yamt }
478 1.2.4.2 yamt if (isr & PSM_ISR_BCC) {
479 1.2.4.2 yamt /* battery config changed */
480 1.2.4.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_BCC);
481 1.2.4.2 yamt sc->sc_event |= PSM_EV_BATT;
482 1.2.4.2 yamt }
483 1.2.4.2 yamt if (isr & PSM_ISR_RPD) {
484 1.2.4.2 yamt /* request to power down */
485 1.2.4.2 yamt sc->sc_event |= PSM_EV_PBUTTON;
486 1.2.4.2 yamt }
487 1.2.4.2 yamt if (sc->sc_event) {
488 1.2.4.2 yamt /* wake up the thread */
489 1.2.4.2 yamt wakeup(sc);
490 1.2.4.2 yamt }
491 1.2.4.2 yamt return (1);
492 1.2.4.2 yamt }
493