vrpiu.c revision 1.8 1 1.8 takemura /* $NetBSD: vrpiu.c,v 1.8 2001/01/08 09:50:08 takemura Exp $ */
2 1.1 takemura
3 1.1 takemura /*
4 1.1 takemura * Copyright (c) 1999 Shin Takemura All rights reserved.
5 1.6 sato * Copyright (c) 2000 SATO Kazumi, All rights reserved.
6 1.6 sato * Copyright (c) 1999,2000 PocketBSD Project. All rights reserved.
7 1.1 takemura *
8 1.1 takemura * Redistribution and use in source and binary forms, with or without
9 1.1 takemura * modification, are permitted provided that the following conditions
10 1.1 takemura * are met:
11 1.1 takemura * 1. Redistributions of source code must retain the above copyright
12 1.1 takemura * notice, this list of conditions and the following disclaimer.
13 1.1 takemura * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 takemura * notice, this list of conditions and the following disclaimer in the
15 1.1 takemura * documentation and/or other materials provided with the distribution.
16 1.1 takemura *
17 1.1 takemura * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
18 1.1 takemura * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 1.1 takemura * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 1.1 takemura * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
21 1.1 takemura * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 1.1 takemura * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 1.1 takemura * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 1.1 takemura * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 1.1 takemura * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 1.1 takemura * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 1.1 takemura * SUCH DAMAGE.
28 1.1 takemura *
29 1.1 takemura */
30 1.1 takemura
31 1.6 sato /*
32 1.6 sato * A/D polling part written by SATO Kazumi.
33 1.6 sato */
34 1.6 sato
35 1.1 takemura #include <sys/param.h>
36 1.1 takemura #include <sys/systm.h>
37 1.1 takemura #include <sys/device.h>
38 1.1 takemura #include <sys/kernel.h>
39 1.6 sato #include <sys/callout.h>
40 1.6 sato #include <sys/boot_flag.h>
41 1.1 takemura
42 1.1 takemura #include <dev/wscons/wsconsio.h>
43 1.1 takemura #include <dev/wscons/wsmousevar.h>
44 1.1 takemura
45 1.1 takemura #include <machine/bus.h>
46 1.5 matt #include <machine/platid.h>
47 1.5 matt #include <machine/platid_mask.h>
48 1.6 sato #include <machine/config_hook.h>
49 1.1 takemura
50 1.6 sato #include <hpcmips/hpcmips/machdep.h>
51 1.3 takemura #include <hpcmips/dev/tpcalibvar.h>
52 1.6 sato
53 1.1 takemura #include <hpcmips/vr/vripvar.h>
54 1.1 takemura #include <hpcmips/vr/cmureg.h>
55 1.1 takemura #include <hpcmips/vr/vrpiuvar.h>
56 1.1 takemura #include <hpcmips/vr/vrpiureg.h>
57 1.1 takemura
58 1.1 takemura /*
59 1.1 takemura * contant and macro definitions
60 1.1 takemura */
61 1.1 takemura #define VRPIUDEBUG
62 1.1 takemura #ifdef VRPIUDEBUG
63 1.1 takemura int vrpiu_debug = 0;
64 1.1 takemura #define DPRINTF(arg) if (vrpiu_debug) printf arg;
65 1.6 sato #define VPRINTF(arg) if (bootverbose || vrpiu_debug) printf arg;
66 1.1 takemura #else
67 1.1 takemura #define DPRINTF(arg)
68 1.6 sato #define VPRINTF(arg) if (bootverbose) printf arg;
69 1.1 takemura #endif
70 1.1 takemura
71 1.6 sato #ifndef VRPIU_AD_POLL_INTERVAL
72 1.6 sato #define VRPIU_AD_POLL_INTERVAL 60 /* interval is 60 sec */
73 1.6 sato #endif /* VRPIU_AD_POLL_INTERTVAL */
74 1.8 takemura
75 1.8 takemura #define PIUSIVL_SCANINTVAL_MIN 333 /* 10msec */
76 1.8 takemura #define PIUSIVL_SCANINTVAL_MAX PIUSIVL_SCANINTVAL_MASK /* 60msec */
77 1.8 takemura
78 1.8 takemura #define TP_INTR (PIUINT_ALLINTR & ~PIUINT_PADADPINTR)
79 1.8 takemura #define AD_INTR (PIUINT_PADADPINTR)
80 1.8 takemura
81 1.1 takemura /*
82 1.1 takemura * data types
83 1.1 takemura */
84 1.1 takemura /* struct vrpiu_softc is defined in vrpiuvar.h */
85 1.1 takemura
86 1.1 takemura /*
87 1.1 takemura * function prototypes
88 1.1 takemura */
89 1.1 takemura static int vrpiumatch __P((struct device *, struct cfdata *, void *));
90 1.1 takemura static void vrpiuattach __P((struct device *, struct device *, void *));
91 1.1 takemura
92 1.1 takemura static void vrpiu_write __P((struct vrpiu_softc *, int, unsigned short));
93 1.1 takemura static u_short vrpiu_read __P((struct vrpiu_softc *, int));
94 1.1 takemura
95 1.1 takemura static int vrpiu_intr __P((void *));
96 1.6 sato static void vrpiu_tp_intr __P((struct vrpiu_softc *));
97 1.6 sato static void vrpiu_ad_intr __P((struct vrpiu_softc *));
98 1.1 takemura #ifdef DEBUG
99 1.1 takemura static void vrpiu_dump_cntreg __P((unsigned int cmd));
100 1.1 takemura #endif
101 1.1 takemura
102 1.6 sato static int vrpiu_tp_enable __P((void *));
103 1.6 sato static int vrpiu_tp_ioctl __P((void *, u_long, caddr_t, int, struct proc *));
104 1.6 sato static void vrpiu_tp_disable __P((void *));
105 1.6 sato int vrpiu_ad_enable __P((void *));
106 1.6 sato void vrpiu_ad_disable __P((void *));
107 1.6 sato static void vrpiu_start_powerstate __P((void *));
108 1.6 sato static void vrpiu_calc_powerstate __P((struct vrpiu_softc *));
109 1.6 sato static void vrpiu_power __P((int, void *));
110 1.8 takemura static u_int scan_interval __P((u_int data));
111 1.1 takemura
112 1.1 takemura /* mra is defined in mra.c */
113 1.1 takemura int mra_Y_AX1_BX2_C __P((int *y, int ys, int *x1, int x1s, int *x2, int x2s,
114 1.1 takemura int n, int scale, int *a, int *b, int *c));
115 1.1 takemura
116 1.1 takemura /*
117 1.1 takemura * static or global variables
118 1.1 takemura */
119 1.1 takemura struct cfattach vrpiu_ca = {
120 1.1 takemura sizeof(struct vrpiu_softc), vrpiumatch, vrpiuattach
121 1.1 takemura };
122 1.1 takemura
123 1.1 takemura const struct wsmouse_accessops vrpiu_accessops = {
124 1.6 sato vrpiu_tp_enable,
125 1.6 sato vrpiu_tp_ioctl,
126 1.6 sato vrpiu_tp_disable,
127 1.1 takemura };
128 1.1 takemura
129 1.6 sato int vrpiu_ad_poll_interval = VRPIU_AD_POLL_INTERVAL;
130 1.6 sato
131 1.1 takemura /*
132 1.1 takemura * function definitions
133 1.1 takemura */
134 1.1 takemura static inline void
135 1.1 takemura vrpiu_write(sc, port, val)
136 1.1 takemura struct vrpiu_softc *sc;
137 1.1 takemura int port;
138 1.1 takemura unsigned short val;
139 1.1 takemura {
140 1.1 takemura bus_space_write_2(sc->sc_iot, sc->sc_ioh, port, val);
141 1.1 takemura }
142 1.1 takemura
143 1.1 takemura static inline u_short
144 1.1 takemura vrpiu_read(sc, port)
145 1.1 takemura struct vrpiu_softc *sc;
146 1.1 takemura int port;
147 1.1 takemura {
148 1.1 takemura return bus_space_read_2(sc->sc_iot, sc->sc_ioh, port);
149 1.1 takemura }
150 1.1 takemura
151 1.1 takemura static int
152 1.1 takemura vrpiumatch(parent, cf, aux)
153 1.1 takemura struct device *parent;
154 1.1 takemura struct cfdata *cf;
155 1.1 takemura void *aux;
156 1.1 takemura {
157 1.1 takemura return 1;
158 1.1 takemura }
159 1.1 takemura
160 1.1 takemura static void
161 1.1 takemura vrpiuattach(parent, self, aux)
162 1.1 takemura struct device *parent;
163 1.1 takemura struct device *self;
164 1.1 takemura void *aux;
165 1.1 takemura {
166 1.1 takemura struct vrpiu_softc *sc = (struct vrpiu_softc *)self;
167 1.1 takemura struct vrip_attach_args *va = aux;
168 1.1 takemura struct wsmousedev_attach_args wsmaa;
169 1.1 takemura
170 1.1 takemura bus_space_tag_t iot = va->va_iot;
171 1.1 takemura bus_space_handle_t ioh;
172 1.1 takemura
173 1.1 takemura if (bus_space_map(iot, va->va_addr, 1, 0, &ioh)) {
174 1.1 takemura printf(": can't map bus space\n");
175 1.1 takemura return;
176 1.1 takemura }
177 1.1 takemura
178 1.1 takemura sc->sc_iot = iot;
179 1.1 takemura sc->sc_ioh = ioh;
180 1.1 takemura sc->sc_vrip = va->va_vc;
181 1.1 takemura
182 1.8 takemura sc->sc_interval = scan_interval(WSMOUSE_RES_DEFAULT);
183 1.8 takemura
184 1.1 takemura /*
185 1.1 takemura * disable device until vrpiu_enable called
186 1.1 takemura */
187 1.6 sato sc->sc_tpstat = VRPIU_TP_STAT_DISABLE;
188 1.1 takemura
189 1.3 takemura tpcalib_init(&sc->sc_tpcalib);
190 1.1 takemura #if 1
191 1.1 takemura /*
192 1.1 takemura * XXX, calibrate parameters
193 1.1 takemura */
194 1.1 takemura {
195 1.5 matt int i;
196 1.5 matt static const struct {
197 1.5 matt platid_mask_t *mask;
198 1.5 matt struct wsmouse_calibcoords coords;
199 1.5 matt } calibrations[] = {
200 1.5 matt { &platid_mask_MACH_NEC_MCR_700A,
201 1.5 matt { 0, 0, 799, 599,
202 1.5 matt 4,
203 1.5 matt { { 115, 80, 0, 0 },
204 1.5 matt { 115, 966, 0, 599 },
205 1.5 matt { 912, 80, 799, 0 },
206 1.5 matt { 912, 966, 799, 599 } } } },
207 1.5 matt
208 1.5 matt { NULL, /* samples got on my MC-R500 */
209 1.5 matt { 0, 0, 639, 239,
210 1.5 matt 5,
211 1.5 matt { { 502, 486, 320, 120 },
212 1.5 matt { 55, 109, 0, 0 },
213 1.5 matt { 54, 913, 0, 239 },
214 1.5 matt { 973, 924, 639, 239 },
215 1.5 matt { 975, 123, 639, 0 } } } },
216 1.1 takemura };
217 1.5 matt for (i = 0; ; i++) {
218 1.5 matt if (calibrations[i].mask == NULL
219 1.5 matt || platid_match(&platid, calibrations[i].mask))
220 1.5 matt break;
221 1.5 matt }
222 1.3 takemura tpcalib_ioctl(&sc->sc_tpcalib, WSMOUSEIO_SCALIBCOORDS,
223 1.5 matt (caddr_t)&calibrations[i].coords, 0, 0);
224 1.1 takemura }
225 1.1 takemura #endif
226 1.1 takemura
227 1.1 takemura /* install interrupt handler and enable interrupt */
228 1.1 takemura if (!(sc->sc_handler =
229 1.1 takemura vrip_intr_establish(va->va_vc, va->va_intr, IPL_TTY,
230 1.1 takemura vrpiu_intr, sc))) {
231 1.1 takemura printf (": can't map interrupt line.\n");
232 1.1 takemura return;
233 1.1 takemura }
234 1.1 takemura
235 1.1 takemura /* mask level2 interrupt, stop scan sequencer and mask clock to piu */
236 1.6 sato vrpiu_tp_disable(sc);
237 1.1 takemura
238 1.1 takemura printf("\n");
239 1.1 takemura
240 1.1 takemura wsmaa.accessops = &vrpiu_accessops;
241 1.1 takemura wsmaa.accesscookie = sc;
242 1.1 takemura
243 1.1 takemura /*
244 1.1 takemura * attach the wsmouse
245 1.1 takemura */
246 1.1 takemura sc->sc_wsmousedev = config_found(self, &wsmaa, wsmousedevprint);
247 1.6 sato
248 1.6 sato /*
249 1.6 sato * power management events
250 1.6 sato */
251 1.6 sato sc->sc_power_hook = powerhook_establish(vrpiu_power, sc);
252 1.6 sato
253 1.6 sato /*
254 1.6 sato * init A/D port polling.
255 1.6 sato */
256 1.6 sato sc->sc_battery.n_values = 3;
257 1.6 sato sc->sc_battery.value[0] = -1;
258 1.6 sato sc->sc_battery.value[1] = -1;
259 1.6 sato sc->sc_battery.value[2] = -1;
260 1.6 sato sc->sc_battery.nextpoll = hz*vrpiu_ad_poll_interval;
261 1.6 sato callout_init(&sc->sc_adpoll);
262 1.6 sato callout_reset(&sc->sc_adpoll, hz,
263 1.6 sato vrpiu_start_powerstate, sc);
264 1.1 takemura }
265 1.1 takemura
266 1.8 takemura /*
267 1.8 takemura * calculate interval value
268 1.8 takemura * input: WSMOUSE_RES_MIN - WSMOUSE_RES_MAX
269 1.8 takemura * output: value for PIUSIVL_REG
270 1.8 takemura */
271 1.8 takemura static u_int
272 1.8 takemura scan_interval(u_int data)
273 1.8 takemura {
274 1.8 takemura int scale;
275 1.8 takemura
276 1.8 takemura if (data < WSMOUSE_RES_MIN)
277 1.8 takemura data = WSMOUSE_RES_MIN;
278 1.8 takemura
279 1.8 takemura if (WSMOUSE_RES_MAX < data)
280 1.8 takemura data = WSMOUSE_RES_MAX;
281 1.8 takemura
282 1.8 takemura scale = WSMOUSE_RES_MAX - WSMOUSE_RES_MIN;
283 1.8 takemura data += WSMOUSE_RES_MIN;
284 1.8 takemura
285 1.8 takemura return PIUSIVL_SCANINTVAL_MIN +
286 1.8 takemura (PIUSIVL_SCANINTVAL_MAX - PIUSIVL_SCANINTVAL_MIN) *
287 1.8 takemura (scale - data) / scale;
288 1.8 takemura }
289 1.8 takemura
290 1.1 takemura int
291 1.6 sato vrpiu_ad_enable(v)
292 1.1 takemura void *v;
293 1.1 takemura {
294 1.1 takemura struct vrpiu_softc *sc = v;
295 1.1 takemura int s;
296 1.1 takemura unsigned int cnt;
297 1.1 takemura
298 1.8 takemura DPRINTF(("%s(%d): vrpiu_ad_enable(): interval=0x%03x\n",
299 1.8 takemura __FILE__, __LINE__, sc->sc_interval));
300 1.6 sato if (sc->sc_adstat != VRPIU_AD_STAT_DISABLE)
301 1.1 takemura return EBUSY;
302 1.1 takemura
303 1.1 takemura /* supply clock to PIU */
304 1.1 takemura __vrcmu_supply(CMUMSKPIU, 1);
305 1.1 takemura
306 1.8 takemura /* set scan interval */
307 1.8 takemura vrpiu_write(sc, PIUSIVL_REG_W, sc->sc_interval);
308 1.1 takemura
309 1.1 takemura s = spltty();
310 1.1 takemura
311 1.1 takemura /* clear interrupt status */
312 1.8 takemura vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
313 1.1 takemura
314 1.1 takemura /* Disable -> Standby */
315 1.1 takemura cnt = PIUCNT_PIUPWR |
316 1.1 takemura PIUCNT_PIUMODE_COORDINATE |
317 1.1 takemura PIUCNT_PADATSTART | PIUCNT_PADATSTOP;
318 1.1 takemura vrpiu_write(sc, PIUCNT_REG_W, cnt);
319 1.1 takemura
320 1.6 sato /* Level2 interrupt register setting */
321 1.8 takemura vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, AD_INTR, 1);
322 1.6 sato
323 1.1 takemura /* save pen status, touch or release */
324 1.1 takemura cnt = vrpiu_read(sc, PIUCNT_REG_W);
325 1.1 takemura
326 1.6 sato /*
327 1.6 sato * Enable scan sequencer operation
328 1.6 sato * Standby -> WaitPenTouch
329 1.6 sato */
330 1.6 sato cnt |= PIUCNT_PIUSEQEN;
331 1.6 sato vrpiu_write(sc, PIUCNT_REG_W, cnt);
332 1.6 sato
333 1.6 sato sc->sc_adstat = VRPIU_AD_STAT_ENABLE;
334 1.6 sato
335 1.6 sato splx(s);
336 1.6 sato
337 1.6 sato return 0;
338 1.6 sato }
339 1.6 sato
340 1.6 sato void
341 1.6 sato vrpiu_ad_disable(v)
342 1.6 sato void *v;
343 1.6 sato {
344 1.6 sato struct vrpiu_softc *sc = v;
345 1.6 sato
346 1.6 sato DPRINTF(("%s(%d): vrpiu_ad_disable()\n", __FILE__, __LINE__));
347 1.6 sato
348 1.6 sato /* Set level2 interrupt register to mask interrupts */
349 1.8 takemura vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, AD_INTR, 0);
350 1.6 sato
351 1.6 sato sc->sc_adstat = VRPIU_AD_STAT_DISABLE;
352 1.6 sato
353 1.6 sato if (sc->sc_tpstat == VRPIU_TP_STAT_DISABLE){
354 1.6 sato /* Disable scan sequencer operation and power off */
355 1.6 sato vrpiu_write(sc, PIUCNT_REG_W, 0);
356 1.6 sato
357 1.6 sato /* mask clock to PIU */
358 1.6 sato __vrcmu_supply(CMUMSKPIU, 1);
359 1.6 sato }
360 1.6 sato }
361 1.6 sato
362 1.6 sato int
363 1.6 sato vrpiu_tp_enable(v)
364 1.6 sato void *v;
365 1.6 sato {
366 1.6 sato struct vrpiu_softc *sc = v;
367 1.6 sato int s;
368 1.6 sato unsigned int cnt;
369 1.6 sato
370 1.8 takemura DPRINTF(("%s(%d): vrpiu_tp_enable(): interval=0x%03x\n",
371 1.8 takemura __FILE__, __LINE__, sc->sc_interval));
372 1.6 sato if (sc->sc_tpstat != VRPIU_TP_STAT_DISABLE)
373 1.6 sato return EBUSY;
374 1.6 sato
375 1.6 sato /* supply clock to PIU */
376 1.6 sato __vrcmu_supply(CMUMSKPIU, 1);
377 1.6 sato
378 1.8 takemura /* set scan interval */
379 1.8 takemura vrpiu_write(sc, PIUSIVL_REG_W, sc->sc_interval);
380 1.6 sato
381 1.6 sato s = spltty();
382 1.6 sato
383 1.6 sato /* clear interrupt status */
384 1.8 takemura vrpiu_write(sc, PIUINT_REG_W, TP_INTR);
385 1.6 sato
386 1.6 sato /* Disable -> Standby */
387 1.6 sato cnt = PIUCNT_PIUPWR |
388 1.6 sato PIUCNT_PIUMODE_COORDINATE |
389 1.6 sato PIUCNT_PADATSTART | PIUCNT_PADATSTOP;
390 1.6 sato vrpiu_write(sc, PIUCNT_REG_W, cnt);
391 1.6 sato
392 1.1 takemura /* Level2 interrupt register setting */
393 1.8 takemura vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, TP_INTR, 1);
394 1.6 sato
395 1.6 sato /* save pen status, touch or release */
396 1.6 sato cnt = vrpiu_read(sc, PIUCNT_REG_W);
397 1.1 takemura
398 1.1 takemura /*
399 1.1 takemura * Enable scan sequencer operation
400 1.1 takemura * Standby -> WaitPenTouch
401 1.1 takemura */
402 1.1 takemura cnt |= PIUCNT_PIUSEQEN;
403 1.1 takemura vrpiu_write(sc, PIUCNT_REG_W, cnt);
404 1.1 takemura
405 1.1 takemura /* transit status DISABLE -> TOUCH or RELEASE */
406 1.6 sato sc->sc_tpstat = (cnt & PIUCNT_PENSTC) ?
407 1.6 sato VRPIU_TP_STAT_TOUCH : VRPIU_TP_STAT_RELEASE;
408 1.1 takemura
409 1.1 takemura splx(s);
410 1.1 takemura
411 1.1 takemura return 0;
412 1.1 takemura }
413 1.1 takemura
414 1.1 takemura void
415 1.6 sato vrpiu_tp_disable(v)
416 1.1 takemura void *v;
417 1.1 takemura {
418 1.1 takemura struct vrpiu_softc *sc = v;
419 1.1 takemura
420 1.6 sato DPRINTF(("%s(%d): vrpiu_tp_disable()\n", __FILE__, __LINE__));
421 1.1 takemura
422 1.1 takemura /* Set level2 interrupt register to mask interrupts */
423 1.8 takemura vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, TP_INTR, 0);
424 1.1 takemura
425 1.6 sato sc->sc_tpstat = VRPIU_TP_STAT_DISABLE;
426 1.1 takemura
427 1.6 sato if (sc->sc_adstat == VRPIU_AD_STAT_DISABLE){
428 1.6 sato /* Disable scan sequencer operation and power off */
429 1.6 sato vrpiu_write(sc, PIUCNT_REG_W, 0);
430 1.1 takemura
431 1.6 sato /* mask clock to PIU */
432 1.6 sato __vrcmu_supply(CMUMSKPIU, 1);
433 1.6 sato }
434 1.1 takemura }
435 1.1 takemura
436 1.1 takemura int
437 1.6 sato vrpiu_tp_ioctl(v, cmd, data, flag, p)
438 1.1 takemura void *v;
439 1.1 takemura u_long cmd;
440 1.1 takemura caddr_t data;
441 1.1 takemura int flag;
442 1.1 takemura struct proc *p;
443 1.1 takemura {
444 1.1 takemura struct vrpiu_softc *sc = v;
445 1.1 takemura
446 1.6 sato DPRINTF(("%s(%d): vrpiu_tp_ioctl(%08lx)\n", __FILE__, __LINE__, cmd));
447 1.1 takemura
448 1.1 takemura switch (cmd) {
449 1.1 takemura case WSMOUSEIO_GTYPE:
450 1.2 takemura *(u_int *)data = WSMOUSE_TYPE_TPANEL;
451 1.1 takemura break;
452 1.1 takemura
453 1.1 takemura case WSMOUSEIO_SRES:
454 1.8 takemura {
455 1.8 takemura int tp_enable;
456 1.8 takemura int ad_enable;
457 1.8 takemura
458 1.8 takemura tp_enable = (sc->sc_tpstat != VRPIU_TP_STAT_DISABLE);
459 1.8 takemura ad_enable = (sc->sc_adstat != VRPIU_AD_STAT_DISABLE);
460 1.8 takemura
461 1.8 takemura if (tp_enable)
462 1.8 takemura vrpiu_tp_disable(sc);
463 1.8 takemura if (ad_enable)
464 1.8 takemura vrpiu_ad_disable(sc);
465 1.8 takemura
466 1.8 takemura sc->sc_interval = scan_interval(*(u_int *)data);
467 1.8 takemura DPRINTF(("%s(%d): WSMOUSEIO_SRES: *data=%d, interval=0x%03x\n",
468 1.8 takemura __FILE__, __LINE__, *(u_int *)data, sc->sc_interval));
469 1.8 takemura
470 1.8 takemura if (sc->sc_interval < PIUSIVL_SCANINTVAL_MIN)
471 1.8 takemura sc->sc_interval = PIUSIVL_SCANINTVAL_MIN;
472 1.8 takemura
473 1.8 takemura if (PIUSIVL_SCANINTVAL_MAX < sc->sc_interval)
474 1.8 takemura sc->sc_interval = PIUSIVL_SCANINTVAL_MAX;
475 1.8 takemura
476 1.8 takemura if (tp_enable)
477 1.8 takemura vrpiu_tp_enable(sc);
478 1.8 takemura if (ad_enable)
479 1.8 takemura vrpiu_ad_enable(sc);
480 1.8 takemura }
481 1.8 takemura break;
482 1.3 takemura
483 1.3 takemura case WSMOUSEIO_SCALIBCOORDS:
484 1.3 takemura case WSMOUSEIO_GCALIBCOORDS:
485 1.3 takemura return tpcalib_ioctl(&sc->sc_tpcalib, cmd, data, flag, p);
486 1.1 takemura
487 1.1 takemura default:
488 1.1 takemura return (-1);
489 1.1 takemura }
490 1.1 takemura return (0);
491 1.1 takemura }
492 1.1 takemura
493 1.1 takemura /*
494 1.6 sato * PIU AD interrupt handler.
495 1.6 sato */
496 1.6 sato void
497 1.6 sato vrpiu_ad_intr(sc)
498 1.6 sato struct vrpiu_softc *sc;
499 1.6 sato {
500 1.6 sato unsigned int i;
501 1.6 sato unsigned int intrstat;
502 1.6 sato
503 1.6 sato intrstat = vrpiu_read(sc, PIUINT_REG_W);
504 1.6 sato
505 1.6 sato if (sc->sc_adstat == VRPIU_AD_STAT_DISABLE) {
506 1.6 sato /*
507 1.6 sato * the device isn't enabled. just clear interrupt.
508 1.6 sato */
509 1.8 takemura vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
510 1.6 sato return;
511 1.6 sato }
512 1.6 sato
513 1.6 sato if (intrstat & PIUINT_PADADPINTR) {
514 1.6 sato sc->sc_battery.value[0] = (unsigned int)vrpiu_read(sc, PIUAB(0));
515 1.6 sato sc->sc_battery.value[1] = (unsigned int)vrpiu_read(sc, PIUAB(1));
516 1.6 sato sc->sc_battery.value[2] = (unsigned int)vrpiu_read(sc, PIUAB(2));
517 1.6 sato }
518 1.6 sato
519 1.6 sato if (intrstat & PIUINT_PADADPINTR) {
520 1.6 sato for (i = 0; i < 3; i++) {
521 1.6 sato if (sc->sc_battery.value[i] & PIUAB_VALID)
522 1.6 sato sc->sc_battery.value[i] &= PIUAB_PADDATA_MASK;
523 1.6 sato else
524 1.6 sato sc->sc_battery.value[i] = 0;
525 1.6 sato }
526 1.6 sato vrpiu_calc_powerstate(sc);
527 1.6 sato }
528 1.8 takemura vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
529 1.6 sato
530 1.6 sato return;
531 1.6 sato }
532 1.6 sato /*
533 1.6 sato * PIU TP interrupt handler.
534 1.1 takemura */
535 1.6 sato void
536 1.6 sato vrpiu_tp_intr(sc)
537 1.6 sato struct vrpiu_softc *sc;
538 1.1 takemura {
539 1.1 takemura unsigned int cnt, i;
540 1.1 takemura unsigned int intrstat, page;
541 1.1 takemura int tpx0, tpx1, tpy0, tpy1;
542 1.1 takemura int x, y, xraw, yraw;
543 1.1 takemura
544 1.1 takemura intrstat = vrpiu_read(sc, PIUINT_REG_W);
545 1.1 takemura
546 1.6 sato if (sc->sc_tpstat == VRPIU_TP_STAT_DISABLE) {
547 1.6 sato /*
548 1.1 takemura * the device isn't enabled. just clear interrupt.
549 1.1 takemura */
550 1.8 takemura vrpiu_write(sc, PIUINT_REG_W, intrstat & TP_INTR);
551 1.6 sato return;
552 1.1 takemura }
553 1.1 takemura
554 1.1 takemura page = (intrstat & PIUINT_OVP) ? 1 : 0;
555 1.1 takemura if (intrstat & (PIUINT_PADPAGE0INTR | PIUINT_PADPAGE1INTR)) {
556 1.1 takemura tpx0 = vrpiu_read(sc, PIUPB(page, 0));
557 1.1 takemura tpx1 = vrpiu_read(sc, PIUPB(page, 1));
558 1.1 takemura tpy0 = vrpiu_read(sc, PIUPB(page, 2));
559 1.1 takemura tpy1 = vrpiu_read(sc, PIUPB(page, 3));
560 1.1 takemura }
561 1.1 takemura
562 1.1 takemura if (intrstat & PIUINT_PADDLOSTINTR) {
563 1.1 takemura page = page ? 0 : 1;
564 1.1 takemura for (i = 0; i < 4; i++)
565 1.1 takemura vrpiu_read(sc, PIUPB(page, i));
566 1.1 takemura }
567 1.1 takemura
568 1.1 takemura cnt = vrpiu_read(sc, PIUCNT_REG_W);
569 1.1 takemura #ifdef DEBUG
570 1.1 takemura if (vrpiu_debug)
571 1.1 takemura vrpiu_dump_cntreg(cnt);
572 1.1 takemura #endif
573 1.1 takemura
574 1.1 takemura /* clear interrupt status */
575 1.8 takemura vrpiu_write(sc, PIUINT_REG_W, intrstat & TP_INTR);
576 1.1 takemura
577 1.1 takemura #if 0
578 1.1 takemura DPRINTF(("vrpiu_intr: OVP=%d", page));
579 1.1 takemura if (intrstat & PIUINT_PADCMDINTR)
580 1.1 takemura DPRINTF((" CMD"));
581 1.1 takemura if (intrstat & PIUINT_PADADPINTR)
582 1.1 takemura DPRINTF((" A/D"));
583 1.1 takemura if (intrstat & PIUINT_PADPAGE1INTR)
584 1.1 takemura DPRINTF((" PAGE1"));
585 1.1 takemura if (intrstat & PIUINT_PADPAGE0INTR)
586 1.1 takemura DPRINTF((" PAGE0"));
587 1.1 takemura if (intrstat & PIUINT_PADDLOSTINTR)
588 1.1 takemura DPRINTF((" DLOST"));
589 1.1 takemura if (intrstat & PIUINT_PENCHGINTR)
590 1.1 takemura DPRINTF((" PENCHG"));
591 1.1 takemura DPRINTF(("\n"));
592 1.1 takemura #endif
593 1.1 takemura if (intrstat & (PIUINT_PADPAGE0INTR | PIUINT_PADPAGE1INTR)) {
594 1.1 takemura if (!((tpx0 & PIUPB_VALID) && (tpx1 & PIUPB_VALID) &&
595 1.1 takemura (tpy0 & PIUPB_VALID) && (tpy1 & PIUPB_VALID))) {
596 1.1 takemura printf("vrpiu: internal error, data is not valid!\n");
597 1.1 takemura } else {
598 1.1 takemura tpx0 &= PIUPB_PADDATA_MASK;
599 1.1 takemura tpx1 &= PIUPB_PADDATA_MASK;
600 1.1 takemura tpy0 &= PIUPB_PADDATA_MASK;
601 1.1 takemura tpy1 &= PIUPB_PADDATA_MASK;
602 1.1 takemura #define ISVALID(n, c, m) ((c) - (m) < (n) && (n) < (c) + (m))
603 1.1 takemura if (ISVALID(tpx0 + tpx1, 1024, 200) &&
604 1.1 takemura ISVALID(tpx0 + tpx1, 1024, 200)) {
605 1.1 takemura #if 0
606 1.1 takemura DPRINTF(("%04x %04x %04x %04x\n",
607 1.1 takemura tpx0, tpx1, tpy0, tpy1));
608 1.1 takemura DPRINTF(("%3d %3d (%4d %4d)->", tpx0, tpy0,
609 1.4 takemura tpx0 + tpx1, tpy0 + tpy1));
610 1.1 takemura #endif
611 1.1 takemura xraw = tpy1 * 1024 / (tpy0 + tpy1);
612 1.1 takemura yraw = tpx1 * 1024 / (tpx0 + tpx1);
613 1.1 takemura DPRINTF(("%3d %3d", xraw, yraw));
614 1.1 takemura
615 1.3 takemura tpcalib_trans(&sc->sc_tpcalib,
616 1.3 takemura xraw, yraw, &x, &y);
617 1.3 takemura
618 1.1 takemura DPRINTF(("->%4d %4d", x, y));
619 1.2 takemura wsmouse_input(sc->sc_wsmousedev,
620 1.2 takemura (cnt & PIUCNT_PENSTC) ? 1 : 0,
621 1.2 takemura x, /* x */
622 1.2 takemura y, /* y */
623 1.2 takemura 0, /* z */
624 1.2 takemura WSMOUSE_INPUT_ABSOLUTE_X |
625 1.2 takemura WSMOUSE_INPUT_ABSOLUTE_Y);
626 1.1 takemura DPRINTF(("\n"));
627 1.1 takemura }
628 1.4 takemura }
629 1.4 takemura }
630 1.4 takemura
631 1.4 takemura if (cnt & PIUCNT_PENSTC) {
632 1.6 sato if (sc->sc_tpstat == VRPIU_TP_STAT_RELEASE) {
633 1.4 takemura /*
634 1.4 takemura * pen touch
635 1.4 takemura */
636 1.4 takemura DPRINTF(("PEN TOUCH\n"));
637 1.6 sato sc->sc_tpstat = VRPIU_TP_STAT_TOUCH;
638 1.4 takemura /*
639 1.4 takemura * We should not report button down event while
640 1.4 takemura * we don't know where it occur.
641 1.4 takemura */
642 1.4 takemura }
643 1.4 takemura } else {
644 1.6 sato if (sc->sc_tpstat == VRPIU_TP_STAT_TOUCH) {
645 1.4 takemura /*
646 1.4 takemura * pen release
647 1.4 takemura */
648 1.4 takemura DPRINTF(("RELEASE\n"));
649 1.6 sato sc->sc_tpstat = VRPIU_TP_STAT_RELEASE;
650 1.4 takemura /* button 0 UP */
651 1.4 takemura wsmouse_input(sc->sc_wsmousedev,
652 1.4 takemura 0,
653 1.4 takemura 0, 0, 0, 0);
654 1.1 takemura }
655 1.1 takemura }
656 1.1 takemura
657 1.1 takemura if (intrstat & PIUINT_PADDLOSTINTR) {
658 1.1 takemura cnt |= PIUCNT_PIUSEQEN;
659 1.1 takemura vrpiu_write(sc, PIUCNT_REG_W, cnt);
660 1.1 takemura }
661 1.1 takemura
662 1.6 sato return;
663 1.6 sato }
664 1.6 sato
665 1.6 sato /*
666 1.6 sato * PIU interrupt handler.
667 1.6 sato */
668 1.6 sato int
669 1.6 sato vrpiu_intr(arg)
670 1.6 sato void *arg;
671 1.6 sato {
672 1.6 sato struct vrpiu_softc *sc = arg;
673 1.6 sato
674 1.6 sato vrpiu_ad_intr(sc);
675 1.6 sato vrpiu_tp_intr(sc);
676 1.6 sato
677 1.1 takemura return 0;
678 1.6 sato }
679 1.6 sato
680 1.6 sato void
681 1.6 sato vrpiu_start_powerstate(v)
682 1.6 sato void *v;
683 1.6 sato {
684 1.6 sato int mask;
685 1.6 sato struct vrpiu_softc *sc = (struct vrpiu_softc *)v;
686 1.6 sato
687 1.6 sato vrpiu_ad_enable(sc);
688 1.6 sato mask = vrpiu_read(sc, PIUAMSK_REG_W);
689 1.6 sato mask &= 0xff8f; /* XXX */
690 1.6 sato vrpiu_write(sc, PIUAMSK_REG_W, mask);
691 1.6 sato vrpiu_write(sc, PIUASCN_REG_W, PIUACN_ADPSSTART);
692 1.6 sato /*
693 1.6 sato * restart next A/D polling
694 1.6 sato */
695 1.6 sato callout_reset(&sc->sc_adpoll, hz*vrpiu_ad_poll_interval,
696 1.6 sato vrpiu_start_powerstate, sc);
697 1.6 sato }
698 1.6 sato
699 1.6 sato void
700 1.6 sato vrpiu_calc_powerstate(sc)
701 1.6 sato struct vrpiu_softc *sc;
702 1.6 sato {
703 1.6 sato extern void vrgiu_diff_io __P((void));
704 1.6 sato vrpiu_ad_disable(sc);
705 1.6 sato VPRINTF(("vrpiu:AD: %d, %d, %d\n",
706 1.6 sato sc->sc_battery.value[0],
707 1.6 sato sc->sc_battery.value[1],
708 1.6 sato sc->sc_battery.value[2]));
709 1.6 sato sc->sc_battery.nextpoll = hz*vrpiu_ad_poll_interval;
710 1.6 sato #ifdef notyet
711 1.7 sato config_hook_call(CONFIG_HOOK_SET,
712 1.7 sato CONFIG_HOOK_BATTERYVAL,
713 1.6 sato (void *)&sc->sc_battery);
714 1.6 sato #endif /* notyet */
715 1.6 sato /*
716 1.6 sato * restart next A/D polling if change polling timming.
717 1.6 sato */
718 1.6 sato if (sc->sc_battery.nextpoll != hz*vrpiu_ad_poll_interval)
719 1.6 sato callout_reset(&sc->sc_adpoll, sc->sc_battery.nextpoll,
720 1.6 sato vrpiu_start_powerstate, sc);
721 1.6 sato if (bootverbose)
722 1.6 sato vrgiu_diff_io();
723 1.6 sato
724 1.6 sato }
725 1.6 sato
726 1.6 sato static void
727 1.6 sato vrpiu_power(why, arg)
728 1.6 sato int why;
729 1.6 sato void *arg;
730 1.6 sato {
731 1.6 sato struct vrpiu_softc *sc = arg;
732 1.6 sato
733 1.6 sato switch (why) {
734 1.6 sato case PWR_STANDBY:
735 1.6 sato case PWR_SUSPEND:
736 1.6 sato break;
737 1.6 sato case PWR_RESUME:
738 1.6 sato callout_reset(&sc->sc_adpoll, hz,
739 1.6 sato vrpiu_start_powerstate, sc);
740 1.6 sato break;
741 1.6 sato }
742 1.1 takemura }
743 1.1 takemura
744 1.1 takemura #ifdef DEBUG
745 1.1 takemura void
746 1.1 takemura vrpiu_dump_cntreg(cnt)
747 1.1 takemura unsigned int cnt;
748 1.1 takemura {
749 1.1 takemura printf("%s", (cnt & PIUCNT_PENSTC) ? "Touch" : "Release");
750 1.1 takemura printf(" state=");
751 1.1 takemura if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_CmdScan)
752 1.1 takemura printf("CmdScan");
753 1.1 takemura if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_IntervalNextScan)
754 1.1 takemura printf("IntervalNextScan");
755 1.1 takemura if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_PenDataScan)
756 1.1 takemura printf("PenDataScan");
757 1.1 takemura if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_WaitPenTouch)
758 1.1 takemura printf("WaitPenTouch");
759 1.1 takemura if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_RFU)
760 1.1 takemura printf("???");
761 1.1 takemura if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_ADPortScan)
762 1.1 takemura printf("ADPortScan");
763 1.1 takemura if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_Standby)
764 1.1 takemura printf("Standby");
765 1.1 takemura if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_Disable)
766 1.1 takemura printf("Disable");
767 1.1 takemura if (cnt & PIUCNT_PADATSTOP)
768 1.1 takemura printf(" AutoStop");
769 1.1 takemura if (cnt & PIUCNT_PADATSTART)
770 1.1 takemura printf(" AutoStart");
771 1.1 takemura if (cnt & PIUCNT_PADSCANSTOP)
772 1.1 takemura printf(" Stop");
773 1.1 takemura if (cnt & PIUCNT_PADSCANSTART)
774 1.1 takemura printf(" Start");
775 1.1 takemura if (cnt & PIUCNT_PADSCANTYPE)
776 1.1 takemura printf(" ScanPressure");
777 1.1 takemura if ((cnt & PIUCNT_PIUMODE_MASK) == PIUCNT_PIUMODE_ADCONVERTER)
778 1.1 takemura printf(" A/D");
779 1.1 takemura if ((cnt & PIUCNT_PIUMODE_MASK) == PIUCNT_PIUMODE_COORDINATE)
780 1.1 takemura printf(" Coordinate");
781 1.1 takemura if (cnt & PIUCNT_PIUSEQEN)
782 1.1 takemura printf(" SeqEn");
783 1.1 takemura if ((cnt & PIUCNT_PIUPWR) == 0)
784 1.1 takemura printf(" PowerOff");
785 1.1 takemura if ((cnt & PIUCNT_PADRST) == 0)
786 1.1 takemura printf(" Reset");
787 1.1 takemura printf("\n");
788 1.1 takemura }
789 1.1 takemura #endif
790