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