Home | History | Annotate | Line # | Download | only in vr
vrpiu.c revision 1.29
      1  1.29     lukem /*	$NetBSD: vrpiu.c,v 1.29 2003/07/15 02:29:36 lukem Exp $	*/
      2   1.1  takemura 
      3   1.1  takemura /*
      4  1.27  takemura  * Copyright (c) 1999-2003 TAKEMURA Shin All rights reserved.
      5  1.14      sato  * Copyright (c) 2000-2001 SATO Kazumi, All rights reserved.
      6  1.14      sato  * Copyright (c) 1999-2001 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.29     lukem 
     35  1.29     lukem #include <sys/cdefs.h>
     36  1.29     lukem __KERNEL_RCSID(0, "$NetBSD: vrpiu.c,v 1.29 2003/07/15 02:29:36 lukem Exp $");
     37   1.6      sato 
     38   1.1  takemura #include <sys/param.h>
     39   1.1  takemura #include <sys/systm.h>
     40   1.1  takemura #include <sys/device.h>
     41   1.1  takemura #include <sys/kernel.h>
     42   1.6      sato #include <sys/callout.h>
     43   1.6      sato #include <sys/boot_flag.h>
     44   1.1  takemura 
     45   1.1  takemura #include <dev/wscons/wsconsio.h>
     46   1.1  takemura #include <dev/wscons/wsmousevar.h>
     47   1.1  takemura 
     48   1.1  takemura #include <machine/bus.h>
     49   1.5      matt #include <machine/platid.h>
     50   1.5      matt #include <machine/platid_mask.h>
     51   1.6      sato #include <machine/config_hook.h>
     52   1.1  takemura 
     53  1.11       uch #include <dev/hpc/tpcalibvar.h>
     54  1.11       uch 
     55  1.14      sato #include <dev/hpc/hpcbatteryvar.h>
     56  1.14      sato #include <dev/hpc/hpcbatterytable.h>
     57  1.14      sato 
     58  1.17      sato #include <hpcmips/vr/vrcpudef.h>
     59  1.18  takemura #include <hpcmips/vr/vripif.h>
     60   1.1  takemura #include <hpcmips/vr/cmureg.h>
     61   1.1  takemura #include <hpcmips/vr/vrpiuvar.h>
     62  1.22  takemura #define	PIUB_REG_OFFSSET	0
     63   1.1  takemura #include <hpcmips/vr/vrpiureg.h>
     64   1.1  takemura 
     65   1.1  takemura /*
     66   1.1  takemura  * contant and macro definitions
     67   1.1  takemura  */
     68   1.1  takemura #define VRPIUDEBUG
     69   1.1  takemura #ifdef VRPIUDEBUG
     70   1.1  takemura int	vrpiu_debug = 0;
     71   1.1  takemura #define	DPRINTF(arg) if (vrpiu_debug) printf arg;
     72   1.6      sato #define	VPRINTF(arg) if (bootverbose || vrpiu_debug) printf arg;
     73   1.1  takemura #else
     74   1.1  takemura #define	DPRINTF(arg)
     75   1.6      sato #define	VPRINTF(arg) if (bootverbose) printf arg;
     76   1.1  takemura #endif
     77   1.1  takemura 
     78  1.14      sato #ifndef VRPIU_NO_ADHOC_BATTERY_EVENT
     79  1.14      sato #define VRPIU_ADHOC_BATTERY_EVENT	/* currently... */
     80  1.14      sato #endif /* VRPIU_NO_ADHOC_BATTERY_EVENT */
     81  1.14      sato 
     82   1.6      sato #ifndef VRPIU_AD_POLL_INTERVAL
     83   1.6      sato #define VRPIU_AD_POLL_INTERVAL	60	/* interval is 60 sec */
     84   1.6      sato #endif /* VRPIU_AD_POLL_INTERTVAL */
     85   1.8  takemura 
     86   1.8  takemura #define	PIUSIVL_SCANINTVAL_MIN	333			/* 10msec	*/
     87   1.8  takemura #define	PIUSIVL_SCANINTVAL_MAX	PIUSIVL_SCANINTVAL_MASK	/* 60msec	*/
     88  1.10  takemura #define VRPIU_TP_SCAN_TIMEOUT	(hz/10)		/* timeout is 100msec	*/
     89   1.8  takemura 
     90   1.8  takemura #define TP_INTR	(PIUINT_ALLINTR & ~PIUINT_PADADPINTR)
     91   1.8  takemura #define AD_INTR	(PIUINT_PADADPINTR)
     92   1.8  takemura 
     93   1.1  takemura /*
     94   1.1  takemura  * data types
     95   1.1  takemura  */
     96   1.1  takemura /* struct vrpiu_softc is defined in vrpiuvar.h */
     97   1.1  takemura 
     98   1.1  takemura /*
     99   1.1  takemura  * function prototypes
    100   1.1  takemura  */
    101  1.15       uch static int	vrpiumatch(struct device *, struct cfdata *, void *);
    102  1.15       uch static void	vrpiuattach(struct device *, struct device *, void *);
    103  1.26  takemura static void	vrc4173piuattach(struct device *, struct device *, void *);
    104  1.26  takemura static void	vrpiu_init(struct vrpiu_softc *, void *);
    105   1.1  takemura 
    106  1.15       uch static void	vrpiu_write(struct vrpiu_softc *, int, unsigned short);
    107  1.15       uch static u_short	vrpiu_read(struct vrpiu_softc *, int);
    108   1.1  takemura 
    109  1.15       uch static int	vrpiu_intr(void *);
    110  1.15       uch static void	vrpiu_tp_intr(struct vrpiu_softc *);
    111  1.15       uch static void	vrpiu_ad_intr(struct vrpiu_softc *);
    112   1.1  takemura #ifdef DEBUG
    113  1.15       uch static void	vrpiu_dump_cntreg(unsigned int);
    114   1.1  takemura #endif
    115   1.1  takemura 
    116  1.15       uch static int	vrpiu_tp_enable(void *);
    117  1.15       uch static int	vrpiu_tp_ioctl(void *, u_long, caddr_t, int, struct proc *);
    118  1.15       uch static void	vrpiu_tp_disable(void *);
    119  1.15       uch static void	vrpiu_tp_up(struct vrpiu_softc *);
    120  1.15       uch static void	vrpiu_tp_timeout(void *);
    121  1.15       uch int		vrpiu_ad_enable(void *);
    122  1.15       uch void		vrpiu_ad_disable(void *);
    123  1.15       uch static void	vrpiu_start_powerstate(void *);
    124  1.15       uch static void	vrpiu_calc_powerstate(struct vrpiu_softc *);
    125  1.15       uch static void	vrpiu_send_battery_event(struct vrpiu_softc *);
    126  1.15       uch static void	vrpiu_power(int, void *);
    127  1.15       uch static u_int	scan_interval(u_int data);
    128   1.1  takemura 
    129   1.1  takemura /* mra is defined in mra.c */
    130  1.15       uch int mra_Y_AX1_BX2_C(int *y, int ys, int *x1, int x1s, int *x2, int x2s,
    131  1.15       uch     int n, int scale, int *a, int *b, int *c);
    132   1.1  takemura 
    133   1.1  takemura /*
    134   1.1  takemura  * static or global variables
    135   1.1  takemura  */
    136  1.25   thorpej CFATTACH_DECL(vrpiu, sizeof(struct vrpiu_softc),
    137  1.25   thorpej     vrpiumatch, vrpiuattach, NULL, NULL);
    138  1.26  takemura CFATTACH_DECL(vrc4173piu, sizeof(struct vrpiu_softc),
    139  1.26  takemura     vrpiumatch, vrc4173piuattach, NULL, NULL);
    140   1.1  takemura 
    141   1.1  takemura const struct wsmouse_accessops vrpiu_accessops = {
    142   1.6      sato 	vrpiu_tp_enable,
    143   1.6      sato 	vrpiu_tp_ioctl,
    144   1.6      sato 	vrpiu_tp_disable,
    145   1.1  takemura };
    146   1.1  takemura 
    147   1.6      sato int vrpiu_ad_poll_interval = VRPIU_AD_POLL_INTERVAL;
    148   1.6      sato 
    149   1.1  takemura /*
    150   1.1  takemura  * function definitions
    151   1.1  takemura  */
    152   1.1  takemura static inline void
    153  1.15       uch vrpiu_write(struct vrpiu_softc *sc, int port, unsigned short val)
    154   1.1  takemura {
    155  1.15       uch 
    156   1.1  takemura 	bus_space_write_2(sc->sc_iot, sc->sc_ioh, port, val);
    157   1.1  takemura }
    158   1.1  takemura 
    159   1.1  takemura static inline u_short
    160  1.15       uch vrpiu_read(struct vrpiu_softc *sc, int port)
    161   1.1  takemura {
    162  1.15       uch 
    163  1.15       uch 	return (bus_space_read_2(sc->sc_iot, sc->sc_ioh, port));
    164   1.1  takemura }
    165   1.1  takemura 
    166  1.22  takemura static inline u_short
    167  1.22  takemura vrpiu_buf_read(struct vrpiu_softc *sc, int port)
    168  1.22  takemura {
    169  1.22  takemura 
    170  1.22  takemura 	return (bus_space_read_2(sc->sc_iot, sc->sc_buf_ioh, port));
    171  1.22  takemura }
    172  1.22  takemura 
    173   1.1  takemura static int
    174  1.15       uch vrpiumatch(struct device *parent, struct cfdata *cf, void *aux)
    175   1.1  takemura {
    176  1.15       uch 
    177  1.15       uch 	return (1);
    178   1.1  takemura }
    179   1.1  takemura 
    180   1.1  takemura static void
    181  1.15       uch vrpiuattach(struct device *parent, struct device *self, void *aux)
    182   1.1  takemura {
    183   1.1  takemura 	struct vrpiu_softc *sc = (struct vrpiu_softc *)self;
    184  1.26  takemura 
    185  1.26  takemura 	sc->sc_ab_paddata_mask = PIUAB_PADDATA_MASK;
    186  1.26  takemura 	sc->sc_pb_paddata_mask = PIUPB_PADDATA_MASK;
    187  1.26  takemura 	sc->sc_pb_paddata_max = PIUPB_PADDATA_MAX;
    188  1.26  takemura 	vrpiu_init(sc, aux);
    189  1.26  takemura }
    190  1.26  takemura 
    191  1.26  takemura static void
    192  1.26  takemura vrc4173piuattach(struct device *parent, struct device *self, void *aux)
    193  1.26  takemura {
    194  1.26  takemura 	struct vrpiu_softc *sc = (struct vrpiu_softc *)self;
    195  1.26  takemura 
    196  1.26  takemura 	sc->sc_ab_paddata_mask = VRC4173PIUAB_PADDATA_MASK;
    197  1.26  takemura 	sc->sc_pb_paddata_mask = VRC4173PIUPB_PADDATA_MASK;
    198  1.26  takemura 	sc->sc_pb_paddata_max = VRC4173PIUPB_PADDATA_MAX;
    199  1.26  takemura 	vrpiu_init(sc, aux);
    200  1.26  takemura }
    201  1.26  takemura 
    202  1.26  takemura static void
    203  1.26  takemura vrpiu_init(struct vrpiu_softc *sc, void *aux)
    204  1.26  takemura {
    205   1.1  takemura 	struct vrip_attach_args *va = aux;
    206   1.1  takemura 	struct wsmousedev_attach_args wsmaa;
    207  1.21  takemura 	int res;
    208   1.1  takemura 	bus_space_tag_t iot = va->va_iot;
    209  1.14      sato 	struct platid_data *p;
    210   1.1  takemura 
    211  1.21  takemura 	if (va->va_parent_ioh != NULL)
    212  1.21  takemura 		res = bus_space_subregion(iot, va->va_parent_ioh, va->va_addr,
    213  1.22  takemura 		    va->va_size, &sc->sc_ioh);
    214  1.21  takemura 	else
    215  1.22  takemura 		res = bus_space_map(iot, va->va_addr, va->va_size, 0,
    216  1.22  takemura 		    &sc->sc_ioh);
    217  1.21  takemura 	if (res != 0) {
    218  1.15       uch 		printf(": can't map bus space\n");
    219  1.15       uch 		return;
    220   1.1  takemura 	}
    221  1.22  takemura 	if (va->va_parent_ioh != NULL)
    222  1.22  takemura 		res = bus_space_subregion(iot, va->va_parent_ioh, va->va_addr2,
    223  1.22  takemura 		    va->va_size2, &sc->sc_buf_ioh);
    224  1.22  takemura 	else
    225  1.22  takemura 		res = bus_space_map(iot, va->va_addr2, va->va_size2, 0,
    226  1.22  takemura 		    &sc->sc_buf_ioh);
    227  1.22  takemura 	if (res != 0) {
    228  1.22  takemura 		printf(": can't map second bus space\n");
    229  1.22  takemura 		return;
    230  1.22  takemura 	}
    231   1.1  takemura 
    232   1.1  takemura 	sc->sc_iot = iot;
    233  1.20  takemura 	sc->sc_unit = va->va_unit;
    234   1.1  takemura 	sc->sc_vrip = va->va_vc;
    235   1.1  takemura 
    236   1.8  takemura 	sc->sc_interval = scan_interval(WSMOUSE_RES_DEFAULT);
    237  1.16  takemura 	if ((p = platid_search_data(&platid, hpcbattery_parameters)) == NULL)
    238  1.14      sato 		sc->sc_battery_spec = NULL;
    239  1.14      sato 	else
    240  1.14      sato 		sc->sc_battery_spec  = p->data;
    241   1.8  takemura 
    242   1.1  takemura 	/*
    243   1.1  takemura 	 * disable device until vrpiu_enable called
    244   1.1  takemura 	 */
    245   1.6      sato 	sc->sc_tpstat = VRPIU_TP_STAT_DISABLE;
    246   1.1  takemura 
    247  1.10  takemura 	/* initialize touch panel timeout structure	*/
    248  1.10  takemura 	callout_init(&sc->sc_tptimeout);
    249  1.10  takemura 
    250  1.10  takemura 	/* initialize calibration context	*/
    251   1.3  takemura 	tpcalib_init(&sc->sc_tpcalib);
    252   1.1  takemura #if 1
    253   1.1  takemura 	/*
    254   1.1  takemura 	 * XXX, calibrate parameters
    255   1.1  takemura 	 */
    256   1.1  takemura 	{
    257  1.15       uch 		int i;
    258  1.15       uch 		static const struct {
    259  1.15       uch 			platid_mask_t *mask;
    260  1.15       uch 			struct wsmouse_calibcoords coords;
    261  1.15       uch 		} calibrations[] = {
    262  1.15       uch 			{ &platid_mask_MACH_NEC_MCR_700,
    263  1.15       uch 			  { 0, 0, 799, 599,
    264  1.15       uch 			    4,
    265  1.15       uch 			    { { 115,  80,   0,   0 },
    266  1.15       uch 			      { 115, 966,   0, 599 },
    267  1.15       uch 			      { 912,  80, 799,   0 },
    268  1.15       uch 			      { 912, 966, 799, 599 } } } },
    269  1.15       uch 			{ &platid_mask_MACH_NEC_MCR_700A,
    270  1.15       uch 			  { 0, 0, 799, 599,
    271  1.15       uch 			    4,
    272  1.15       uch 			    { { 115,  80,   0,   0 },
    273  1.15       uch 			      { 115, 966,   0, 599 },
    274  1.15       uch 			      { 912,  80, 799,   0 },
    275  1.15       uch 			      { 912, 966, 799, 599 } } } },
    276  1.15       uch 			{ &platid_mask_MACH_NEC_MCR_730,
    277  1.15       uch 			  { 0, 0, 799, 599,
    278  1.15       uch 			    4,
    279  1.15       uch 			    { { 115,  80,   0,   0 },
    280  1.15       uch 			      { 115, 966,   0, 599 },
    281  1.15       uch 			      { 912,  80, 799,   0 },
    282  1.15       uch 			      { 912, 966, 799, 599 } } } },
    283  1.15       uch 			{ NULL,		/* samples got on my MC-R500 */
    284  1.15       uch 			  { 0, 0, 639, 239,
    285  1.15       uch 			    5,
    286  1.15       uch 			    { { 502, 486, 320, 120 },
    287  1.15       uch 			      {  55, 109,   0,   0 },
    288  1.15       uch 			      {  54, 913,   0, 239 },
    289  1.15       uch 			      { 973, 924, 639, 239 },
    290  1.15       uch 			      { 975, 123, 639,   0 } } } },
    291  1.15       uch 		};
    292  1.15       uch 		for (i = 0; ; i++) {
    293  1.15       uch 			if (calibrations[i].mask == NULL
    294  1.15       uch 			    || platid_match(&platid, calibrations[i].mask))
    295  1.15       uch 				break;
    296  1.15       uch 		}
    297  1.15       uch 		tpcalib_ioctl(&sc->sc_tpcalib, WSMOUSEIO_SCALIBCOORDS,
    298  1.15       uch 		    (caddr_t)&calibrations[i].coords, 0, 0);
    299   1.1  takemura 	}
    300   1.1  takemura #endif
    301   1.1  takemura 
    302   1.1  takemura 	/* install interrupt handler and enable interrupt */
    303   1.1  takemura 	if (!(sc->sc_handler =
    304  1.20  takemura 	    vrip_intr_establish(sc->sc_vrip, sc->sc_unit, 0, IPL_TTY,
    305  1.15       uch 		vrpiu_intr, sc))) {
    306  1.15       uch 		printf (": can't map interrupt line.\n");
    307  1.15       uch 		return;
    308   1.1  takemura 	}
    309   1.1  takemura 
    310   1.1  takemura 	/* mask level2 interrupt, stop scan sequencer and mask clock to piu */
    311   1.6      sato 	vrpiu_tp_disable(sc);
    312   1.1  takemura 
    313   1.1  takemura 	printf("\n");
    314   1.1  takemura 
    315   1.1  takemura 	wsmaa.accessops = &vrpiu_accessops;
    316   1.1  takemura 	wsmaa.accesscookie = sc;
    317   1.1  takemura 
    318   1.1  takemura 	/*
    319   1.1  takemura 	 * attach the wsmouse
    320   1.1  takemura 	 */
    321  1.26  takemura 	sc->sc_wsmousedev = config_found(&sc->sc_dev, &wsmaa, wsmousedevprint);
    322   1.6      sato 
    323   1.6      sato 	/*
    324   1.6      sato 	 * power management events
    325   1.6      sato 	 */
    326   1.6      sato 	sc->sc_power_hook = powerhook_establish(vrpiu_power, sc);
    327   1.6      sato 
    328   1.6      sato 	/*
    329   1.6      sato 	 * init A/D port polling.
    330   1.6      sato 	 */
    331   1.6      sato 	sc->sc_battery.n_values = 3;
    332   1.6      sato 	sc->sc_battery.value[0] = -1;
    333   1.6      sato 	sc->sc_battery.value[1] = -1;
    334   1.6      sato 	sc->sc_battery.value[2] = -1;
    335   1.6      sato 	sc->sc_battery.nextpoll = hz*vrpiu_ad_poll_interval;
    336   1.6      sato 	callout_init(&sc->sc_adpoll);
    337   1.9  takemura 	callout_reset(&sc->sc_adpoll, hz, vrpiu_start_powerstate, sc);
    338   1.1  takemura }
    339   1.1  takemura 
    340   1.8  takemura /*
    341   1.8  takemura  * calculate interval value
    342   1.8  takemura  *  input: WSMOUSE_RES_MIN - WSMOUSE_RES_MAX
    343   1.8  takemura  * output: value for PIUSIVL_REG
    344   1.8  takemura  */
    345   1.8  takemura static u_int
    346   1.8  takemura scan_interval(u_int data)
    347   1.8  takemura {
    348   1.8  takemura 	int scale;
    349   1.8  takemura 
    350   1.8  takemura 	if (data < WSMOUSE_RES_MIN)
    351  1.15       uch 		data = WSMOUSE_RES_MIN;
    352   1.8  takemura 
    353   1.8  takemura 	if (WSMOUSE_RES_MAX < data)
    354  1.15       uch 		data = WSMOUSE_RES_MAX;
    355   1.8  takemura 
    356   1.8  takemura 	scale = WSMOUSE_RES_MAX - WSMOUSE_RES_MIN;
    357   1.8  takemura 	data += WSMOUSE_RES_MIN;
    358   1.8  takemura 
    359   1.8  takemura 	return PIUSIVL_SCANINTVAL_MIN +
    360   1.8  takemura 	    (PIUSIVL_SCANINTVAL_MAX - PIUSIVL_SCANINTVAL_MIN) *
    361   1.8  takemura 	    (scale - data) / scale;
    362   1.8  takemura }
    363   1.8  takemura 
    364   1.1  takemura int
    365  1.15       uch vrpiu_ad_enable(void *v)
    366   1.1  takemura {
    367   1.1  takemura 	struct vrpiu_softc *sc = v;
    368   1.1  takemura 	int s;
    369   1.1  takemura 	unsigned int cnt;
    370   1.1  takemura 
    371   1.8  takemura 	DPRINTF(("%s(%d): vrpiu_ad_enable(): interval=0x%03x\n",
    372  1.15       uch 	    __FILE__, __LINE__, sc->sc_interval));
    373   1.6      sato 	if (sc->sc_adstat != VRPIU_AD_STAT_DISABLE)
    374  1.15       uch 		return EBUSY;
    375   1.1  takemura 
    376   1.1  takemura 	/* supply clock to PIU */
    377  1.20  takemura 	vrip_power(sc->sc_vrip, sc->sc_unit, 1);
    378   1.1  takemura 
    379   1.8  takemura 	/* set scan interval */
    380   1.8  takemura 	vrpiu_write(sc, PIUSIVL_REG_W, sc->sc_interval);
    381   1.1  takemura 
    382   1.1  takemura 	s = spltty();
    383   1.1  takemura 
    384   1.1  takemura 	/* clear interrupt status */
    385   1.8  takemura 	vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
    386   1.1  takemura 
    387   1.1  takemura 	/* Disable -> Standby */
    388   1.1  takemura 	cnt = PIUCNT_PIUPWR |
    389  1.15       uch 	    PIUCNT_PIUMODE_COORDINATE |
    390  1.15       uch 	    PIUCNT_PADATSTART | PIUCNT_PADATSTOP;
    391   1.1  takemura 	vrpiu_write(sc, PIUCNT_REG_W, cnt);
    392   1.1  takemura 
    393   1.6      sato 	/* Level2 interrupt register setting */
    394   1.8  takemura 	vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, AD_INTR, 1);
    395   1.6      sato 
    396   1.1  takemura 	/* save pen status, touch or release */
    397   1.1  takemura 	cnt = vrpiu_read(sc, PIUCNT_REG_W);
    398   1.1  takemura 
    399   1.6      sato 	/*
    400   1.6      sato 	 * Enable scan sequencer operation
    401   1.6      sato 	 * Standby -> WaitPenTouch
    402   1.6      sato 	 */
    403   1.6      sato 	cnt |= PIUCNT_PIUSEQEN;
    404   1.6      sato 	vrpiu_write(sc, PIUCNT_REG_W, cnt);
    405   1.6      sato 
    406   1.6      sato 	sc->sc_adstat = VRPIU_AD_STAT_ENABLE;
    407   1.6      sato 
    408   1.6      sato 	splx(s);
    409   1.6      sato 
    410   1.6      sato 	return 0;
    411   1.6      sato }
    412   1.6      sato 
    413   1.6      sato void
    414  1.15       uch vrpiu_ad_disable(void *v)
    415   1.6      sato {
    416   1.6      sato 	struct vrpiu_softc *sc = v;
    417   1.6      sato 
    418   1.6      sato 	DPRINTF(("%s(%d): vrpiu_ad_disable()\n", __FILE__, __LINE__));
    419   1.6      sato 
    420   1.6      sato 	/* Set level2 interrupt register to mask interrupts */
    421   1.8  takemura 	vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, AD_INTR, 0);
    422   1.6      sato 
    423   1.6      sato 	sc->sc_adstat = VRPIU_AD_STAT_DISABLE;
    424   1.6      sato 
    425   1.6      sato 	if (sc->sc_tpstat == VRPIU_TP_STAT_DISABLE){
    426  1.15       uch 		/* Disable scan sequencer operation and power off */
    427  1.15       uch 		vrpiu_write(sc, PIUCNT_REG_W, 0);
    428   1.6      sato 
    429  1.15       uch 		/* mask clock to PIU */
    430  1.20  takemura 		vrip_power(sc->sc_vrip, sc->sc_unit, 0);
    431   1.6      sato 	}
    432   1.6      sato }
    433   1.6      sato 
    434   1.6      sato int
    435  1.15       uch vrpiu_tp_enable(void *v)
    436   1.6      sato {
    437   1.6      sato 	struct vrpiu_softc *sc = v;
    438   1.6      sato 	int s;
    439   1.6      sato 	unsigned int cnt;
    440   1.6      sato 
    441   1.8  takemura 	DPRINTF(("%s(%d): vrpiu_tp_enable(): interval=0x%03x\n",
    442  1.15       uch 	    __FILE__, __LINE__, sc->sc_interval));
    443   1.6      sato 	if (sc->sc_tpstat != VRPIU_TP_STAT_DISABLE)
    444  1.15       uch 		return EBUSY;
    445   1.6      sato 
    446   1.6      sato 	/* supply clock to PIU */
    447  1.20  takemura 	vrip_power(sc->sc_vrip, sc->sc_unit, 1);
    448   1.6      sato 
    449   1.8  takemura 	/* set scan interval */
    450   1.8  takemura 	vrpiu_write(sc, PIUSIVL_REG_W, sc->sc_interval);
    451   1.6      sato 
    452   1.6      sato 	s = spltty();
    453   1.6      sato 
    454   1.6      sato 	/* clear interrupt status */
    455   1.8  takemura 	vrpiu_write(sc, PIUINT_REG_W, TP_INTR);
    456   1.6      sato 
    457   1.6      sato 	/* Disable -> Standby */
    458   1.6      sato 	cnt = PIUCNT_PIUPWR |
    459  1.15       uch 	    PIUCNT_PIUMODE_COORDINATE |
    460  1.15       uch 	    PIUCNT_PADATSTART | PIUCNT_PADATSTOP;
    461   1.6      sato 	vrpiu_write(sc, PIUCNT_REG_W, cnt);
    462   1.6      sato 
    463   1.1  takemura 	/* Level2 interrupt register setting */
    464   1.8  takemura 	vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, TP_INTR, 1);
    465   1.6      sato 
    466   1.6      sato 	/* save pen status, touch or release */
    467   1.6      sato 	cnt = vrpiu_read(sc, PIUCNT_REG_W);
    468   1.1  takemura 
    469   1.1  takemura 	/*
    470   1.1  takemura 	 * Enable scan sequencer operation
    471   1.1  takemura 	 * Standby -> WaitPenTouch
    472   1.1  takemura 	 */
    473   1.1  takemura 	cnt |= PIUCNT_PIUSEQEN;
    474   1.1  takemura 	vrpiu_write(sc, PIUCNT_REG_W, cnt);
    475   1.1  takemura 
    476   1.1  takemura 	/* transit status DISABLE -> TOUCH or RELEASE */
    477   1.6      sato 	sc->sc_tpstat = (cnt & PIUCNT_PENSTC) ?
    478  1.15       uch 	    VRPIU_TP_STAT_TOUCH : VRPIU_TP_STAT_RELEASE;
    479   1.1  takemura 
    480   1.1  takemura 	splx(s);
    481   1.1  takemura 
    482   1.1  takemura 	return 0;
    483   1.1  takemura }
    484   1.1  takemura 
    485   1.1  takemura void
    486  1.15       uch vrpiu_tp_disable(void *v)
    487   1.1  takemura {
    488   1.1  takemura 	struct vrpiu_softc *sc = v;
    489   1.1  takemura 
    490   1.6      sato 	DPRINTF(("%s(%d): vrpiu_tp_disable()\n", __FILE__, __LINE__));
    491   1.1  takemura 
    492   1.1  takemura 	/* Set level2 interrupt register to mask interrupts */
    493   1.8  takemura 	vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, TP_INTR, 0);
    494   1.1  takemura 
    495   1.6      sato 	sc->sc_tpstat = VRPIU_TP_STAT_DISABLE;
    496   1.1  takemura 
    497   1.6      sato 	if (sc->sc_adstat == VRPIU_AD_STAT_DISABLE){
    498  1.15       uch 		/* Disable scan sequencer operation and power off */
    499  1.15       uch 		vrpiu_write(sc, PIUCNT_REG_W, 0);
    500   1.1  takemura 
    501  1.15       uch 		/* mask clock to PIU */
    502  1.20  takemura 		vrip_power(sc->sc_vrip, sc->sc_unit, 0);
    503   1.6      sato 	}
    504   1.1  takemura }
    505   1.1  takemura 
    506   1.1  takemura int
    507  1.15       uch vrpiu_tp_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
    508   1.1  takemura {
    509   1.1  takemura 	struct vrpiu_softc *sc = v;
    510   1.1  takemura 
    511   1.6      sato 	DPRINTF(("%s(%d): vrpiu_tp_ioctl(%08lx)\n", __FILE__, __LINE__, cmd));
    512   1.1  takemura 
    513   1.1  takemura 	switch (cmd) {
    514   1.1  takemura 	case WSMOUSEIO_GTYPE:
    515  1.15       uch 		*(u_int *)data = WSMOUSE_TYPE_TPANEL;
    516  1.15       uch 		break;
    517   1.1  takemura 
    518   1.1  takemura 	case WSMOUSEIO_SRES:
    519  1.15       uch 	{
    520   1.8  takemura 		int tp_enable;
    521   1.8  takemura 		int ad_enable;
    522   1.8  takemura 
    523   1.8  takemura 		tp_enable = (sc->sc_tpstat != VRPIU_TP_STAT_DISABLE);
    524   1.8  takemura 		ad_enable = (sc->sc_adstat != VRPIU_AD_STAT_DISABLE);
    525   1.8  takemura 
    526   1.8  takemura 		if (tp_enable)
    527  1.15       uch 			vrpiu_tp_disable(sc);
    528   1.8  takemura 		if (ad_enable)
    529  1.15       uch 			vrpiu_ad_disable(sc);
    530   1.8  takemura 
    531   1.8  takemura 		sc->sc_interval = scan_interval(*(u_int *)data);
    532   1.8  takemura 		DPRINTF(("%s(%d): WSMOUSEIO_SRES: *data=%d, interval=0x%03x\n",
    533   1.8  takemura 		    __FILE__, __LINE__, *(u_int *)data, sc->sc_interval));
    534   1.8  takemura 
    535   1.8  takemura 		if (sc->sc_interval < PIUSIVL_SCANINTVAL_MIN)
    536  1.15       uch 			sc->sc_interval = PIUSIVL_SCANINTVAL_MIN;
    537   1.8  takemura 
    538   1.8  takemura 		if (PIUSIVL_SCANINTVAL_MAX < sc->sc_interval)
    539  1.15       uch 			sc->sc_interval = PIUSIVL_SCANINTVAL_MAX;
    540   1.8  takemura 
    541   1.8  takemura 		if (tp_enable)
    542  1.15       uch 			vrpiu_tp_enable(sc);
    543   1.8  takemura 		if (ad_enable)
    544  1.15       uch 			vrpiu_ad_enable(sc);
    545  1.15       uch 	}
    546  1.15       uch 	break;
    547   1.3  takemura 
    548   1.3  takemura 	case WSMOUSEIO_SCALIBCOORDS:
    549   1.3  takemura 	case WSMOUSEIO_GCALIBCOORDS:
    550  1.27  takemura 	case WSMOUSEIO_GETID:
    551  1.15       uch 		return tpcalib_ioctl(&sc->sc_tpcalib, cmd, data, flag, p);
    552   1.1  takemura 
    553   1.1  takemura 	default:
    554  1.23    atatat 		return (EPASSTHROUGH);
    555   1.1  takemura 	}
    556   1.1  takemura 	return (0);
    557   1.1  takemura }
    558   1.1  takemura 
    559   1.1  takemura /*
    560   1.6      sato  * PIU AD interrupt handler.
    561   1.6      sato  */
    562   1.6      sato void
    563  1.15       uch vrpiu_ad_intr(struct vrpiu_softc *sc)
    564   1.6      sato {
    565   1.6      sato 	unsigned int i;
    566   1.6      sato 	unsigned int intrstat;
    567   1.6      sato 
    568   1.6      sato 	intrstat = vrpiu_read(sc, PIUINT_REG_W);
    569   1.6      sato 
    570   1.6      sato 	if (sc->sc_adstat == VRPIU_AD_STAT_DISABLE) {
    571  1.15       uch 		/*
    572  1.15       uch 		 * the device isn't enabled. just clear interrupt.
    573  1.15       uch 		 */
    574  1.15       uch 		vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
    575  1.15       uch 		return;
    576   1.6      sato 	}
    577   1.6      sato 
    578   1.6      sato 	if (intrstat & PIUINT_PADADPINTR) {
    579  1.15       uch 		sc->sc_battery.value[0] = (unsigned int)
    580  1.22  takemura 		    vrpiu_buf_read(sc, PIUAB(0));
    581  1.15       uch 		sc->sc_battery.value[1] = (unsigned int)
    582  1.22  takemura 		    vrpiu_buf_read(sc, PIUAB(1));
    583  1.15       uch 		sc->sc_battery.value[2] = (unsigned int)
    584  1.22  takemura 		    vrpiu_buf_read(sc, PIUAB(2));
    585   1.6      sato 	}
    586   1.6      sato 
    587   1.6      sato 	if (intrstat & PIUINT_PADADPINTR) {
    588  1.15       uch 		for (i = 0; i < 3; i++) {
    589  1.15       uch 			if (sc->sc_battery.value[i] & PIUAB_VALID)
    590  1.26  takemura 				sc->sc_battery.value[i] &=
    591  1.26  takemura 					sc->sc_ab_paddata_mask;
    592  1.15       uch 			else
    593  1.15       uch 				sc->sc_battery.value[i] = 0;
    594  1.15       uch 		}
    595  1.15       uch 		vrpiu_calc_powerstate(sc);
    596   1.6      sato 	}
    597   1.8  takemura 	vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
    598   1.6      sato 
    599   1.6      sato 	return;
    600   1.6      sato }
    601   1.6      sato /*
    602   1.6      sato  * PIU TP interrupt handler.
    603   1.1  takemura  */
    604   1.6      sato void
    605  1.15       uch vrpiu_tp_intr(struct vrpiu_softc *sc)
    606   1.1  takemura {
    607   1.1  takemura 	unsigned int cnt, i;
    608   1.1  takemura 	unsigned int intrstat, page;
    609   1.1  takemura 	int tpx0, tpx1, tpy0, tpy1;
    610   1.1  takemura 	int x, y, xraw, yraw;
    611   1.1  takemura 
    612   1.1  takemura 	intrstat = vrpiu_read(sc, PIUINT_REG_W);
    613   1.1  takemura 
    614   1.6      sato 	if (sc->sc_tpstat == VRPIU_TP_STAT_DISABLE) {
    615  1.15       uch 		/*
    616  1.15       uch 		 * the device isn't enabled. just clear interrupt.
    617  1.15       uch 		 */
    618  1.15       uch 		vrpiu_write(sc, PIUINT_REG_W, intrstat & TP_INTR);
    619  1.15       uch 		return;
    620   1.1  takemura 	}
    621   1.1  takemura 
    622   1.1  takemura 	page = (intrstat & PIUINT_OVP) ? 1 : 0;
    623   1.1  takemura 	if (intrstat & (PIUINT_PADPAGE0INTR | PIUINT_PADPAGE1INTR)) {
    624  1.22  takemura 		tpx0 = vrpiu_buf_read(sc, PIUPB(page, 0));
    625  1.22  takemura 		tpx1 = vrpiu_buf_read(sc, PIUPB(page, 1));
    626  1.22  takemura 		tpy0 = vrpiu_buf_read(sc, PIUPB(page, 2));
    627  1.22  takemura 		tpy1 = vrpiu_buf_read(sc, PIUPB(page, 3));
    628   1.1  takemura 	}
    629   1.1  takemura 
    630   1.1  takemura 	if (intrstat & PIUINT_PADDLOSTINTR) {
    631  1.15       uch 		page = page ? 0 : 1;
    632  1.15       uch 		for (i = 0; i < 4; i++)
    633  1.22  takemura 			vrpiu_buf_read(sc, PIUPB(page, i));
    634   1.1  takemura 	}
    635   1.1  takemura 
    636   1.1  takemura 	cnt = vrpiu_read(sc, PIUCNT_REG_W);
    637   1.1  takemura #ifdef DEBUG
    638   1.1  takemura 	if (vrpiu_debug)
    639  1.15       uch 		vrpiu_dump_cntreg(cnt);
    640   1.1  takemura #endif
    641   1.1  takemura 
    642   1.1  takemura 	/* clear interrupt status */
    643   1.8  takemura 	vrpiu_write(sc, PIUINT_REG_W, intrstat & TP_INTR);
    644   1.1  takemura 
    645   1.1  takemura #if 0
    646   1.1  takemura 	DPRINTF(("vrpiu_intr: OVP=%d", page));
    647   1.1  takemura 	if (intrstat & PIUINT_PADCMDINTR)
    648  1.15       uch 		DPRINTF((" CMD"));
    649   1.1  takemura 	if (intrstat & PIUINT_PADADPINTR)
    650  1.15       uch 		DPRINTF((" A/D"));
    651   1.1  takemura 	if (intrstat & PIUINT_PADPAGE1INTR)
    652  1.15       uch 		DPRINTF((" PAGE1"));
    653   1.1  takemura 	if (intrstat & PIUINT_PADPAGE0INTR)
    654  1.15       uch 		DPRINTF((" PAGE0"));
    655   1.1  takemura 	if (intrstat & PIUINT_PADDLOSTINTR)
    656  1.15       uch 		DPRINTF((" DLOST"));
    657   1.1  takemura 	if (intrstat & PIUINT_PENCHGINTR)
    658  1.15       uch 		DPRINTF((" PENCHG"));
    659   1.1  takemura 	DPRINTF(("\n"));
    660   1.1  takemura #endif
    661   1.1  takemura 	if (intrstat & (PIUINT_PADPAGE0INTR | PIUINT_PADPAGE1INTR)) {
    662  1.15       uch 		/*
    663  1.15       uch 		 * just ignore scan data if status isn't Touch.
    664  1.15       uch 		 */
    665  1.15       uch 		if (sc->sc_tpstat == VRPIU_TP_STAT_TOUCH) {
    666  1.15       uch 			/* reset tp scan timeout	*/
    667  1.15       uch 			callout_reset(&sc->sc_tptimeout, VRPIU_TP_SCAN_TIMEOUT,
    668  1.15       uch 			    vrpiu_tp_timeout, sc);
    669  1.15       uch 
    670  1.15       uch 			if (!((tpx0 & PIUPB_VALID) && (tpx1 & PIUPB_VALID) &&
    671  1.15       uch 			    (tpy0 & PIUPB_VALID) && (tpy1 & PIUPB_VALID))) {
    672  1.15       uch 				printf("vrpiu: internal error,"
    673  1.15       uch 				    " data is not valid!\n");
    674  1.15       uch 			} else {
    675  1.26  takemura 				tpx0 &= sc->sc_pb_paddata_mask;
    676  1.26  takemura 				tpx1 &= sc->sc_pb_paddata_mask;
    677  1.26  takemura 				tpy0 &= sc->sc_pb_paddata_mask;
    678  1.26  takemura 				tpy1 &= sc->sc_pb_paddata_mask;
    679  1.28  takemura #define ISVALID(n, c)	((c) - (c)/5 < (n) && (n) < (c) + (c)/5)
    680  1.28  takemura 				if (ISVALID(tpx0 + tpx1, sc->sc_pb_paddata_max) &&
    681  1.28  takemura 				    ISVALID(tpy0 + tpy1, sc->sc_pb_paddata_max)) {
    682   1.1  takemura #if 0
    683  1.15       uch 					DPRINTF(("%04x %04x %04x %04x\n",
    684  1.15       uch 					    tpx0, tpx1, tpy0, tpy1));
    685  1.15       uch 					DPRINTF(("%3d %3d (%4d %4d)->", tpx0,
    686  1.15       uch 					    tpy0, tpx0 + tpx1, tpy0 + tpy1));
    687   1.1  takemura #endif
    688  1.26  takemura 					xraw = tpy1 * sc->sc_pb_paddata_max / (tpy0 + tpy1);
    689  1.26  takemura 					yraw = tpx1 * sc->sc_pb_paddata_max / (tpx0 + tpx1);
    690  1.15       uch 					DPRINTF(("%3d %3d", xraw, yraw));
    691  1.15       uch 
    692  1.15       uch 					tpcalib_trans(&sc->sc_tpcalib, xraw,
    693  1.15       uch 					    yraw, &x, &y);
    694  1.15       uch 
    695  1.15       uch 					DPRINTF(("->%4d %4d", x, y));
    696  1.15       uch 					wsmouse_input(sc->sc_wsmousedev,
    697  1.15       uch 					    1, /* button 0 down */
    698  1.15       uch 					    x, /* x */
    699  1.15       uch 					    y, /* y */
    700  1.15       uch 					    0, /* z */
    701  1.15       uch 					    WSMOUSE_INPUT_ABSOLUTE_X |
    702  1.15       uch 					    WSMOUSE_INPUT_ABSOLUTE_Y);
    703  1.15       uch 					DPRINTF(("\n"));
    704  1.15       uch 				}
    705  1.15       uch 			}
    706   1.4  takemura 		}
    707   1.4  takemura 	}
    708   1.4  takemura 
    709   1.4  takemura 	if (cnt & PIUCNT_PENSTC) {
    710  1.15       uch 		if (sc->sc_tpstat == VRPIU_TP_STAT_RELEASE) {
    711  1.15       uch 			/*
    712  1.15       uch 			 * pen touch
    713  1.15       uch 			 */
    714  1.15       uch 			DPRINTF(("PEN TOUCH\n"));
    715  1.15       uch 			sc->sc_tpstat = VRPIU_TP_STAT_TOUCH;
    716  1.15       uch 			/*
    717  1.15       uch 			 * We should not report button down event while
    718  1.15       uch 			 * we don't know where it occur.
    719  1.15       uch 			 */
    720  1.15       uch 
    721  1.15       uch 			/* set tp scan timeout	*/
    722  1.15       uch 			callout_reset(&sc->sc_tptimeout, VRPIU_TP_SCAN_TIMEOUT,
    723  1.15       uch 			    vrpiu_tp_timeout, sc);
    724  1.15       uch 		}
    725   1.4  takemura 	} else {
    726  1.15       uch 		vrpiu_tp_up(sc);
    727   1.1  takemura 	}
    728   1.1  takemura 
    729   1.1  takemura 	if (intrstat & PIUINT_PADDLOSTINTR) {
    730  1.15       uch 		cnt |= PIUCNT_PIUSEQEN;
    731  1.15       uch 		vrpiu_write(sc, PIUCNT_REG_W, cnt);
    732   1.1  takemura 	}
    733   1.1  takemura 
    734   1.6      sato 	return;
    735  1.10  takemura }
    736  1.10  takemura 
    737  1.10  takemura void
    738  1.15       uch vrpiu_tp_up(struct vrpiu_softc *sc)
    739  1.10  takemura {
    740  1.10  takemura 	if (sc->sc_tpstat == VRPIU_TP_STAT_TOUCH) {
    741  1.15       uch 		/*
    742  1.15       uch 		 * pen release
    743  1.15       uch 		 */
    744  1.15       uch 		DPRINTF(("RELEASE\n"));
    745  1.15       uch 		sc->sc_tpstat = VRPIU_TP_STAT_RELEASE;
    746  1.10  takemura 
    747  1.15       uch 		/* clear tp scan timeout	*/
    748  1.15       uch 		callout_stop(&sc->sc_tptimeout);
    749  1.10  takemura 
    750  1.15       uch 		/* button 0 UP */
    751  1.15       uch 		wsmouse_input(sc->sc_wsmousedev, 0, 0, 0, 0, 0);
    752  1.10  takemura 	}
    753  1.10  takemura }
    754  1.10  takemura 
    755  1.10  takemura /* touch panel timeout handler */
    756  1.10  takemura void
    757  1.15       uch vrpiu_tp_timeout(void *v)
    758  1.10  takemura {
    759  1.10  takemura 	struct vrpiu_softc *sc = (struct vrpiu_softc *)v;
    760  1.10  takemura 
    761  1.10  takemura #ifdef VRPIUDEBUG
    762  1.10  takemura 	{
    763  1.15       uch 		unsigned int cnt = vrpiu_read(sc, PIUCNT_REG_W);
    764  1.15       uch 		DPRINTF(("TIMEOUT: stat=%s  reg=%s\n",
    765  1.15       uch 		    (sc->sc_tpstat == VRPIU_TP_STAT_TOUCH)?"touch":"release",
    766  1.15       uch 		    (cnt & PIUCNT_PENSTC)?"touch":"release"));
    767  1.10  takemura 	}
    768  1.10  takemura #endif
    769  1.10  takemura 	vrpiu_tp_up(sc);
    770   1.6      sato }
    771   1.6      sato 
    772   1.6      sato /*
    773   1.6      sato  * PIU interrupt handler.
    774   1.6      sato  */
    775   1.6      sato int
    776  1.15       uch vrpiu_intr(void *arg)
    777   1.6      sato {
    778   1.6      sato         struct vrpiu_softc *sc = arg;
    779   1.6      sato 
    780   1.6      sato 	vrpiu_ad_intr(sc);
    781   1.6      sato 	vrpiu_tp_intr(sc);
    782   1.6      sato 
    783   1.1  takemura 	return 0;
    784   1.6      sato }
    785   1.6      sato 
    786   1.6      sato void
    787  1.15       uch vrpiu_start_powerstate(void *v)
    788   1.6      sato {
    789   1.6      sato 	int mask;
    790   1.6      sato 	struct vrpiu_softc *sc = (struct vrpiu_softc *)v;
    791   1.6      sato 
    792   1.6      sato 	vrpiu_ad_enable(sc);
    793   1.6      sato 	mask = vrpiu_read(sc, PIUAMSK_REG_W);
    794   1.6      sato 	mask &= 0xff8f; /* XXX */
    795   1.6      sato 	vrpiu_write(sc, PIUAMSK_REG_W, mask);
    796   1.6      sato 	vrpiu_write(sc, PIUASCN_REG_W, PIUACN_ADPSSTART);
    797   1.6      sato 	/*
    798   1.6      sato 	 * restart next A/D polling
    799   1.6      sato 	 */
    800   1.6      sato 	callout_reset(&sc->sc_adpoll, hz*vrpiu_ad_poll_interval,
    801  1.15       uch 	    vrpiu_start_powerstate, sc);
    802   1.6      sato }
    803   1.6      sato 
    804   1.6      sato void
    805  1.15       uch vrpiu_calc_powerstate(struct vrpiu_softc *sc)
    806   1.6      sato {
    807  1.15       uch 	extern void vrgiu_diff_io(void);
    808   1.6      sato 	vrpiu_ad_disable(sc);
    809   1.6      sato 	VPRINTF(("vrpiu:AD: %d, %d, %d\n",
    810  1.15       uch 	    sc->sc_battery.value[0],
    811  1.15       uch 	    sc->sc_battery.value[1],
    812  1.15       uch 	    sc->sc_battery.value[2]));
    813   1.6      sato 	sc->sc_battery.nextpoll = hz*vrpiu_ad_poll_interval;
    814  1.14      sato 	vrpiu_send_battery_event(sc);
    815   1.6      sato 	/*
    816   1.6      sato 	 * restart next A/D polling if change polling timming.
    817   1.6      sato 	 */
    818   1.6      sato 	if (sc->sc_battery.nextpoll != hz*vrpiu_ad_poll_interval)
    819  1.15       uch 		callout_reset(&sc->sc_adpoll, sc->sc_battery.nextpoll,
    820  1.15       uch 		    vrpiu_start_powerstate, sc);
    821   1.6      sato 	if (bootverbose)
    822  1.15       uch 		vrgiu_diff_io();
    823   1.6      sato 
    824   1.6      sato }
    825   1.6      sato 
    826   1.6      sato static void
    827  1.15       uch vrpiu_power(int why, void *arg)
    828   1.6      sato {
    829   1.6      sato 	struct vrpiu_softc *sc = arg;
    830   1.6      sato 
    831   1.6      sato 	switch (why) {
    832   1.6      sato 	case PWR_STANDBY:
    833   1.6      sato 	case PWR_SUSPEND:
    834  1.15       uch 		break;
    835   1.6      sato 	case PWR_RESUME:
    836  1.15       uch 		callout_reset(&sc->sc_adpoll, hz,
    837  1.15       uch 		    vrpiu_start_powerstate, sc);
    838  1.15       uch 		break;
    839   1.6      sato 	}
    840  1.14      sato }
    841  1.14      sato 
    842  1.14      sato static void
    843  1.15       uch vrpiu_send_battery_event(struct vrpiu_softc *sc)
    844  1.14      sato {
    845  1.14      sato #ifdef VRPIU_ADHOC_BATTERY_EVENT
    846  1.14      sato 	static int batteryhigh = 0;
    847  1.14      sato 	static int batterylow = 0;
    848  1.14      sato 	static int critical = 0;
    849  1.14      sato 
    850  1.14      sato 	if (sc->sc_battery_spec == NULL
    851  1.15       uch 	    || sc->sc_battery_spec->main_port == -1)
    852  1.14      sato 		return;
    853  1.14      sato 
    854  1.14      sato 	if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
    855  1.15       uch 	    <= sc->sc_battery_spec->dc_critical) {
    856  1.15       uch 		batteryhigh = 0;
    857  1.15       uch 		config_hook_call(CONFIG_HOOK_PMEVENT,
    858  1.15       uch 		    CONFIG_HOOK_PMEVENT_BATTERY,
    859  1.15       uch 		    (void *)CONFIG_HOOK_BATT_CRITICAL);
    860  1.15       uch 		batterylow = 3;
    861  1.15       uch 		if (critical) {
    862  1.14      sato 			config_hook_call(CONFIG_HOOK_PMEVENT,
    863  1.15       uch 			    CONFIG_HOOK_PMEVENT_SUSPENDREQ,
    864  1.15       uch 			    (void *)0);
    865  1.15       uch 			critical = 0;
    866  1.15       uch 			batterylow = 0;
    867  1.15       uch 		}
    868  1.15       uch 		critical++;
    869  1.14      sato 	} else if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
    870  1.15       uch 	    <= sc->sc_battery_spec->dc_20p) {
    871  1.15       uch 		batteryhigh = 0;
    872  1.15       uch 		if (batterylow == 1)
    873  1.14      sato 			config_hook_call(CONFIG_HOOK_PMEVENT,
    874  1.15       uch 			    CONFIG_HOOK_PMEVENT_BATTERY,
    875  1.15       uch 			    (void *)CONFIG_HOOK_BATT_20P);
    876  1.15       uch 		config_hook_call(CONFIG_HOOK_PMEVENT,
    877  1.15       uch 		    CONFIG_HOOK_PMEVENT_BATTERY,
    878  1.15       uch 		    (void *)CONFIG_HOOK_BATT_LOW);
    879  1.15       uch 		batterylow = 2;
    880  1.14      sato 	} else if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
    881  1.15       uch 	    <= sc->sc_battery_spec->dc_50p) {
    882  1.15       uch 		batteryhigh = 0;
    883  1.15       uch 		if (batterylow == 0) {
    884  1.15       uch 			batterylow = 1;
    885  1.15       uch 			config_hook_call(CONFIG_HOOK_PMEVENT,
    886  1.15       uch 			    CONFIG_HOOK_PMEVENT_BATTERY,
    887  1.15       uch 			    (void *)CONFIG_HOOK_BATT_50P);
    888  1.15       uch 		}
    889  1.14      sato 	} else if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
    890  1.15       uch 	    >= sc->sc_battery_spec->ac_80p) {
    891  1.15       uch 		batterylow = 0;
    892  1.15       uch 		if (batteryhigh == 0) {
    893  1.15       uch 			batteryhigh = 1;
    894  1.15       uch 			config_hook_call(CONFIG_HOOK_PMEVENT,
    895  1.15       uch 			    CONFIG_HOOK_PMEVENT_BATTERY,
    896  1.15       uch 			    (void *)CONFIG_HOOK_BATT_80P);
    897  1.15       uch 			config_hook_call(CONFIG_HOOK_PMEVENT,
    898  1.15       uch 			    CONFIG_HOOK_PMEVENT_BATTERY,
    899  1.15       uch 			    (void *)CONFIG_HOOK_BATT_HIGH);
    900  1.15       uch 		}
    901  1.14      sato 	}
    902  1.14      sato #else /* VRPIU_ADHOC_BATTERY_EVENT */
    903  1.14      sato 	config_hook_call(CONFIG_HOOK_SET,
    904  1.15       uch 	    CONFIG_HOOK_BATTERYVAL,
    905  1.15       uch 	    (void *)&sc->sc_battery);
    906  1.14      sato #endif /* VRPIU_ADHOC_BATTERY_EVENT */
    907   1.1  takemura }
    908   1.1  takemura 
    909   1.1  takemura #ifdef DEBUG
    910   1.1  takemura void
    911  1.15       uch vrpiu_dump_cntreg(unsigned int cnt)
    912   1.1  takemura {
    913   1.1  takemura 	printf("%s", (cnt & PIUCNT_PENSTC) ? "Touch" : "Release");
    914   1.1  takemura 	printf(" state=");
    915   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_CmdScan)
    916  1.15       uch 		printf("CmdScan");
    917   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_IntervalNextScan)
    918  1.15       uch 		printf("IntervalNextScan");
    919   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_PenDataScan)
    920  1.15       uch 		printf("PenDataScan");
    921   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_WaitPenTouch)
    922  1.15       uch 		printf("WaitPenTouch");
    923   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_RFU)
    924  1.15       uch 		printf("???");
    925   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_ADPortScan)
    926  1.15       uch 		printf("ADPortScan");
    927   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_Standby)
    928  1.15       uch 		printf("Standby");
    929   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_Disable)
    930  1.15       uch 		printf("Disable");
    931   1.1  takemura 	if (cnt & PIUCNT_PADATSTOP)
    932  1.15       uch 		printf(" AutoStop");
    933   1.1  takemura 	if (cnt & PIUCNT_PADATSTART)
    934  1.15       uch 		printf(" AutoStart");
    935   1.1  takemura 	if (cnt & PIUCNT_PADSCANSTOP)
    936  1.15       uch 		printf(" Stop");
    937   1.1  takemura 	if (cnt & PIUCNT_PADSCANSTART)
    938  1.15       uch 		printf(" Start");
    939   1.1  takemura 	if (cnt & PIUCNT_PADSCANTYPE)
    940  1.15       uch 		printf(" ScanPressure");
    941   1.1  takemura 	if ((cnt & PIUCNT_PIUMODE_MASK) == PIUCNT_PIUMODE_ADCONVERTER)
    942  1.15       uch 		printf(" A/D");
    943   1.1  takemura 	if ((cnt & PIUCNT_PIUMODE_MASK) == PIUCNT_PIUMODE_COORDINATE)
    944  1.15       uch 		printf(" Coordinate");
    945   1.1  takemura 	if (cnt & PIUCNT_PIUSEQEN)
    946  1.15       uch 		printf(" SeqEn");
    947   1.1  takemura 	if ((cnt & PIUCNT_PIUPWR) == 0)
    948  1.15       uch 		printf(" PowerOff");
    949   1.1  takemura 	if ((cnt & PIUCNT_PADRST) == 0)
    950  1.15       uch 		printf(" Reset");
    951   1.1  takemura 	printf("\n");
    952   1.1  takemura }
    953   1.1  takemura #endif
    954