pm_direct.c revision 1.25 1 1.25 briggs /* $NetBSD: pm_direct.c,v 1.25 2005/02/01 03:24:29 briggs Exp $ */
2 1.1 tsubai
3 1.1 tsubai /*
4 1.1 tsubai * Copyright (C) 1997 Takashi Hamada
5 1.1 tsubai * All rights reserved.
6 1.1 tsubai *
7 1.1 tsubai * Redistribution and use in source and binary forms, with or without
8 1.1 tsubai * modification, are permitted provided that the following conditions
9 1.1 tsubai * are met:
10 1.1 tsubai * 1. Redistributions of source code must retain the above copyright
11 1.1 tsubai * notice, this list of conditions and the following disclaimer.
12 1.1 tsubai * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 tsubai * notice, this list of conditions and the following disclaimer in the
14 1.1 tsubai * documentation and/or other materials provided with the distribution.
15 1.1 tsubai * 3. All advertising materials mentioning features or use of this software
16 1.1 tsubai * must display the following acknowledgement:
17 1.1 tsubai * This product includes software developed by Takashi Hamada
18 1.1 tsubai * 4. The name of the author may not be used to endorse or promote products
19 1.1 tsubai * derived from this software without specific prior written permission.
20 1.1 tsubai *
21 1.1 tsubai * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
22 1.1 tsubai * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
23 1.1 tsubai * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
24 1.1 tsubai * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
25 1.1 tsubai * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
26 1.1 tsubai * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 1.1 tsubai * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 1.1 tsubai * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 1.1 tsubai * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
30 1.1 tsubai * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 1.1 tsubai */
32 1.1 tsubai /* From: pm_direct.c 1.3 03/18/98 Takashi Hamada */
33 1.20 lukem
34 1.21 briggs /*
35 1.21 briggs * TODO : Check bounds on PMData in pmgrop
36 1.21 briggs * callers should specify how much room for data is in the buffer
37 1.21 briggs * and that should be respected by the pmgrop
38 1.21 briggs */
39 1.21 briggs
40 1.20 lukem #include <sys/cdefs.h>
41 1.25 briggs __KERNEL_RCSID(0, "$NetBSD: pm_direct.c,v 1.25 2005/02/01 03:24:29 briggs Exp $");
42 1.1 tsubai
43 1.1 tsubai #ifdef DEBUG
44 1.1 tsubai #ifndef ADB_DEBUG
45 1.1 tsubai #define ADB_DEBUG
46 1.1 tsubai #endif
47 1.1 tsubai #endif
48 1.1 tsubai
49 1.1 tsubai /* #define PM_GRAB_SI 1 */
50 1.1 tsubai
51 1.1 tsubai #include <sys/param.h>
52 1.1 tsubai #include <sys/cdefs.h>
53 1.1 tsubai #include <sys/device.h>
54 1.1 tsubai #include <sys/systm.h>
55 1.1 tsubai
56 1.1 tsubai #include <machine/adbsys.h>
57 1.23 briggs #include <machine/autoconf.h>
58 1.1 tsubai #include <machine/cpu.h>
59 1.1 tsubai
60 1.23 briggs #include <dev/ofw/openfirm.h>
61 1.23 briggs
62 1.1 tsubai #include <macppc/dev/adbvar.h>
63 1.1 tsubai #include <macppc/dev/pm_direct.h>
64 1.1 tsubai #include <macppc/dev/viareg.h>
65 1.1 tsubai
66 1.1 tsubai extern int adb_polling; /* Are we polling? (Debugger mode) */
67 1.1 tsubai
68 1.1 tsubai /* hardware dependent values */
69 1.1 tsubai #define ADBDelay 100 /* XXX */
70 1.1 tsubai
71 1.1 tsubai /* useful macros */
72 1.1 tsubai #define PM_SR() read_via_reg(VIA1, vSR)
73 1.1 tsubai #define PM_VIA_INTR_ENABLE() write_via_reg(VIA1, vIER, 0x90)
74 1.1 tsubai #define PM_VIA_INTR_DISABLE() write_via_reg(VIA1, vIER, 0x10)
75 1.1 tsubai #define PM_VIA_CLR_INTR() write_via_reg(VIA1, vIFR, 0x90)
76 1.25 briggs
77 1.1 tsubai #define PM_SET_STATE_ACKON() via_reg_or(VIA2, vBufB, 0x10)
78 1.1 tsubai #define PM_SET_STATE_ACKOFF() via_reg_and(VIA2, vBufB, ~0x10)
79 1.1 tsubai #define PM_IS_ON (0x08 == (read_via_reg(VIA2, vBufB) & 0x08))
80 1.1 tsubai #define PM_IS_OFF (0x00 == (read_via_reg(VIA2, vBufB) & 0x08))
81 1.1 tsubai
82 1.1 tsubai /*
83 1.1 tsubai * Variables for internal use
84 1.1 tsubai */
85 1.1 tsubai u_short pm_existent_ADB_devices = 0x0; /* each bit expresses the existent ADB device */
86 1.1 tsubai u_int pm_LCD_brightness = 0x0;
87 1.1 tsubai u_int pm_LCD_contrast = 0x0;
88 1.1 tsubai u_int pm_counter = 0; /* clock count */
89 1.1 tsubai
90 1.23 briggs static enum batt_type { BATT_COMET, BATT_HOOPER, BATT_SMART } pmu_batt_type;
91 1.23 briggs static int pmu_nbatt;
92 1.23 briggs static int strinlist(char *, char *, int);
93 1.23 briggs static enum pmu_type { PMU_UNKNOWN, PMU_OHARE, PMU_G3, PMU_KEYLARGO } pmu_type;
94 1.23 briggs
95 1.1 tsubai /* these values shows that number of data returned after 'send' cmd is sent */
96 1.1 tsubai signed char pm_send_cmd_type[] = {
97 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
98 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
99 1.1 tsubai 0x01, 0x01, -1, -1, -1, -1, -1, -1,
100 1.1 tsubai 0x00, 0x00, -1, -1, -1, -1, -1, 0x00,
101 1.1 tsubai -1, 0x00, 0x02, 0x01, 0x01, -1, -1, -1,
102 1.1 tsubai 0x00, -1, -1, -1, -1, -1, -1, -1,
103 1.5 tsubai 0x04, 0x14, -1, 0x03, -1, -1, -1, -1,
104 1.5 tsubai 0x00, 0x00, 0x02, 0x02, -1, -1, -1, -1,
105 1.1 tsubai 0x01, 0x01, -1, -1, -1, -1, -1, -1,
106 1.7 tsubai 0x00, 0x00, -1, -1, 0x01, -1, -1, -1,
107 1.1 tsubai 0x01, 0x00, 0x02, 0x02, -1, 0x01, 0x03, 0x01,
108 1.1 tsubai 0x00, 0x01, 0x00, 0x00, 0x00, -1, -1, -1,
109 1.1 tsubai 0x02, -1, -1, -1, -1, -1, -1, -1,
110 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -1, -1,
111 1.1 tsubai 0x01, 0x01, 0x01, -1, -1, -1, -1, -1,
112 1.1 tsubai 0x00, 0x00, -1, -1, -1, -1, 0x04, 0x04,
113 1.1 tsubai 0x04, -1, 0x00, -1, -1, -1, -1, -1,
114 1.1 tsubai 0x00, -1, -1, -1, -1, -1, -1, -1,
115 1.1 tsubai 0x01, 0x02, -1, -1, -1, -1, -1, -1,
116 1.1 tsubai 0x00, 0x00, -1, -1, -1, -1, -1, -1,
117 1.1 tsubai 0x02, 0x02, 0x02, 0x04, -1, 0x00, -1, -1,
118 1.1 tsubai 0x01, 0x01, 0x03, 0x02, -1, -1, -1, -1,
119 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
120 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
121 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
122 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
123 1.1 tsubai 0x00, -1, -1, -1, -1, -1, -1, -1,
124 1.1 tsubai 0x01, 0x01, -1, -1, 0x00, 0x00, -1, -1,
125 1.1 tsubai -1, 0x04, 0x00, -1, -1, -1, -1, -1,
126 1.1 tsubai 0x03, -1, 0x00, -1, 0x00, -1, -1, 0x00,
127 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
128 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1
129 1.1 tsubai };
130 1.1 tsubai
131 1.1 tsubai /* these values shows that number of data returned after 'receive' cmd is sent */
132 1.1 tsubai signed char pm_receive_cmd_type[] = {
133 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
134 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
135 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
136 1.1 tsubai 0x02, 0x02, -1, -1, -1, -1, -1, 0x00,
137 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
138 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
139 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
140 1.5 tsubai 0x05, 0x15, -1, 0x02, -1, -1, -1, -1,
141 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
142 1.1 tsubai 0x02, 0x02, -1, -1, -1, -1, -1, -1,
143 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
144 1.1 tsubai 0x02, 0x00, 0x03, 0x03, -1, -1, -1, -1,
145 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
146 1.1 tsubai 0x04, 0x04, 0x03, 0x09, -1, -1, -1, -1,
147 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
148 1.1 tsubai -1, -1, -1, -1, -1, -1, 0x01, 0x01,
149 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
150 1.1 tsubai 0x06, -1, -1, -1, -1, -1, -1, -1,
151 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
152 1.1 tsubai 0x02, 0x02, -1, -1, -1, -1, -1, -1,
153 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
154 1.1 tsubai 0x02, 0x00, 0x00, 0x00, -1, -1, -1, -1,
155 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
156 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
157 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
158 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
159 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
160 1.1 tsubai 0x02, 0x02, -1, -1, 0x02, -1, -1, -1,
161 1.1 tsubai 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
162 1.1 tsubai -1, -1, 0x02, -1, -1, -1, -1, 0x00,
163 1.1 tsubai 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
164 1.1 tsubai -1, -1, -1, -1, -1, -1, -1, -1,
165 1.1 tsubai };
166 1.1 tsubai
167 1.1 tsubai
168 1.1 tsubai /*
169 1.1 tsubai * Define the private functions
170 1.1 tsubai */
171 1.1 tsubai
172 1.1 tsubai /* for debugging */
173 1.1 tsubai #ifdef ADB_DEBUG
174 1.1 tsubai void pm_printerr __P((char *, int, int, char *));
175 1.1 tsubai #endif
176 1.1 tsubai
177 1.1 tsubai int pm_wait_busy __P((int));
178 1.1 tsubai int pm_wait_free __P((int));
179 1.1 tsubai
180 1.25 briggs static int pm_receive __P((u_char *));
181 1.25 briggs static int pm_send __P((u_char));
182 1.1 tsubai
183 1.1 tsubai /* these functions are called from adb_direct.c */
184 1.1 tsubai void pm_setup_adb __P((void));
185 1.1 tsubai void pm_check_adb_devices __P((int));
186 1.1 tsubai int pm_adb_op __P((u_char *, void *, void *, int));
187 1.1 tsubai
188 1.1 tsubai /* these functions also use the variables of adb_direct.c */
189 1.1 tsubai void pm_adb_get_TALK_result __P((PMData *));
190 1.1 tsubai void pm_adb_get_ADB_data __P((PMData *));
191 1.1 tsubai
192 1.1 tsubai
193 1.1 tsubai /*
194 1.1 tsubai * These variables are in adb_direct.c.
195 1.1 tsubai */
196 1.1 tsubai extern u_char *adbBuffer; /* pointer to user data area */
197 1.1 tsubai extern void *adbCompRout; /* pointer to the completion routine */
198 1.1 tsubai extern void *adbCompData; /* pointer to the completion routine data */
199 1.1 tsubai extern int adbWaiting; /* waiting for return data from the device */
200 1.1 tsubai extern int adbWaitingCmd; /* ADB command we are waiting for */
201 1.1 tsubai extern int adbStarting; /* doing ADB reinit, so do "polling" differently */
202 1.1 tsubai
203 1.1 tsubai #define ADB_MAX_MSG_LENGTH 16
204 1.1 tsubai #define ADB_MAX_HDR_LENGTH 8
205 1.1 tsubai struct adbCommand {
206 1.1 tsubai u_char header[ADB_MAX_HDR_LENGTH]; /* not used yet */
207 1.1 tsubai u_char data[ADB_MAX_MSG_LENGTH]; /* packet data only */
208 1.1 tsubai u_char *saveBuf; /* where to save result */
209 1.1 tsubai u_char *compRout; /* completion routine pointer */
210 1.1 tsubai u_char *compData; /* completion routine data pointer */
211 1.1 tsubai u_int cmd; /* the original command for this data */
212 1.1 tsubai u_int unsol; /* 1 if packet was unsolicited */
213 1.1 tsubai u_int ack_only; /* 1 for no special processing */
214 1.1 tsubai };
215 1.1 tsubai extern void adb_pass_up __P((struct adbCommand *));
216 1.1 tsubai
217 1.1 tsubai #if 0
218 1.1 tsubai /*
219 1.1 tsubai * Define the external functions
220 1.1 tsubai */
221 1.1 tsubai extern int zshard __P((int)); /* from zs.c */
222 1.1 tsubai #endif
223 1.1 tsubai
224 1.1 tsubai #ifdef ADB_DEBUG
225 1.1 tsubai /*
226 1.1 tsubai * This function dumps contents of the PMData
227 1.1 tsubai */
228 1.1 tsubai void
229 1.1 tsubai pm_printerr(ttl, rval, num, data)
230 1.1 tsubai char *ttl;
231 1.1 tsubai int rval;
232 1.1 tsubai int num;
233 1.1 tsubai char *data;
234 1.1 tsubai {
235 1.1 tsubai int i;
236 1.1 tsubai
237 1.1 tsubai printf("pm: %s:%04x %02x ", ttl, rval, num);
238 1.1 tsubai for (i = 0; i < num; i++)
239 1.1 tsubai printf("%02x ", data[i]);
240 1.1 tsubai printf("\n");
241 1.1 tsubai }
242 1.1 tsubai #endif
243 1.1 tsubai
244 1.1 tsubai
245 1.1 tsubai
246 1.1 tsubai /*
247 1.1 tsubai * Check the hardware type of the Power Manager
248 1.1 tsubai */
249 1.1 tsubai void
250 1.1 tsubai pm_setup_adb()
251 1.1 tsubai {
252 1.1 tsubai }
253 1.1 tsubai
254 1.23 briggs static int
255 1.23 briggs strinlist(char *targ, char *list, int listlen)
256 1.23 briggs {
257 1.23 briggs char *str;
258 1.23 briggs int sl;
259 1.23 briggs
260 1.23 briggs str = list;
261 1.23 briggs while (listlen > 0) {
262 1.23 briggs sl = strlen(str);
263 1.23 briggs if (strncmp(targ, str, sl) == 0)
264 1.23 briggs return 1;
265 1.23 briggs str += sl+1;
266 1.23 briggs listlen -= sl+1;
267 1.23 briggs }
268 1.23 briggs return 0;
269 1.23 briggs }
270 1.23 briggs
271 1.23 briggs /*
272 1.23 briggs * Check the hardware type of the Power Manager
273 1.23 briggs */
274 1.23 briggs void
275 1.23 briggs pm_init(void)
276 1.23 briggs {
277 1.23 briggs uint32_t regs[10];
278 1.23 briggs PMData pmdata;
279 1.23 briggs char compat[128];
280 1.23 briggs int clen, node, imask;
281 1.23 briggs
282 1.23 briggs node = OF_peer(0);
283 1.23 briggs if (node == -1) {
284 1.23 briggs printf("pmu: Failed to get root");
285 1.23 briggs return;
286 1.23 briggs }
287 1.23 briggs clen = OF_getprop(node, "compatible", compat, sizeof(compat));
288 1.23 briggs if (clen <= 0) {
289 1.23 briggs printf("pmu: failed to read root compatible data %d\n", clen);
290 1.23 briggs return;
291 1.23 briggs }
292 1.23 briggs
293 1.23 briggs imask = PMU_INT_PCEJECT | PMU_INT_SNDBRT | PMU_INT_ADB | PMU_INT_TICK;
294 1.23 briggs
295 1.23 briggs if (strinlist("AAPL,3500", compat, clen) ||
296 1.23 briggs strinlist("AAPL,3400/2400", compat, clen)) {
297 1.23 briggs /* How to distinguish BATT_COMET? */
298 1.23 briggs pmu_nbatt = 1;
299 1.23 briggs pmu_batt_type = BATT_HOOPER;
300 1.23 briggs pmu_type = PMU_OHARE;
301 1.23 briggs } else if (strinlist("AAPL,PowerBook1998", compat, clen) ||
302 1.23 briggs strinlist("PowerBook1,1", compat, clen)) {
303 1.23 briggs pmu_nbatt = 2;
304 1.23 briggs pmu_batt_type = BATT_SMART;
305 1.23 briggs pmu_type = PMU_G3;
306 1.23 briggs } else {
307 1.23 briggs pmu_nbatt = 1;
308 1.23 briggs pmu_batt_type = BATT_SMART;
309 1.23 briggs pmu_type = PMU_KEYLARGO;
310 1.23 briggs node = getnodebyname(0, "power-mgt");
311 1.23 briggs if (node == -1) {
312 1.23 briggs printf("pmu: can't find power-mgt\n");
313 1.23 briggs return;
314 1.23 briggs }
315 1.23 briggs clen = OF_getprop(node, "prim-info", regs, sizeof(regs));
316 1.23 briggs if (clen < 24) {
317 1.23 briggs printf("pmu: failed to read prim-info\n");
318 1.23 briggs return;
319 1.23 briggs }
320 1.23 briggs pmu_nbatt = regs[6] >> 16;
321 1.23 briggs }
322 1.23 briggs
323 1.23 briggs pmdata.command = PMU_SET_IMASK;
324 1.23 briggs pmdata.num_data = 1;
325 1.23 briggs pmdata.s_buf = pmdata.data;
326 1.23 briggs pmdata.r_buf = pmdata.data;
327 1.23 briggs pmdata.data[0] = imask;
328 1.23 briggs pmgrop(&pmdata);
329 1.23 briggs }
330 1.23 briggs
331 1.1 tsubai
332 1.1 tsubai /*
333 1.1 tsubai * Check the existent ADB devices
334 1.1 tsubai */
335 1.1 tsubai void
336 1.1 tsubai pm_check_adb_devices(id)
337 1.1 tsubai int id;
338 1.1 tsubai {
339 1.1 tsubai u_short ed = 0x1;
340 1.1 tsubai
341 1.1 tsubai ed <<= id;
342 1.1 tsubai pm_existent_ADB_devices |= ed;
343 1.1 tsubai }
344 1.1 tsubai
345 1.1 tsubai
346 1.1 tsubai /*
347 1.1 tsubai * Wait until PM IC is busy
348 1.1 tsubai */
349 1.1 tsubai int
350 1.1 tsubai pm_wait_busy(delay)
351 1.1 tsubai int delay;
352 1.1 tsubai {
353 1.1 tsubai while (PM_IS_ON) {
354 1.1 tsubai #ifdef PM_GRAB_SI
355 1.1 tsubai #if 0
356 1.1 tsubai zshard(0); /* grab any serial interrupts */
357 1.1 tsubai #else
358 1.1 tsubai (void)intr_dispatch(0x70);
359 1.1 tsubai #endif
360 1.1 tsubai #endif
361 1.1 tsubai if ((--delay) < 0)
362 1.1 tsubai return 1; /* timeout */
363 1.1 tsubai }
364 1.1 tsubai return 0;
365 1.1 tsubai }
366 1.1 tsubai
367 1.1 tsubai
368 1.1 tsubai /*
369 1.1 tsubai * Wait until PM IC is free
370 1.1 tsubai */
371 1.1 tsubai int
372 1.1 tsubai pm_wait_free(delay)
373 1.1 tsubai int delay;
374 1.1 tsubai {
375 1.1 tsubai while (PM_IS_OFF) {
376 1.1 tsubai #ifdef PM_GRAB_SI
377 1.1 tsubai #if 0
378 1.1 tsubai zshard(0); /* grab any serial interrupts */
379 1.1 tsubai #else
380 1.1 tsubai (void)intr_dispatch(0x70);
381 1.1 tsubai #endif
382 1.1 tsubai #endif
383 1.1 tsubai if ((--delay) < 0)
384 1.1 tsubai return 0; /* timeout */
385 1.1 tsubai }
386 1.1 tsubai return 1;
387 1.1 tsubai }
388 1.1 tsubai
389 1.1 tsubai
390 1.1 tsubai
391 1.1 tsubai /*
392 1.25 briggs * Receive data from PMU
393 1.1 tsubai */
394 1.25 briggs static int
395 1.25 briggs pm_receive(data)
396 1.1 tsubai u_char *data;
397 1.1 tsubai {
398 1.1 tsubai int i;
399 1.1 tsubai int rval;
400 1.1 tsubai
401 1.1 tsubai rval = 0xffffcd34;
402 1.1 tsubai
403 1.1 tsubai switch (1) {
404 1.18 itojun default:
405 1.18 itojun /* set VIA SR to input mode */
406 1.18 itojun via_reg_or(VIA1, vACR, 0x0c);
407 1.18 itojun via_reg_and(VIA1, vACR, ~0x10);
408 1.18 itojun i = PM_SR();
409 1.18 itojun
410 1.18 itojun PM_SET_STATE_ACKOFF();
411 1.18 itojun if (pm_wait_busy((int)ADBDelay*32) != 0)
412 1.18 itojun break; /* timeout */
413 1.1 tsubai
414 1.18 itojun PM_SET_STATE_ACKON();
415 1.18 itojun rval = 0xffffcd33;
416 1.18 itojun if (pm_wait_free((int)ADBDelay*32) == 0)
417 1.18 itojun break; /* timeout */
418 1.1 tsubai
419 1.18 itojun *data = PM_SR();
420 1.18 itojun rval = 0;
421 1.1 tsubai
422 1.18 itojun break;
423 1.1 tsubai }
424 1.1 tsubai
425 1.1 tsubai PM_SET_STATE_ACKON();
426 1.1 tsubai via_reg_or(VIA1, vACR, 0x1c);
427 1.1 tsubai
428 1.1 tsubai return rval;
429 1.1 tsubai }
430 1.1 tsubai
431 1.1 tsubai
432 1.1 tsubai
433 1.1 tsubai /*
434 1.25 briggs * Send data to PMU
435 1.1 tsubai */
436 1.25 briggs static int
437 1.25 briggs pm_send(data)
438 1.1 tsubai u_char data;
439 1.1 tsubai {
440 1.1 tsubai int rval;
441 1.1 tsubai
442 1.1 tsubai via_reg_or(VIA1, vACR, 0x1c);
443 1.1 tsubai write_via_reg(VIA1, vSR, data); /* PM_SR() = data; */
444 1.1 tsubai
445 1.1 tsubai PM_SET_STATE_ACKOFF();
446 1.1 tsubai rval = 0xffffcd36;
447 1.1 tsubai if (pm_wait_busy((int)ADBDelay*32) != 0) {
448 1.1 tsubai PM_SET_STATE_ACKON();
449 1.1 tsubai
450 1.1 tsubai via_reg_or(VIA1, vACR, 0x1c);
451 1.1 tsubai
452 1.1 tsubai return rval;
453 1.1 tsubai }
454 1.1 tsubai
455 1.1 tsubai PM_SET_STATE_ACKON();
456 1.1 tsubai rval = 0xffffcd35;
457 1.1 tsubai if (pm_wait_free((int)ADBDelay*32) != 0)
458 1.1 tsubai rval = 0;
459 1.1 tsubai
460 1.1 tsubai PM_SET_STATE_ACKON();
461 1.1 tsubai via_reg_or(VIA1, vACR, 0x1c);
462 1.1 tsubai
463 1.1 tsubai return rval;
464 1.1 tsubai }
465 1.1 tsubai
466 1.1 tsubai
467 1.1 tsubai
468 1.1 tsubai /*
469 1.25 briggs * The PMgrOp routine
470 1.1 tsubai */
471 1.1 tsubai int
472 1.25 briggs pmgrop(pmdata)
473 1.1 tsubai PMData *pmdata;
474 1.1 tsubai {
475 1.1 tsubai int i;
476 1.1 tsubai int s;
477 1.1 tsubai u_char via1_vIER;
478 1.1 tsubai int rval = 0;
479 1.1 tsubai int num_pm_data = 0;
480 1.1 tsubai u_char pm_cmd;
481 1.1 tsubai short pm_num_rx_data;
482 1.1 tsubai u_char pm_data;
483 1.1 tsubai u_char *pm_buf;
484 1.1 tsubai
485 1.1 tsubai s = splhigh();
486 1.1 tsubai
487 1.1 tsubai /* disable all inetrrupts but PM */
488 1.1 tsubai via1_vIER = 0x10;
489 1.1 tsubai via1_vIER &= read_via_reg(VIA1, vIER);
490 1.1 tsubai write_via_reg(VIA1, vIER, via1_vIER);
491 1.1 tsubai if (via1_vIER != 0x0)
492 1.1 tsubai via1_vIER |= 0x80;
493 1.1 tsubai
494 1.1 tsubai switch (pmdata->command) {
495 1.18 itojun default:
496 1.18 itojun /* wait until PM is free */
497 1.18 itojun pm_cmd = (u_char)(pmdata->command & 0xff);
498 1.18 itojun rval = 0xcd38;
499 1.18 itojun if (pm_wait_free(ADBDelay * 4) == 0)
500 1.18 itojun break; /* timeout */
501 1.18 itojun
502 1.18 itojun /* send PM command */
503 1.25 briggs if ((rval = pm_send((u_char)(pm_cmd & 0xff))))
504 1.18 itojun break; /* timeout */
505 1.18 itojun
506 1.18 itojun /* send number of PM data */
507 1.18 itojun num_pm_data = pmdata->num_data;
508 1.25 briggs if (pm_send_cmd_type[pm_cmd] < 0) {
509 1.25 briggs if ((rval = pm_send((u_char)(num_pm_data & 0xff))) != 0)
510 1.25 briggs break; /* timeout */
511 1.25 briggs pmdata->command = 0;
512 1.25 briggs }
513 1.18 itojun /* send PM data */
514 1.18 itojun pm_buf = (u_char *)pmdata->s_buf;
515 1.18 itojun for (i = 0 ; i < num_pm_data; i++)
516 1.25 briggs if ((rval = pm_send(pm_buf[i])) != 0)
517 1.18 itojun break; /* timeout */
518 1.18 itojun if (i != num_pm_data)
519 1.18 itojun break; /* timeout */
520 1.1 tsubai
521 1.1 tsubai
522 1.18 itojun /* check if PM will send me data */
523 1.18 itojun pm_num_rx_data = pm_receive_cmd_type[pm_cmd];
524 1.18 itojun pmdata->num_data = pm_num_rx_data;
525 1.18 itojun if (pm_num_rx_data == 0) {
526 1.18 itojun rval = 0;
527 1.18 itojun break; /* no return data */
528 1.18 itojun }
529 1.18 itojun
530 1.18 itojun /* receive PM command */
531 1.18 itojun pm_data = pmdata->command;
532 1.25 briggs pm_num_rx_data--;
533 1.25 briggs if (pm_num_rx_data == 0)
534 1.25 briggs if ((rval = pm_receive(&pm_data)) != 0) {
535 1.18 itojun rval = 0xffffcd37;
536 1.18 itojun break;
537 1.1 tsubai }
538 1.25 briggs pmdata->command = pm_data;
539 1.1 tsubai
540 1.18 itojun /* receive number of PM data */
541 1.25 briggs if (pm_num_rx_data < 0) {
542 1.25 briggs if ((rval = pm_receive(&pm_data)) != 0)
543 1.25 briggs break; /* timeout */
544 1.18 itojun num_pm_data = pm_data;
545 1.25 briggs } else
546 1.25 briggs num_pm_data = pm_num_rx_data;
547 1.25 briggs pmdata->num_data = num_pm_data;
548 1.1 tsubai
549 1.18 itojun /* receive PM data */
550 1.18 itojun pm_buf = (u_char *)pmdata->r_buf;
551 1.18 itojun for (i = 0; i < num_pm_data; i++) {
552 1.25 briggs if ((rval = pm_receive(&pm_data)) != 0)
553 1.18 itojun break; /* timeout */
554 1.18 itojun pm_buf[i] = pm_data;
555 1.18 itojun }
556 1.1 tsubai
557 1.18 itojun rval = 0;
558 1.1 tsubai }
559 1.1 tsubai
560 1.1 tsubai /* restore former value */
561 1.1 tsubai write_via_reg(VIA1, vIER, via1_vIER);
562 1.1 tsubai splx(s);
563 1.1 tsubai
564 1.1 tsubai return rval;
565 1.1 tsubai }
566 1.1 tsubai
567 1.1 tsubai
568 1.1 tsubai /*
569 1.25 briggs * My PMU interrupt routine
570 1.1 tsubai */
571 1.24 briggs int
572 1.25 briggs pm_intr(void *arg)
573 1.1 tsubai {
574 1.1 tsubai int s;
575 1.1 tsubai int rval;
576 1.1 tsubai PMData pmdata;
577 1.1 tsubai
578 1.1 tsubai s = splhigh();
579 1.1 tsubai
580 1.1 tsubai PM_VIA_CLR_INTR(); /* clear VIA1 interrupt */
581 1.1 tsubai /* ask PM what happend */
582 1.23 briggs pmdata.command = PMU_INT_ACK;
583 1.1 tsubai pmdata.num_data = 0;
584 1.1 tsubai pmdata.s_buf = &pmdata.data[2];
585 1.1 tsubai pmdata.r_buf = &pmdata.data[2];
586 1.25 briggs rval = pmgrop(&pmdata);
587 1.1 tsubai if (rval != 0) {
588 1.1 tsubai #ifdef ADB_DEBUG
589 1.1 tsubai if (adb_debug)
590 1.1 tsubai printf("pm: PM is not ready. error code: %08x\n", rval);
591 1.1 tsubai #endif
592 1.1 tsubai splx(s);
593 1.24 briggs return 0;
594 1.1 tsubai }
595 1.1 tsubai
596 1.1 tsubai switch ((u_int)(pmdata.data[2] & 0xff)) {
597 1.21 briggs case 0x00: /* no event pending? */
598 1.18 itojun break;
599 1.18 itojun case 0x80: /* 1 sec interrupt? */
600 1.18 itojun pm_counter++;
601 1.18 itojun break;
602 1.18 itojun case 0x08: /* Brightness/Contrast button on LCD panel */
603 1.18 itojun /* get brightness and contrast of the LCD */
604 1.18 itojun pm_LCD_brightness = (u_int)pmdata.data[3] & 0xff;
605 1.18 itojun pm_LCD_contrast = (u_int)pmdata.data[4] & 0xff;
606 1.25 briggs
607 1.25 briggs /* this is experimental code */
608 1.23 briggs pmdata.command = PMU_SET_BRIGHTNESS;
609 1.18 itojun pmdata.num_data = 1;
610 1.18 itojun pmdata.s_buf = pmdata.data;
611 1.18 itojun pmdata.r_buf = pmdata.data;
612 1.18 itojun pm_LCD_brightness = 0x7f - pm_LCD_brightness / 2;
613 1.18 itojun if (pm_LCD_brightness < 0x08)
614 1.18 itojun pm_LCD_brightness = 0x08;
615 1.18 itojun if (pm_LCD_brightness > 0x78)
616 1.18 itojun pm_LCD_brightness = 0x78;
617 1.18 itojun pmdata.data[0] = pm_LCD_brightness;
618 1.25 briggs rval = pmgrop(&pmdata);
619 1.18 itojun break;
620 1.25 briggs
621 1.23 briggs case 0x10: /* ADB data requested by TALK command */
622 1.18 itojun case 0x14:
623 1.18 itojun pm_adb_get_TALK_result(&pmdata);
624 1.18 itojun break;
625 1.18 itojun case 0x16: /* ADB device event */
626 1.18 itojun case 0x18:
627 1.18 itojun case 0x1e:
628 1.18 itojun pm_adb_get_ADB_data(&pmdata);
629 1.18 itojun break;
630 1.18 itojun default:
631 1.1 tsubai #ifdef ADB_DEBUG
632 1.18 itojun if (adb_debug)
633 1.23 briggs pm_printerr("driver does not support this event.",
634 1.18 itojun pmdata.data[2], pmdata.num_data,
635 1.18 itojun pmdata.data);
636 1.1 tsubai #endif
637 1.18 itojun break;
638 1.1 tsubai }
639 1.1 tsubai
640 1.1 tsubai splx(s);
641 1.24 briggs
642 1.24 briggs return 1;
643 1.1 tsubai }
644 1.1 tsubai
645 1.1 tsubai
646 1.1 tsubai /*
647 1.1 tsubai * Synchronous ADBOp routine for the Power Manager
648 1.1 tsubai */
649 1.1 tsubai int
650 1.1 tsubai pm_adb_op(buffer, compRout, data, command)
651 1.1 tsubai u_char *buffer;
652 1.1 tsubai void *compRout;
653 1.1 tsubai void *data;
654 1.1 tsubai int command;
655 1.1 tsubai {
656 1.1 tsubai int i;
657 1.1 tsubai int s;
658 1.1 tsubai int rval;
659 1.12 tsubai int timo;
660 1.1 tsubai PMData pmdata;
661 1.1 tsubai struct adbCommand packet;
662 1.1 tsubai
663 1.1 tsubai if (adbWaiting == 1)
664 1.1 tsubai return 1;
665 1.1 tsubai
666 1.1 tsubai s = splhigh();
667 1.1 tsubai write_via_reg(VIA1, vIER, 0x10);
668 1.1 tsubai
669 1.1 tsubai adbBuffer = buffer;
670 1.1 tsubai adbCompRout = compRout;
671 1.1 tsubai adbCompData = data;
672 1.1 tsubai
673 1.23 briggs pmdata.command = PMU_ADB_CMD;
674 1.1 tsubai pmdata.s_buf = pmdata.data;
675 1.1 tsubai pmdata.r_buf = pmdata.data;
676 1.1 tsubai
677 1.1 tsubai /* if the command is LISTEN, add number of ADB data to number of PM data */
678 1.1 tsubai if ((command & 0xc) == 0x8) {
679 1.1 tsubai if (buffer != (u_char *)0)
680 1.1 tsubai pmdata.num_data = buffer[0] + 3;
681 1.1 tsubai } else {
682 1.1 tsubai pmdata.num_data = 3;
683 1.1 tsubai }
684 1.1 tsubai
685 1.1 tsubai pmdata.data[0] = (u_char)(command & 0xff);
686 1.1 tsubai pmdata.data[1] = 0;
687 1.1 tsubai if ((command & 0xc) == 0x8) { /* if the command is LISTEN, copy ADB data to PM buffer */
688 1.1 tsubai if ((buffer != (u_char *)0) && (buffer[0] <= 24)) {
689 1.1 tsubai pmdata.data[2] = buffer[0]; /* number of data */
690 1.1 tsubai for (i = 0; i < buffer[0]; i++)
691 1.1 tsubai pmdata.data[3 + i] = buffer[1 + i];
692 1.1 tsubai } else
693 1.1 tsubai pmdata.data[2] = 0;
694 1.1 tsubai } else
695 1.1 tsubai pmdata.data[2] = 0;
696 1.1 tsubai
697 1.1 tsubai if ((command & 0xc) != 0xc) { /* if the command is not TALK */
698 1.1 tsubai /* set up stuff for adb_pass_up */
699 1.1 tsubai packet.data[0] = 1 + pmdata.data[2];
700 1.1 tsubai packet.data[1] = command;
701 1.1 tsubai for (i = 0; i < pmdata.data[2]; i++)
702 1.1 tsubai packet.data[i+2] = pmdata.data[i+3];
703 1.1 tsubai packet.saveBuf = adbBuffer;
704 1.1 tsubai packet.compRout = adbCompRout;
705 1.1 tsubai packet.compData = adbCompData;
706 1.1 tsubai packet.cmd = command;
707 1.1 tsubai packet.unsol = 0;
708 1.1 tsubai packet.ack_only = 1;
709 1.1 tsubai adb_polling = 1;
710 1.1 tsubai adb_pass_up(&packet);
711 1.1 tsubai adb_polling = 0;
712 1.1 tsubai }
713 1.1 tsubai
714 1.1 tsubai rval = pmgrop(&pmdata);
715 1.9 tsubai if (rval != 0) {
716 1.9 tsubai splx(s);
717 1.1 tsubai return 1;
718 1.9 tsubai }
719 1.1 tsubai
720 1.12 tsubai delay(10000);
721 1.12 tsubai
722 1.1 tsubai adbWaiting = 1;
723 1.1 tsubai adbWaitingCmd = command;
724 1.1 tsubai
725 1.1 tsubai PM_VIA_INTR_ENABLE();
726 1.1 tsubai
727 1.16 wiz /* wait until the PM interrupt has occurred */
728 1.12 tsubai timo = 0x80000;
729 1.1 tsubai while (adbWaiting == 1) {
730 1.1 tsubai if (read_via_reg(VIA1, vIFR) & 0x14)
731 1.24 briggs pm_intr(NULL);
732 1.1 tsubai #ifdef PM_GRAB_SI
733 1.1 tsubai #if 0
734 1.1 tsubai zshard(0); /* grab any serial interrupts */
735 1.1 tsubai #else
736 1.1 tsubai (void)intr_dispatch(0x70);
737 1.1 tsubai #endif
738 1.1 tsubai #endif
739 1.12 tsubai if ((--timo) < 0) {
740 1.17 dbj /* Try to take an interrupt anyway, just in case.
741 1.17 dbj * This has been observed to happen on my ibook
742 1.17 dbj * when i press a key after boot and before adb
743 1.17 dbj * is attached; For example, when booting with -d.
744 1.17 dbj */
745 1.24 briggs pm_intr(NULL);
746 1.17 dbj if (adbWaiting) {
747 1.17 dbj printf("pm_adb_op: timeout. command = 0x%x\n",command);
748 1.17 dbj splx(s);
749 1.17 dbj return 1;
750 1.17 dbj }
751 1.17 dbj #ifdef ADB_DEBUG
752 1.17 dbj else {
753 1.17 dbj printf("pm_adb_op: missed interrupt. cmd=0x%x\n",command);
754 1.17 dbj }
755 1.17 dbj #endif
756 1.9 tsubai }
757 1.1 tsubai }
758 1.1 tsubai
759 1.1 tsubai /* this command enables the interrupt by operating ADB devices */
760 1.25 briggs pmdata.command = PMU_ADB_CMD;
761 1.25 briggs pmdata.num_data = 4;
762 1.25 briggs pmdata.s_buf = pmdata.data;
763 1.25 briggs pmdata.r_buf = pmdata.data;
764 1.25 briggs pmdata.data[0] = 0x00;
765 1.25 briggs pmdata.data[1] = 0x86; /* magic spell for awaking the PM */
766 1.25 briggs pmdata.data[2] = 0x00;
767 1.25 briggs pmdata.data[3] = 0x0c; /* each bit may express the existent ADB device */
768 1.1 tsubai rval = pmgrop(&pmdata);
769 1.1 tsubai
770 1.1 tsubai splx(s);
771 1.1 tsubai return rval;
772 1.1 tsubai }
773 1.1 tsubai
774 1.1 tsubai
775 1.1 tsubai void
776 1.1 tsubai pm_adb_get_TALK_result(pmdata)
777 1.1 tsubai PMData *pmdata;
778 1.1 tsubai {
779 1.1 tsubai int i;
780 1.1 tsubai struct adbCommand packet;
781 1.1 tsubai
782 1.1 tsubai /* set up data for adb_pass_up */
783 1.1 tsubai packet.data[0] = pmdata->num_data-1;
784 1.1 tsubai packet.data[1] = pmdata->data[3];
785 1.1 tsubai for (i = 0; i <packet.data[0]-1; i++)
786 1.1 tsubai packet.data[i+2] = pmdata->data[i+4];
787 1.1 tsubai
788 1.1 tsubai packet.saveBuf = adbBuffer;
789 1.1 tsubai packet.compRout = adbCompRout;
790 1.1 tsubai packet.compData = adbCompData;
791 1.1 tsubai packet.unsol = 0;
792 1.1 tsubai packet.ack_only = 0;
793 1.1 tsubai adb_polling = 1;
794 1.1 tsubai adb_pass_up(&packet);
795 1.1 tsubai adb_polling = 0;
796 1.1 tsubai
797 1.1 tsubai adbWaiting = 0;
798 1.1 tsubai adbBuffer = (long)0;
799 1.1 tsubai adbCompRout = (long)0;
800 1.1 tsubai adbCompData = (long)0;
801 1.1 tsubai }
802 1.1 tsubai
803 1.1 tsubai
804 1.1 tsubai void
805 1.1 tsubai pm_adb_get_ADB_data(pmdata)
806 1.1 tsubai PMData *pmdata;
807 1.1 tsubai {
808 1.1 tsubai int i;
809 1.1 tsubai struct adbCommand packet;
810 1.1 tsubai
811 1.23 briggs if (pmu_type == PMU_OHARE && pmdata->num_data == 4 &&
812 1.23 briggs pmdata->data[1] == 0x2c && pmdata->data[3] == 0xff &&
813 1.23 briggs ((pmdata->data[2] & ~1) == 0xf4)) {
814 1.23 briggs if (pmdata->data[2] == 0xf4) {
815 1.23 briggs pm_eject_pcmcia(0);
816 1.23 briggs } else {
817 1.23 briggs pm_eject_pcmcia(1);
818 1.23 briggs }
819 1.23 briggs return;
820 1.23 briggs }
821 1.1 tsubai /* set up data for adb_pass_up */
822 1.1 tsubai packet.data[0] = pmdata->num_data-1; /* number of raw data */
823 1.1 tsubai packet.data[1] = pmdata->data[3]; /* ADB command */
824 1.1 tsubai for (i = 0; i <packet.data[0]-1; i++)
825 1.1 tsubai packet.data[i+2] = pmdata->data[i+4];
826 1.1 tsubai packet.unsol = 1;
827 1.1 tsubai packet.ack_only = 0;
828 1.1 tsubai adb_pass_up(&packet);
829 1.1 tsubai }
830 1.1 tsubai
831 1.1 tsubai
832 1.1 tsubai void
833 1.1 tsubai pm_adb_restart()
834 1.1 tsubai {
835 1.1 tsubai PMData p;
836 1.1 tsubai
837 1.4 tsubai p.command = PMU_RESET_CPU;
838 1.1 tsubai p.num_data = 0;
839 1.1 tsubai p.s_buf = p.data;
840 1.1 tsubai p.r_buf = p.data;
841 1.6 tsubai pmgrop(&p);
842 1.6 tsubai }
843 1.6 tsubai
844 1.6 tsubai void
845 1.6 tsubai pm_adb_poweroff()
846 1.6 tsubai {
847 1.6 tsubai PMData p;
848 1.6 tsubai
849 1.6 tsubai p.command = PMU_POWER_OFF;
850 1.6 tsubai p.num_data = 4;
851 1.6 tsubai p.s_buf = p.data;
852 1.6 tsubai p.r_buf = p.data;
853 1.6 tsubai strcpy(p.data, "MATT");
854 1.1 tsubai pmgrop(&p);
855 1.2 tsubai }
856 1.2 tsubai
857 1.2 tsubai void
858 1.2 tsubai pm_read_date_time(time)
859 1.2 tsubai u_long *time;
860 1.2 tsubai {
861 1.2 tsubai PMData p;
862 1.2 tsubai
863 1.4 tsubai p.command = PMU_READ_RTC;
864 1.2 tsubai p.num_data = 0;
865 1.2 tsubai p.s_buf = p.data;
866 1.2 tsubai p.r_buf = p.data;
867 1.2 tsubai pmgrop(&p);
868 1.2 tsubai
869 1.13 wiz memcpy(time, p.data, 4);
870 1.4 tsubai }
871 1.4 tsubai
872 1.4 tsubai void
873 1.4 tsubai pm_set_date_time(time)
874 1.4 tsubai u_long time;
875 1.4 tsubai {
876 1.4 tsubai PMData p;
877 1.4 tsubai
878 1.4 tsubai p.command = PMU_SET_RTC;
879 1.4 tsubai p.num_data = 4;
880 1.4 tsubai p.s_buf = p.r_buf = p.data;
881 1.13 wiz memcpy(p.data, &time, 4);
882 1.7 tsubai pmgrop(&p);
883 1.7 tsubai }
884 1.7 tsubai
885 1.7 tsubai int
886 1.7 tsubai pm_read_brightness()
887 1.7 tsubai {
888 1.7 tsubai PMData p;
889 1.7 tsubai
890 1.7 tsubai p.command = PMU_READ_BRIGHTNESS;
891 1.7 tsubai p.num_data = 1; /* XXX why 1? */
892 1.7 tsubai p.s_buf = p.r_buf = p.data;
893 1.7 tsubai p.data[0] = 0;
894 1.7 tsubai pmgrop(&p);
895 1.7 tsubai
896 1.7 tsubai return p.data[0];
897 1.7 tsubai }
898 1.7 tsubai
899 1.7 tsubai void
900 1.7 tsubai pm_set_brightness(val)
901 1.7 tsubai int val;
902 1.7 tsubai {
903 1.7 tsubai PMData p;
904 1.7 tsubai
905 1.7 tsubai val = 0x7f - val / 2;
906 1.7 tsubai if (val < 0x08)
907 1.7 tsubai val = 0x08;
908 1.7 tsubai if (val > 0x78)
909 1.7 tsubai val = 0x78;
910 1.7 tsubai
911 1.7 tsubai p.command = PMU_SET_BRIGHTNESS;
912 1.7 tsubai p.num_data = 1;
913 1.7 tsubai p.s_buf = p.r_buf = p.data;
914 1.7 tsubai p.data[0] = val;
915 1.7 tsubai pmgrop(&p);
916 1.7 tsubai }
917 1.7 tsubai
918 1.7 tsubai void
919 1.7 tsubai pm_init_brightness()
920 1.7 tsubai {
921 1.7 tsubai int val;
922 1.7 tsubai
923 1.7 tsubai val = pm_read_brightness();
924 1.7 tsubai pm_set_brightness(val);
925 1.7 tsubai }
926 1.7 tsubai
927 1.7 tsubai void
928 1.7 tsubai pm_eject_pcmcia(slot)
929 1.7 tsubai int slot;
930 1.7 tsubai {
931 1.7 tsubai PMData p;
932 1.7 tsubai
933 1.7 tsubai if (slot != 0 && slot != 1)
934 1.7 tsubai return;
935 1.7 tsubai
936 1.7 tsubai p.command = PMU_EJECT_PCMCIA;
937 1.7 tsubai p.num_data = 1;
938 1.7 tsubai p.s_buf = p.r_buf = p.data;
939 1.8 tsubai p.data[0] = 5 + slot; /* XXX */
940 1.5 tsubai pmgrop(&p);
941 1.19 itojun }
942 1.19 itojun
943 1.19 itojun /*
944 1.19 itojun * Thanks to Paul Mackerras and Fabio Riccardi's Linux implementation
945 1.19 itojun * for a clear description of the PMU results.
946 1.19 itojun */
947 1.23 briggs static int
948 1.23 briggs pm_battery_info_smart(int battery, struct pmu_battery_info *info)
949 1.19 itojun {
950 1.19 itojun PMData p;
951 1.19 itojun
952 1.19 itojun p.command = PMU_SMART_BATTERY_STATE;
953 1.19 itojun p.num_data = 1;
954 1.19 itojun p.s_buf = p.r_buf = p.data;
955 1.19 itojun p.data[0] = battery + 1;
956 1.19 itojun pmgrop(&p);
957 1.19 itojun
958 1.19 itojun info->flags = p.data[1];
959 1.19 itojun
960 1.22 briggs info->secs_remaining = 0;
961 1.19 itojun switch (p.data[0]) {
962 1.19 itojun case 3:
963 1.19 itojun case 4:
964 1.19 itojun info->cur_charge = p.data[2];
965 1.19 itojun info->max_charge = p.data[3];
966 1.19 itojun info->draw = *((signed char *)&p.data[4]);
967 1.19 itojun info->voltage = p.data[5];
968 1.19 itojun break;
969 1.19 itojun case 5:
970 1.19 itojun info->cur_charge = ((p.data[2] << 8) | (p.data[3]));
971 1.19 itojun info->max_charge = ((p.data[4] << 8) | (p.data[5]));
972 1.19 itojun info->draw = *((signed short *)&p.data[6]);
973 1.19 itojun info->voltage = ((p.data[8] << 8) | (p.data[7]));
974 1.19 itojun break;
975 1.19 itojun default:
976 1.19 itojun /* XXX - Error condition */
977 1.19 itojun info->cur_charge = 0;
978 1.19 itojun info->max_charge = 0;
979 1.19 itojun info->draw = 0;
980 1.19 itojun info->voltage = 0;
981 1.19 itojun break;
982 1.19 itojun }
983 1.22 briggs if (info->draw) {
984 1.22 briggs if (info->flags & PMU_PWR_AC_PRESENT && info->draw > 0) {
985 1.22 briggs info->secs_remaining =
986 1.22 briggs ((info->max_charge - info->cur_charge) * 3600)
987 1.22 briggs / info->draw;
988 1.22 briggs } else {
989 1.22 briggs info->secs_remaining =
990 1.22 briggs (info->cur_charge * 3600) / -info->draw;
991 1.22 briggs }
992 1.22 briggs }
993 1.19 itojun
994 1.19 itojun return 1;
995 1.5 tsubai }
996 1.5 tsubai
997 1.23 briggs static int
998 1.23 briggs pm_battery_info_legacy(int battery, struct pmu_battery_info *info, int ty)
999 1.23 briggs {
1000 1.23 briggs PMData p;
1001 1.23 briggs long pcharge=0, charge, vb, vmax, lmax;
1002 1.23 briggs long vmax_charging, vmax_charged, amperage, voltage;
1003 1.23 briggs
1004 1.23 briggs p.command = PMU_BATTERY_STATE;
1005 1.23 briggs p.num_data = 0;
1006 1.23 briggs p.s_buf = p.r_buf = p.data;
1007 1.23 briggs pmgrop(&p);
1008 1.23 briggs
1009 1.23 briggs info->flags = p.data[0];
1010 1.23 briggs
1011 1.23 briggs if (info->flags & PMU_PWR_BATT_PRESENT) {
1012 1.23 briggs if (ty == BATT_COMET) {
1013 1.23 briggs vmax_charging = 213;
1014 1.23 briggs vmax_charged = 189;
1015 1.23 briggs lmax = 6500;
1016 1.23 briggs } else {
1017 1.23 briggs /* Experimental values */
1018 1.23 briggs vmax_charging = 365;
1019 1.23 briggs vmax_charged = 365;
1020 1.23 briggs lmax = 6500;
1021 1.23 briggs }
1022 1.23 briggs vmax = vmax_charged;
1023 1.23 briggs vb = (p.data[1] << 8) | p.data[2];
1024 1.23 briggs voltage = (vb * 256 + 72665) / 10;
1025 1.23 briggs amperage = (unsigned char) p.data[5];
1026 1.23 briggs if ((info->flags & PMU_PWR_AC_PRESENT) == 0) {
1027 1.23 briggs if (amperage > 200)
1028 1.23 briggs vb += ((amperage - 200) * 15)/100;
1029 1.23 briggs } else if (info->flags & PMU_PWR_BATT_CHARGING) {
1030 1.23 briggs vb = (vb * 97) / 100;
1031 1.23 briggs vmax = vmax_charging;
1032 1.23 briggs }
1033 1.23 briggs charge = (100 * vb) / vmax;
1034 1.23 briggs if (info->flags & PMU_PWR_PCHARGE_RESET) {
1035 1.23 briggs pcharge = (p.data[6] << 8) | p.data[7];
1036 1.23 briggs if (pcharge > lmax)
1037 1.23 briggs pcharge = lmax;
1038 1.23 briggs pcharge *= 100;
1039 1.23 briggs pcharge = 100 - pcharge / lmax;
1040 1.23 briggs if (pcharge < charge)
1041 1.23 briggs charge = pcharge;
1042 1.23 briggs }
1043 1.23 briggs info->cur_charge = charge;
1044 1.23 briggs info->max_charge = 100;
1045 1.23 briggs info->draw = -amperage;
1046 1.23 briggs info->voltage = voltage;
1047 1.23 briggs if (amperage > 0)
1048 1.23 briggs info->secs_remaining = (charge * 16440) / amperage;
1049 1.23 briggs else
1050 1.23 briggs info->secs_remaining = 0;
1051 1.23 briggs } else {
1052 1.23 briggs info->cur_charge = 0;
1053 1.23 briggs info->max_charge = 0;
1054 1.23 briggs info->draw = 0;
1055 1.23 briggs info->voltage = 0;
1056 1.23 briggs info->secs_remaining = 0;
1057 1.23 briggs }
1058 1.23 briggs
1059 1.23 briggs return 1;
1060 1.23 briggs }
1061 1.23 briggs
1062 1.23 briggs int
1063 1.23 briggs pm_battery_info(int battery, struct pmu_battery_info *info)
1064 1.23 briggs {
1065 1.23 briggs
1066 1.23 briggs if (battery > pmu_nbatt)
1067 1.23 briggs return 0;
1068 1.23 briggs
1069 1.23 briggs switch (pmu_batt_type) {
1070 1.23 briggs case BATT_COMET:
1071 1.23 briggs case BATT_HOOPER:
1072 1.23 briggs return pm_battery_info_legacy(battery, info, pmu_batt_type);
1073 1.23 briggs
1074 1.23 briggs case BATT_SMART:
1075 1.23 briggs return pm_battery_info_smart(battery, info);
1076 1.23 briggs }
1077 1.23 briggs
1078 1.23 briggs return 0;
1079 1.23 briggs }
1080 1.23 briggs
1081 1.5 tsubai int
1082 1.5 tsubai pm_read_nvram(addr)
1083 1.5 tsubai int addr;
1084 1.5 tsubai {
1085 1.5 tsubai PMData p;
1086 1.5 tsubai
1087 1.5 tsubai p.command = PMU_READ_NVRAM;
1088 1.5 tsubai p.num_data = 2;
1089 1.5 tsubai p.s_buf = p.r_buf = p.data;
1090 1.5 tsubai p.data[0] = addr >> 8;
1091 1.5 tsubai p.data[1] = addr;
1092 1.5 tsubai pmgrop(&p);
1093 1.5 tsubai
1094 1.5 tsubai return p.data[0];
1095 1.5 tsubai }
1096 1.5 tsubai
1097 1.5 tsubai void
1098 1.5 tsubai pm_write_nvram(addr, val)
1099 1.5 tsubai int addr, val;
1100 1.5 tsubai {
1101 1.5 tsubai PMData p;
1102 1.5 tsubai
1103 1.5 tsubai p.command = PMU_WRITE_NVRAM;
1104 1.5 tsubai p.num_data = 3;
1105 1.5 tsubai p.s_buf = p.r_buf = p.data;
1106 1.5 tsubai p.data[0] = addr >> 8;
1107 1.5 tsubai p.data[1] = addr;
1108 1.5 tsubai p.data[2] = val;
1109 1.4 tsubai pmgrop(&p);
1110 1.1 tsubai }
1111