psh3pwr.c revision 1.7 1 1.7 andvar /* $NetBSD: psh3pwr.c,v 1.7 2024/05/10 20:08:04 andvar Exp $ */
2 1.1 kiyohara /*
3 1.1 kiyohara * Copyright (c) 2005, 2007 KIYOHARA Takashi
4 1.1 kiyohara * All rights reserved.
5 1.1 kiyohara *
6 1.1 kiyohara * Redistribution and use in source and binary forms, with or without
7 1.1 kiyohara * modification, are permitted provided that the following conditions
8 1.1 kiyohara * are met:
9 1.1 kiyohara * 1. Redistributions of source code must retain the above copyright
10 1.1 kiyohara * notice, this list of conditions and the following disclaimer.
11 1.1 kiyohara * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 kiyohara * notice, this list of conditions and the following disclaimer in the
13 1.1 kiyohara * documentation and/or other materials provided with the distribution.
14 1.1 kiyohara *
15 1.1 kiyohara * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 1.1 kiyohara * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
17 1.1 kiyohara * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
18 1.1 kiyohara * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
19 1.1 kiyohara * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
20 1.1 kiyohara * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
21 1.1 kiyohara * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 1.1 kiyohara * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
23 1.1 kiyohara * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
24 1.1 kiyohara * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
25 1.1 kiyohara * POSSIBILITY OF SUCH DAMAGE.
26 1.1 kiyohara *
27 1.1 kiyohara */
28 1.1 kiyohara
29 1.1 kiyohara #include <sys/cdefs.h>
30 1.7 andvar __KERNEL_RCSID(0, "$NetBSD: psh3pwr.c,v 1.7 2024/05/10 20:08:04 andvar Exp $");
31 1.1 kiyohara
32 1.1 kiyohara #include <sys/param.h>
33 1.1 kiyohara #include <sys/kernel.h>
34 1.1 kiyohara #include <sys/device.h>
35 1.1 kiyohara #include <sys/systm.h>
36 1.1 kiyohara #include <sys/callout.h>
37 1.1 kiyohara
38 1.2 kiyohara #include <machine/config_hook.h>
39 1.1 kiyohara #include <machine/platid.h>
40 1.1 kiyohara #include <machine/platid_mask.h>
41 1.1 kiyohara
42 1.2 kiyohara #include <dev/apm/apmbios.h>
43 1.1 kiyohara
44 1.1 kiyohara #include <sh3/exception.h>
45 1.1 kiyohara #include <sh3/intcreg.h>
46 1.1 kiyohara #include <sh3/pfcreg.h>
47 1.1 kiyohara
48 1.1 kiyohara #include <sh3/dev/adcvar.h>
49 1.1 kiyohara
50 1.1 kiyohara
51 1.1 kiyohara #ifdef PSH3PWR_DEBUG
52 1.1 kiyohara #define DPRINTF(arg) printf arg
53 1.1 kiyohara #else
54 1.1 kiyohara #define DPRINTF(arg) ((void)0)
55 1.1 kiyohara #endif
56 1.1 kiyohara
57 1.1 kiyohara
58 1.7 andvar /* A/D converter channels to get power stats from */
59 1.1 kiyohara #define ADC_CHANNEL_BATTERY 3
60 1.1 kiyohara
61 1.1 kiyohara /* On/Off bit for Green LED. pin 7 in SH7709 GPIO port H. */
62 1.1 kiyohara #define PSH3_GREEN_LED_ON 0x80
63 1.1 kiyohara
64 1.1 kiyohara /*
65 1.1 kiyohara * XXXX:
66 1.1 kiyohara * WindowsCE seem to be using this as a flag.
67 1.1 kiyohara * pin 6 in SH7709 GPIO port SCPDR.
68 1.1 kiyohara */
69 1.1 kiyohara #define PSH3PWR_PLUG_OUT 0x40
70 1.1 kiyohara
71 1.2 kiyohara
72 1.2 kiyohara static inline int __attribute__((__always_inline__))
73 1.2 kiyohara psh3pwr_ac_is_off(void)
74 1.2 kiyohara {
75 1.2 kiyohara
76 1.2 kiyohara return _reg_read_1(SH7709_SCPDR) & PSH3PWR_PLUG_OUT;
77 1.2 kiyohara }
78 1.2 kiyohara
79 1.2 kiyohara
80 1.2 kiyohara /*
81 1.2 kiyohara * Empirical range of battery values.
82 1.2 kiyohara * Thanks to Joseph Heenan for measurements.
83 1.2 kiyohara */
84 1.2 kiyohara #define PSH3PWR_BATTERY_MIN 630
85 1.2 kiyohara #define PSH3PWR_BATTERY_CRITICAL 635
86 1.2 kiyohara #define PSH3PWR_BATTERY_LOW 645
87 1.2 kiyohara #define PSH3PWR_BATTERY_FULL 910 /* can be slightly more */
88 1.1 kiyohara
89 1.1 kiyohara
90 1.1 kiyohara struct psh3pwr_softc {
91 1.3 kiyohara device_t sc_dev;
92 1.1 kiyohara
93 1.1 kiyohara void *sc_ih_pin;
94 1.1 kiyohara void *sc_ih_pout;
95 1.1 kiyohara };
96 1.1 kiyohara
97 1.3 kiyohara static int psh3pwr_match(device_t, struct cfdata *, void *);
98 1.3 kiyohara static void psh3pwr_attach(device_t, device_t, void *);
99 1.1 kiyohara
100 1.3 kiyohara CFATTACH_DECL_NEW(psh3pwr, sizeof(struct psh3pwr_softc),
101 1.1 kiyohara psh3pwr_match, psh3pwr_attach, NULL, NULL);
102 1.1 kiyohara
103 1.2 kiyohara static int psh3pwr_intr_plug_out(void *);
104 1.1 kiyohara static int psh3pwr_intr_plug_in(void *);
105 1.1 kiyohara static void psh3pwr_sleep(void *);
106 1.2 kiyohara static int psh3pwr_apm_getpower_hook(void *, int, long, void *);
107 1.2 kiyohara static int psh3pwr_get_battery(void);
108 1.1 kiyohara
109 1.1 kiyohara
110 1.1 kiyohara static int
111 1.3 kiyohara psh3pwr_match(device_t parent, struct cfdata *cfp, void *aux)
112 1.1 kiyohara {
113 1.1 kiyohara
114 1.1 kiyohara if (!platid_match(&platid, &platid_mask_MACH_HITACHI_PERSONA))
115 1.1 kiyohara return 0;
116 1.1 kiyohara
117 1.1 kiyohara if (strcmp(cfp->cf_name, "psh3pwr") != 0)
118 1.1 kiyohara return 0;
119 1.1 kiyohara
120 1.1 kiyohara return 1;
121 1.1 kiyohara }
122 1.1 kiyohara
123 1.1 kiyohara
124 1.1 kiyohara static void
125 1.3 kiyohara psh3pwr_attach(device_t parent, device_t self, void *aux)
126 1.1 kiyohara {
127 1.1 kiyohara extern void (*__sleep_func)(void *);
128 1.1 kiyohara extern void *__sleep_ctx;
129 1.3 kiyohara struct psh3pwr_softc *sc = device_private(self);
130 1.2 kiyohara uint8_t phdr;
131 1.2 kiyohara
132 1.3 kiyohara sc->sc_dev = self;
133 1.3 kiyohara
134 1.2 kiyohara /* arrange for hpcapm to call us when power status is requested */
135 1.2 kiyohara config_hook(CONFIG_HOOK_GET, CONFIG_HOOK_ACADAPTER,
136 1.2 kiyohara CONFIG_HOOK_EXCLUSIVE, psh3pwr_apm_getpower_hook, sc);
137 1.2 kiyohara config_hook(CONFIG_HOOK_GET, CONFIG_HOOK_CHARGE,
138 1.2 kiyohara CONFIG_HOOK_EXCLUSIVE, psh3pwr_apm_getpower_hook, sc);
139 1.2 kiyohara config_hook(CONFIG_HOOK_GET, CONFIG_HOOK_BATTERYVAL,
140 1.2 kiyohara CONFIG_HOOK_EXCLUSIVE, psh3pwr_apm_getpower_hook, sc);
141 1.1 kiyohara
142 1.1 kiyohara /* regisiter sleep function to APM */
143 1.1 kiyohara __sleep_func = psh3pwr_sleep;
144 1.1 kiyohara __sleep_ctx = self;
145 1.1 kiyohara
146 1.1 kiyohara phdr = _reg_read_1(SH7709_PHDR);
147 1.1 kiyohara _reg_write_1(SH7709_PHDR, phdr | PSH3_GREEN_LED_ON);
148 1.1 kiyohara
149 1.3 kiyohara aprint_naive("\n");
150 1.3 kiyohara aprint_normal("\n");
151 1.1 kiyohara
152 1.1 kiyohara sc->sc_ih_pout = intc_intr_establish(SH7709_INTEVT2_IRQ0,
153 1.6 chs IST_EDGE, IPL_TTY, psh3pwr_intr_plug_out, self);
154 1.1 kiyohara sc->sc_ih_pin = intc_intr_establish(SH7709_INTEVT2_IRQ1,
155 1.6 chs IST_EDGE, IPL_TTY, psh3pwr_intr_plug_in, self);
156 1.1 kiyohara
157 1.1 kiyohara /* XXXX: WindowsCE sets this bit. */
158 1.3 kiyohara aprint_normal_dev(self, "plug status: %s\n",
159 1.3 kiyohara psh3pwr_ac_is_off() ? "out" : "in");
160 1.4 kiyohara
161 1.4 kiyohara if (!pmf_device_register(self, NULL, NULL))
162 1.4 kiyohara aprint_error_dev(self, "unable to establish power handler\n");
163 1.1 kiyohara }
164 1.1 kiyohara
165 1.1 kiyohara
166 1.2 kiyohara static int
167 1.6 chs psh3pwr_intr_plug_out(void *dev)
168 1.1 kiyohara {
169 1.1 kiyohara uint8_t irr0, scpdr;
170 1.1 kiyohara
171 1.1 kiyohara irr0 = _reg_read_1(SH7709_IRR0);
172 1.1 kiyohara if (!(irr0 & IRR0_IRQ0)) {
173 1.1 kiyohara return 0;
174 1.1 kiyohara }
175 1.1 kiyohara _reg_write_1(SH7709_IRR0, irr0 & ~IRR0_IRQ0);
176 1.1 kiyohara
177 1.1 kiyohara /* XXXX: WindowsCE sets this bit. */
178 1.1 kiyohara scpdr = _reg_read_1(SH7709_SCPDR);
179 1.1 kiyohara _reg_write_1(SH7709_SCPDR, scpdr | PSH3PWR_PLUG_OUT);
180 1.1 kiyohara
181 1.6 chs DPRINTF(("%s: plug out\n", device_xname(dev)));
182 1.1 kiyohara
183 1.1 kiyohara return 1;
184 1.1 kiyohara }
185 1.1 kiyohara
186 1.2 kiyohara static int
187 1.6 chs psh3pwr_intr_plug_in(void *dev)
188 1.1 kiyohara {
189 1.1 kiyohara uint8_t irr0, scpdr;
190 1.1 kiyohara
191 1.1 kiyohara irr0 = _reg_read_1(SH7709_IRR0);
192 1.1 kiyohara if (!(irr0 & IRR0_IRQ1))
193 1.1 kiyohara return 0;
194 1.1 kiyohara _reg_write_1(SH7709_IRR0, irr0 & ~IRR0_IRQ1);
195 1.1 kiyohara
196 1.1 kiyohara /* XXXX: WindowsCE sets this bit. */
197 1.1 kiyohara scpdr = _reg_read_1(SH7709_SCPDR);
198 1.1 kiyohara _reg_write_1(SH7709_SCPDR, scpdr & ~PSH3PWR_PLUG_OUT);
199 1.1 kiyohara
200 1.6 chs DPRINTF(("%s: plug in\n", device_xname(dev)));
201 1.1 kiyohara
202 1.1 kiyohara return 1;
203 1.1 kiyohara }
204 1.1 kiyohara
205 1.1 kiyohara void
206 1.6 chs psh3pwr_sleep(void *v)
207 1.1 kiyohara {
208 1.1 kiyohara /* splhigh on entry */
209 1.1 kiyohara extern void pfckbd_poll_hitachi_power(void);
210 1.1 kiyohara
211 1.1 kiyohara uint8_t phdr;
212 1.1 kiyohara
213 1.1 kiyohara phdr = _reg_read_1(SH7709_PHDR);
214 1.1 kiyohara _reg_write_1(SH7709_PHDR, phdr & ~PSH3_GREEN_LED_ON);
215 1.1 kiyohara
216 1.1 kiyohara pfckbd_poll_hitachi_power();
217 1.1 kiyohara
218 1.1 kiyohara phdr = _reg_read_1(SH7709_PHDR);
219 1.1 kiyohara _reg_write_1(SH7709_PHDR, phdr | PSH3_GREEN_LED_ON);
220 1.1 kiyohara }
221 1.1 kiyohara
222 1.2 kiyohara static int
223 1.2 kiyohara psh3pwr_apm_getpower_hook(void *ctx, int type, long id, void *msg)
224 1.2 kiyohara {
225 1.2 kiyohara /* struct psh0pwr_softc * const sc = ctx; */
226 1.2 kiyohara int * const pval = msg;
227 1.2 kiyohara int battery, state;
228 1.2 kiyohara
229 1.2 kiyohara if (type != CONFIG_HOOK_GET)
230 1.2 kiyohara return EINVAL;
231 1.2 kiyohara
232 1.2 kiyohara switch (id) {
233 1.1 kiyohara
234 1.2 kiyohara case CONFIG_HOOK_ACADAPTER:
235 1.2 kiyohara *pval = psh3pwr_ac_is_off() ? APM_AC_OFF : APM_AC_ON;
236 1.2 kiyohara return 0;
237 1.1 kiyohara
238 1.2 kiyohara case CONFIG_HOOK_CHARGE:
239 1.2 kiyohara battery = psh3pwr_get_battery();
240 1.2 kiyohara if (battery < PSH3PWR_BATTERY_CRITICAL)
241 1.2 kiyohara state = APM_BATT_FLAG_CRITICAL;
242 1.2 kiyohara else if (battery < PSH3PWR_BATTERY_LOW)
243 1.2 kiyohara state = APM_BATT_FLAG_LOW;
244 1.2 kiyohara else
245 1.2 kiyohara state = APM_BATT_FLAG_HIGH; /* XXX? */
246 1.2 kiyohara *pval = state;
247 1.2 kiyohara return 0;
248 1.1 kiyohara
249 1.2 kiyohara case CONFIG_HOOK_BATTERYVAL:
250 1.2 kiyohara battery = psh3pwr_get_battery();
251 1.2 kiyohara if (battery > PSH3PWR_BATTERY_FULL)
252 1.2 kiyohara state = 100;
253 1.2 kiyohara else
254 1.2 kiyohara state = 100 * (battery - PSH3PWR_BATTERY_MIN) /
255 1.2 kiyohara (PSH3PWR_BATTERY_FULL - PSH3PWR_BATTERY_MIN);
256 1.2 kiyohara *pval = state;
257 1.2 kiyohara return 0;
258 1.2 kiyohara }
259 1.1 kiyohara
260 1.2 kiyohara return EINVAL;
261 1.1 kiyohara }
262 1.1 kiyohara
263 1.2 kiyohara
264 1.1 kiyohara static int
265 1.2 kiyohara psh3pwr_get_battery(void)
266 1.1 kiyohara {
267 1.2 kiyohara int battery;
268 1.2 kiyohara int s;
269 1.1 kiyohara
270 1.2 kiyohara s = spltty();
271 1.2 kiyohara battery = adc_sample_channel(ADC_CHANNEL_BATTERY);
272 1.2 kiyohara splx(s);
273 1.1 kiyohara
274 1.2 kiyohara return battery;
275 1.1 kiyohara }
276