Home | History | Annotate | Line # | Download | only in vr
vrpiu.c revision 1.37
      1  1.37  jmcneill /*	$NetBSD: vrpiu.c,v 1.37 2006/09/24 03:53:07 jmcneill 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.37  jmcneill __KERNEL_RCSID(0, "$NetBSD: vrpiu.c,v 1.37 2006/09/24 03:53:07 jmcneill 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.33    tsarna #include <dev/hpc/hpctpanelvar.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.35  christos static int	vrpiu_tp_ioctl(void *, u_long, caddr_t, int, struct lwp *);
    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.30        he 	if (va->va_parent_ioh != 0)
    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.30        he 	if (va->va_parent_ioh != 0)
    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.32      shin 			{ &platid_mask_MACH_NEC_MCR_730A,
    284  1.32      shin 			  { 0, 0, 799, 599,
    285  1.32      shin 			    4,
    286  1.32      shin 			    { { 115,  80,   0,   0 },
    287  1.32      shin 			      { 115, 966,   0, 599 },
    288  1.32      shin 			      { 912,  80, 799,   0 },
    289  1.32      shin 			      { 912, 966, 799, 599 } } } },
    290  1.15       uch 			{ NULL,		/* samples got on my MC-R500 */
    291  1.15       uch 			  { 0, 0, 639, 239,
    292  1.15       uch 			    5,
    293  1.15       uch 			    { { 502, 486, 320, 120 },
    294  1.15       uch 			      {  55, 109,   0,   0 },
    295  1.15       uch 			      {  54, 913,   0, 239 },
    296  1.15       uch 			      { 973, 924, 639, 239 },
    297  1.15       uch 			      { 975, 123, 639,   0 } } } },
    298  1.15       uch 		};
    299  1.15       uch 		for (i = 0; ; i++) {
    300  1.15       uch 			if (calibrations[i].mask == NULL
    301  1.15       uch 			    || platid_match(&platid, calibrations[i].mask))
    302  1.15       uch 				break;
    303  1.15       uch 		}
    304  1.15       uch 		tpcalib_ioctl(&sc->sc_tpcalib, WSMOUSEIO_SCALIBCOORDS,
    305  1.34        he 		    (caddr_t)__UNCONST(&calibrations[i].coords), 0, 0);
    306   1.1  takemura 	}
    307   1.1  takemura #endif
    308   1.1  takemura 
    309   1.1  takemura 	/* install interrupt handler and enable interrupt */
    310  1.36     blymn 	if (!(sc->sc_handler =
    311  1.20  takemura 	    vrip_intr_establish(sc->sc_vrip, sc->sc_unit, 0, IPL_TTY,
    312  1.15       uch 		vrpiu_intr, sc))) {
    313  1.15       uch 		printf (": can't map interrupt line.\n");
    314  1.15       uch 		return;
    315   1.1  takemura 	}
    316   1.1  takemura 
    317   1.1  takemura 	/* mask level2 interrupt, stop scan sequencer and mask clock to piu */
    318   1.6      sato 	vrpiu_tp_disable(sc);
    319   1.1  takemura 
    320   1.1  takemura 	printf("\n");
    321   1.1  takemura 
    322   1.1  takemura 	wsmaa.accessops = &vrpiu_accessops;
    323   1.1  takemura 	wsmaa.accesscookie = sc;
    324   1.1  takemura 
    325   1.1  takemura 	/*
    326   1.1  takemura 	 * attach the wsmouse
    327   1.1  takemura 	 */
    328  1.26  takemura 	sc->sc_wsmousedev = config_found(&sc->sc_dev, &wsmaa, wsmousedevprint);
    329   1.6      sato 
    330   1.6      sato 	/*
    331   1.6      sato 	 * power management events
    332   1.6      sato 	 */
    333  1.37  jmcneill 	sc->sc_power_hook = powerhook_establish(sc->sc_dev.dv_xname,
    334  1.37  jmcneill 	    vrpiu_power, sc);
    335  1.37  jmcneill 	if (sc->sc_power_hook == NULL)
    336  1.37  jmcneill 		aprint_error("%s: WARNING: couldn't establish powerhook\n",
    337  1.37  jmcneill 		    sc->sc_dev.dv_xname);
    338  1.36     blymn 
    339   1.6      sato 	/*
    340   1.6      sato 	 * init A/D port polling.
    341   1.6      sato 	 */
    342   1.6      sato 	sc->sc_battery.n_values = 3;
    343   1.6      sato 	sc->sc_battery.value[0] = -1;
    344   1.6      sato 	sc->sc_battery.value[1] = -1;
    345   1.6      sato 	sc->sc_battery.value[2] = -1;
    346   1.6      sato 	sc->sc_battery.nextpoll = hz*vrpiu_ad_poll_interval;
    347   1.6      sato 	callout_init(&sc->sc_adpoll);
    348   1.9  takemura 	callout_reset(&sc->sc_adpoll, hz, vrpiu_start_powerstate, sc);
    349   1.1  takemura }
    350   1.1  takemura 
    351   1.8  takemura /*
    352   1.8  takemura  * calculate interval value
    353   1.8  takemura  *  input: WSMOUSE_RES_MIN - WSMOUSE_RES_MAX
    354   1.8  takemura  * output: value for PIUSIVL_REG
    355   1.8  takemura  */
    356   1.8  takemura static u_int
    357   1.8  takemura scan_interval(u_int data)
    358   1.8  takemura {
    359   1.8  takemura 	int scale;
    360   1.8  takemura 
    361   1.8  takemura 	if (data < WSMOUSE_RES_MIN)
    362  1.15       uch 		data = WSMOUSE_RES_MIN;
    363   1.8  takemura 
    364   1.8  takemura 	if (WSMOUSE_RES_MAX < data)
    365  1.15       uch 		data = WSMOUSE_RES_MAX;
    366   1.8  takemura 
    367   1.8  takemura 	scale = WSMOUSE_RES_MAX - WSMOUSE_RES_MIN;
    368   1.8  takemura 	data += WSMOUSE_RES_MIN;
    369   1.8  takemura 
    370  1.36     blymn 	return PIUSIVL_SCANINTVAL_MIN +
    371   1.8  takemura 	    (PIUSIVL_SCANINTVAL_MAX - PIUSIVL_SCANINTVAL_MIN) *
    372   1.8  takemura 	    (scale - data) / scale;
    373   1.8  takemura }
    374   1.8  takemura 
    375   1.1  takemura int
    376  1.15       uch vrpiu_ad_enable(void *v)
    377   1.1  takemura {
    378   1.1  takemura 	struct vrpiu_softc *sc = v;
    379   1.1  takemura 	int s;
    380   1.1  takemura 	unsigned int cnt;
    381   1.1  takemura 
    382   1.8  takemura 	DPRINTF(("%s(%d): vrpiu_ad_enable(): interval=0x%03x\n",
    383  1.15       uch 	    __FILE__, __LINE__, sc->sc_interval));
    384   1.6      sato 	if (sc->sc_adstat != VRPIU_AD_STAT_DISABLE)
    385  1.15       uch 		return EBUSY;
    386   1.1  takemura 
    387   1.1  takemura 	/* supply clock to PIU */
    388  1.20  takemura 	vrip_power(sc->sc_vrip, sc->sc_unit, 1);
    389   1.1  takemura 
    390   1.8  takemura 	/* set scan interval */
    391   1.8  takemura 	vrpiu_write(sc, PIUSIVL_REG_W, sc->sc_interval);
    392   1.1  takemura 
    393   1.1  takemura 	s = spltty();
    394   1.1  takemura 
    395   1.1  takemura 	/* clear interrupt status */
    396   1.8  takemura 	vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
    397   1.1  takemura 
    398   1.1  takemura 	/* Disable -> Standby */
    399   1.1  takemura 	cnt = PIUCNT_PIUPWR |
    400  1.15       uch 	    PIUCNT_PIUMODE_COORDINATE |
    401  1.15       uch 	    PIUCNT_PADATSTART | PIUCNT_PADATSTOP;
    402   1.1  takemura 	vrpiu_write(sc, PIUCNT_REG_W, cnt);
    403   1.1  takemura 
    404   1.6      sato 	/* Level2 interrupt register setting */
    405   1.8  takemura 	vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, AD_INTR, 1);
    406   1.6      sato 
    407   1.1  takemura 	/* save pen status, touch or release */
    408   1.1  takemura 	cnt = vrpiu_read(sc, PIUCNT_REG_W);
    409   1.1  takemura 
    410   1.6      sato 	/*
    411   1.6      sato 	 * Enable scan sequencer operation
    412   1.6      sato 	 * Standby -> WaitPenTouch
    413   1.6      sato 	 */
    414   1.6      sato 	cnt |= PIUCNT_PIUSEQEN;
    415   1.6      sato 	vrpiu_write(sc, PIUCNT_REG_W, cnt);
    416   1.6      sato 
    417   1.6      sato 	sc->sc_adstat = VRPIU_AD_STAT_ENABLE;
    418   1.6      sato 
    419   1.6      sato 	splx(s);
    420   1.6      sato 
    421   1.6      sato 	return 0;
    422   1.6      sato }
    423   1.6      sato 
    424   1.6      sato void
    425  1.15       uch vrpiu_ad_disable(void *v)
    426   1.6      sato {
    427   1.6      sato 	struct vrpiu_softc *sc = v;
    428   1.6      sato 
    429   1.6      sato 	DPRINTF(("%s(%d): vrpiu_ad_disable()\n", __FILE__, __LINE__));
    430   1.6      sato 
    431   1.6      sato 	/* Set level2 interrupt register to mask interrupts */
    432   1.8  takemura 	vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, AD_INTR, 0);
    433   1.6      sato 
    434   1.6      sato 	sc->sc_adstat = VRPIU_AD_STAT_DISABLE;
    435   1.6      sato 
    436   1.6      sato 	if (sc->sc_tpstat == VRPIU_TP_STAT_DISABLE){
    437  1.15       uch 		/* Disable scan sequencer operation and power off */
    438  1.15       uch 		vrpiu_write(sc, PIUCNT_REG_W, 0);
    439   1.6      sato 
    440  1.15       uch 		/* mask clock to PIU */
    441  1.20  takemura 		vrip_power(sc->sc_vrip, sc->sc_unit, 0);
    442   1.6      sato 	}
    443   1.6      sato }
    444   1.6      sato 
    445   1.6      sato int
    446  1.15       uch vrpiu_tp_enable(void *v)
    447   1.6      sato {
    448   1.6      sato 	struct vrpiu_softc *sc = v;
    449   1.6      sato 	int s;
    450   1.6      sato 	unsigned int cnt;
    451   1.6      sato 
    452   1.8  takemura 	DPRINTF(("%s(%d): vrpiu_tp_enable(): interval=0x%03x\n",
    453  1.15       uch 	    __FILE__, __LINE__, sc->sc_interval));
    454   1.6      sato 	if (sc->sc_tpstat != VRPIU_TP_STAT_DISABLE)
    455  1.15       uch 		return EBUSY;
    456   1.6      sato 
    457   1.6      sato 	/* supply clock to PIU */
    458  1.20  takemura 	vrip_power(sc->sc_vrip, sc->sc_unit, 1);
    459   1.6      sato 
    460   1.8  takemura 	/* set scan interval */
    461   1.8  takemura 	vrpiu_write(sc, PIUSIVL_REG_W, sc->sc_interval);
    462   1.6      sato 
    463   1.6      sato 	s = spltty();
    464   1.6      sato 
    465   1.6      sato 	/* clear interrupt status */
    466   1.8  takemura 	vrpiu_write(sc, PIUINT_REG_W, TP_INTR);
    467   1.6      sato 
    468   1.6      sato 	/* Disable -> Standby */
    469   1.6      sato 	cnt = PIUCNT_PIUPWR |
    470  1.15       uch 	    PIUCNT_PIUMODE_COORDINATE |
    471  1.15       uch 	    PIUCNT_PADATSTART | PIUCNT_PADATSTOP;
    472   1.6      sato 	vrpiu_write(sc, PIUCNT_REG_W, cnt);
    473   1.6      sato 
    474   1.1  takemura 	/* Level2 interrupt register setting */
    475   1.8  takemura 	vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, TP_INTR, 1);
    476   1.6      sato 
    477   1.6      sato 	/* save pen status, touch or release */
    478   1.6      sato 	cnt = vrpiu_read(sc, PIUCNT_REG_W);
    479   1.1  takemura 
    480   1.1  takemura 	/*
    481   1.1  takemura 	 * Enable scan sequencer operation
    482   1.1  takemura 	 * Standby -> WaitPenTouch
    483   1.1  takemura 	 */
    484   1.1  takemura 	cnt |= PIUCNT_PIUSEQEN;
    485   1.1  takemura 	vrpiu_write(sc, PIUCNT_REG_W, cnt);
    486   1.1  takemura 
    487   1.1  takemura 	/* transit status DISABLE -> TOUCH or RELEASE */
    488   1.6      sato 	sc->sc_tpstat = (cnt & PIUCNT_PENSTC) ?
    489  1.15       uch 	    VRPIU_TP_STAT_TOUCH : VRPIU_TP_STAT_RELEASE;
    490   1.1  takemura 
    491   1.1  takemura 	splx(s);
    492   1.1  takemura 
    493   1.1  takemura 	return 0;
    494   1.1  takemura }
    495   1.1  takemura 
    496   1.1  takemura void
    497  1.15       uch vrpiu_tp_disable(void *v)
    498   1.1  takemura {
    499   1.1  takemura 	struct vrpiu_softc *sc = v;
    500   1.1  takemura 
    501   1.6      sato 	DPRINTF(("%s(%d): vrpiu_tp_disable()\n", __FILE__, __LINE__));
    502   1.1  takemura 
    503   1.1  takemura 	/* Set level2 interrupt register to mask interrupts */
    504   1.8  takemura 	vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, TP_INTR, 0);
    505   1.1  takemura 
    506   1.6      sato 	sc->sc_tpstat = VRPIU_TP_STAT_DISABLE;
    507   1.1  takemura 
    508   1.6      sato 	if (sc->sc_adstat == VRPIU_AD_STAT_DISABLE){
    509  1.15       uch 		/* Disable scan sequencer operation and power off */
    510  1.15       uch 		vrpiu_write(sc, PIUCNT_REG_W, 0);
    511   1.1  takemura 
    512  1.15       uch 		/* mask clock to PIU */
    513  1.20  takemura 		vrip_power(sc->sc_vrip, sc->sc_unit, 0);
    514   1.6      sato 	}
    515   1.1  takemura }
    516   1.1  takemura 
    517   1.1  takemura int
    518  1.35  christos vrpiu_tp_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct lwp *l)
    519   1.1  takemura {
    520   1.1  takemura 	struct vrpiu_softc *sc = v;
    521   1.1  takemura 
    522   1.6      sato 	DPRINTF(("%s(%d): vrpiu_tp_ioctl(%08lx)\n", __FILE__, __LINE__, cmd));
    523   1.1  takemura 
    524   1.1  takemura 	switch (cmd) {
    525   1.1  takemura 	case WSMOUSEIO_SRES:
    526  1.15       uch 	{
    527   1.8  takemura 		int tp_enable;
    528   1.8  takemura 		int ad_enable;
    529   1.8  takemura 
    530   1.8  takemura 		tp_enable = (sc->sc_tpstat != VRPIU_TP_STAT_DISABLE);
    531   1.8  takemura 		ad_enable = (sc->sc_adstat != VRPIU_AD_STAT_DISABLE);
    532   1.8  takemura 
    533   1.8  takemura 		if (tp_enable)
    534  1.15       uch 			vrpiu_tp_disable(sc);
    535   1.8  takemura 		if (ad_enable)
    536  1.15       uch 			vrpiu_ad_disable(sc);
    537  1.36     blymn 
    538   1.8  takemura 		sc->sc_interval = scan_interval(*(u_int *)data);
    539   1.8  takemura 		DPRINTF(("%s(%d): WSMOUSEIO_SRES: *data=%d, interval=0x%03x\n",
    540   1.8  takemura 		    __FILE__, __LINE__, *(u_int *)data, sc->sc_interval));
    541  1.36     blymn 
    542   1.8  takemura 		if (sc->sc_interval < PIUSIVL_SCANINTVAL_MIN)
    543  1.15       uch 			sc->sc_interval = PIUSIVL_SCANINTVAL_MIN;
    544  1.36     blymn 
    545   1.8  takemura 		if (PIUSIVL_SCANINTVAL_MAX < sc->sc_interval)
    546  1.15       uch 			sc->sc_interval = PIUSIVL_SCANINTVAL_MAX;
    547   1.8  takemura 
    548   1.8  takemura 		if (tp_enable)
    549  1.15       uch 			vrpiu_tp_enable(sc);
    550   1.8  takemura 		if (ad_enable)
    551  1.15       uch 			vrpiu_ad_enable(sc);
    552  1.15       uch 	}
    553  1.15       uch 	break;
    554   1.3  takemura 
    555   1.1  takemura 	default:
    556  1.35  christos 		return hpc_tpanel_ioctl(&sc->sc_tpcalib, cmd, data, flag, l);
    557   1.1  takemura 	}
    558  1.33    tsarna 	return 0;
    559   1.1  takemura }
    560   1.1  takemura 
    561   1.1  takemura /*
    562   1.6      sato  * PIU AD interrupt handler.
    563   1.6      sato  */
    564   1.6      sato void
    565  1.15       uch vrpiu_ad_intr(struct vrpiu_softc *sc)
    566   1.6      sato {
    567   1.6      sato 	unsigned int i;
    568   1.6      sato 	unsigned int intrstat;
    569   1.6      sato 
    570   1.6      sato 	intrstat = vrpiu_read(sc, PIUINT_REG_W);
    571   1.6      sato 
    572   1.6      sato 	if (sc->sc_adstat == VRPIU_AD_STAT_DISABLE) {
    573  1.15       uch 		/*
    574  1.15       uch 		 * the device isn't enabled. just clear interrupt.
    575  1.15       uch 		 */
    576  1.15       uch 		vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
    577  1.15       uch 		return;
    578   1.6      sato 	}
    579   1.6      sato 
    580   1.6      sato 	if (intrstat & PIUINT_PADADPINTR) {
    581  1.15       uch 		sc->sc_battery.value[0] = (unsigned int)
    582  1.22  takemura 		    vrpiu_buf_read(sc, PIUAB(0));
    583  1.15       uch 		sc->sc_battery.value[1] = (unsigned int)
    584  1.22  takemura 		    vrpiu_buf_read(sc, PIUAB(1));
    585  1.15       uch 		sc->sc_battery.value[2] = (unsigned int)
    586  1.22  takemura 		    vrpiu_buf_read(sc, PIUAB(2));
    587   1.6      sato 	}
    588   1.6      sato 
    589   1.6      sato 	if (intrstat & PIUINT_PADADPINTR) {
    590  1.15       uch 		for (i = 0; i < 3; i++) {
    591  1.15       uch 			if (sc->sc_battery.value[i] & PIUAB_VALID)
    592  1.26  takemura 				sc->sc_battery.value[i] &=
    593  1.26  takemura 					sc->sc_ab_paddata_mask;
    594  1.15       uch 			else
    595  1.15       uch 				sc->sc_battery.value[i] = 0;
    596  1.15       uch 		}
    597  1.15       uch 		vrpiu_calc_powerstate(sc);
    598   1.6      sato 	}
    599   1.8  takemura 	vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
    600   1.6      sato 
    601   1.6      sato 	return;
    602   1.6      sato }
    603   1.6      sato /*
    604   1.6      sato  * PIU TP interrupt handler.
    605   1.1  takemura  */
    606   1.6      sato void
    607  1.15       uch vrpiu_tp_intr(struct vrpiu_softc *sc)
    608   1.1  takemura {
    609   1.1  takemura 	unsigned int cnt, i;
    610   1.1  takemura 	unsigned int intrstat, page;
    611   1.1  takemura 	int tpx0, tpx1, tpy0, tpy1;
    612   1.1  takemura 	int x, y, xraw, yraw;
    613   1.1  takemura 
    614  1.31      shin 	tpx0 = tpx1 = tpy0 = tpy1 = 0;	/* XXX: gcc -Wuninitialized */
    615  1.31      shin 
    616   1.1  takemura 	intrstat = vrpiu_read(sc, PIUINT_REG_W);
    617   1.1  takemura 
    618   1.6      sato 	if (sc->sc_tpstat == VRPIU_TP_STAT_DISABLE) {
    619  1.15       uch 		/*
    620  1.15       uch 		 * the device isn't enabled. just clear interrupt.
    621  1.15       uch 		 */
    622  1.15       uch 		vrpiu_write(sc, PIUINT_REG_W, intrstat & TP_INTR);
    623  1.15       uch 		return;
    624   1.1  takemura 	}
    625   1.1  takemura 
    626   1.1  takemura 	page = (intrstat & PIUINT_OVP) ? 1 : 0;
    627   1.1  takemura 	if (intrstat & (PIUINT_PADPAGE0INTR | PIUINT_PADPAGE1INTR)) {
    628  1.22  takemura 		tpx0 = vrpiu_buf_read(sc, PIUPB(page, 0));
    629  1.22  takemura 		tpx1 = vrpiu_buf_read(sc, PIUPB(page, 1));
    630  1.22  takemura 		tpy0 = vrpiu_buf_read(sc, PIUPB(page, 2));
    631  1.22  takemura 		tpy1 = vrpiu_buf_read(sc, PIUPB(page, 3));
    632   1.1  takemura 	}
    633   1.1  takemura 
    634   1.1  takemura 	if (intrstat & PIUINT_PADDLOSTINTR) {
    635  1.15       uch 		page = page ? 0 : 1;
    636  1.15       uch 		for (i = 0; i < 4; i++)
    637  1.22  takemura 			vrpiu_buf_read(sc, PIUPB(page, i));
    638   1.1  takemura 	}
    639   1.1  takemura 
    640   1.1  takemura 	cnt = vrpiu_read(sc, PIUCNT_REG_W);
    641   1.1  takemura #ifdef DEBUG
    642   1.1  takemura 	if (vrpiu_debug)
    643  1.15       uch 		vrpiu_dump_cntreg(cnt);
    644   1.1  takemura #endif
    645   1.1  takemura 
    646   1.1  takemura 	/* clear interrupt status */
    647   1.8  takemura 	vrpiu_write(sc, PIUINT_REG_W, intrstat & TP_INTR);
    648   1.1  takemura 
    649   1.1  takemura #if 0
    650   1.1  takemura 	DPRINTF(("vrpiu_intr: OVP=%d", page));
    651   1.1  takemura 	if (intrstat & PIUINT_PADCMDINTR)
    652  1.15       uch 		DPRINTF((" CMD"));
    653   1.1  takemura 	if (intrstat & PIUINT_PADADPINTR)
    654  1.15       uch 		DPRINTF((" A/D"));
    655   1.1  takemura 	if (intrstat & PIUINT_PADPAGE1INTR)
    656  1.15       uch 		DPRINTF((" PAGE1"));
    657   1.1  takemura 	if (intrstat & PIUINT_PADPAGE0INTR)
    658  1.15       uch 		DPRINTF((" PAGE0"));
    659   1.1  takemura 	if (intrstat & PIUINT_PADDLOSTINTR)
    660  1.15       uch 		DPRINTF((" DLOST"));
    661   1.1  takemura 	if (intrstat & PIUINT_PENCHGINTR)
    662  1.15       uch 		DPRINTF((" PENCHG"));
    663   1.1  takemura 	DPRINTF(("\n"));
    664   1.1  takemura #endif
    665   1.1  takemura 	if (intrstat & (PIUINT_PADPAGE0INTR | PIUINT_PADPAGE1INTR)) {
    666  1.15       uch 		/*
    667  1.15       uch 		 * just ignore scan data if status isn't Touch.
    668  1.15       uch 		 */
    669  1.15       uch 		if (sc->sc_tpstat == VRPIU_TP_STAT_TOUCH) {
    670  1.15       uch 			/* reset tp scan timeout	*/
    671  1.15       uch 			callout_reset(&sc->sc_tptimeout, VRPIU_TP_SCAN_TIMEOUT,
    672  1.15       uch 			    vrpiu_tp_timeout, sc);
    673  1.15       uch 
    674  1.15       uch 			if (!((tpx0 & PIUPB_VALID) && (tpx1 & PIUPB_VALID) &&
    675  1.15       uch 			    (tpy0 & PIUPB_VALID) && (tpy1 & PIUPB_VALID))) {
    676  1.15       uch 				printf("vrpiu: internal error,"
    677  1.15       uch 				    " data is not valid!\n");
    678  1.15       uch 			} else {
    679  1.26  takemura 				tpx0 &= sc->sc_pb_paddata_mask;
    680  1.26  takemura 				tpx1 &= sc->sc_pb_paddata_mask;
    681  1.26  takemura 				tpy0 &= sc->sc_pb_paddata_mask;
    682  1.26  takemura 				tpy1 &= sc->sc_pb_paddata_mask;
    683  1.28  takemura #define ISVALID(n, c)	((c) - (c)/5 < (n) && (n) < (c) + (c)/5)
    684  1.28  takemura 				if (ISVALID(tpx0 + tpx1, sc->sc_pb_paddata_max) &&
    685  1.28  takemura 				    ISVALID(tpy0 + tpy1, sc->sc_pb_paddata_max)) {
    686   1.1  takemura #if 0
    687  1.15       uch 					DPRINTF(("%04x %04x %04x %04x\n",
    688  1.15       uch 					    tpx0, tpx1, tpy0, tpy1));
    689  1.15       uch 					DPRINTF(("%3d %3d (%4d %4d)->", tpx0,
    690  1.15       uch 					    tpy0, tpx0 + tpx1, tpy0 + tpy1));
    691   1.1  takemura #endif
    692  1.26  takemura 					xraw = tpy1 * sc->sc_pb_paddata_max / (tpy0 + tpy1);
    693  1.26  takemura 					yraw = tpx1 * sc->sc_pb_paddata_max / (tpx0 + tpx1);
    694  1.15       uch 					DPRINTF(("%3d %3d", xraw, yraw));
    695  1.36     blymn 
    696  1.15       uch 					tpcalib_trans(&sc->sc_tpcalib, xraw,
    697  1.15       uch 					    yraw, &x, &y);
    698  1.15       uch 
    699  1.15       uch 					DPRINTF(("->%4d %4d", x, y));
    700  1.15       uch 					wsmouse_input(sc->sc_wsmousedev,
    701  1.15       uch 					    1, /* button 0 down */
    702  1.15       uch 					    x, /* x */
    703  1.15       uch 					    y, /* y */
    704  1.15       uch 					    0, /* z */
    705  1.15       uch 					    WSMOUSE_INPUT_ABSOLUTE_X |
    706  1.15       uch 					    WSMOUSE_INPUT_ABSOLUTE_Y);
    707  1.15       uch 					DPRINTF(("\n"));
    708  1.15       uch 				}
    709  1.15       uch 			}
    710   1.4  takemura 		}
    711   1.4  takemura 	}
    712   1.4  takemura 
    713   1.4  takemura 	if (cnt & PIUCNT_PENSTC) {
    714  1.15       uch 		if (sc->sc_tpstat == VRPIU_TP_STAT_RELEASE) {
    715  1.15       uch 			/*
    716  1.15       uch 			 * pen touch
    717  1.15       uch 			 */
    718  1.15       uch 			DPRINTF(("PEN TOUCH\n"));
    719  1.15       uch 			sc->sc_tpstat = VRPIU_TP_STAT_TOUCH;
    720  1.15       uch 			/*
    721  1.15       uch 			 * We should not report button down event while
    722  1.15       uch 			 * we don't know where it occur.
    723  1.15       uch 			 */
    724  1.15       uch 
    725  1.15       uch 			/* set tp scan timeout	*/
    726  1.15       uch 			callout_reset(&sc->sc_tptimeout, VRPIU_TP_SCAN_TIMEOUT,
    727  1.15       uch 			    vrpiu_tp_timeout, sc);
    728  1.15       uch 		}
    729   1.4  takemura 	} else {
    730  1.15       uch 		vrpiu_tp_up(sc);
    731   1.1  takemura 	}
    732   1.1  takemura 
    733   1.1  takemura 	if (intrstat & PIUINT_PADDLOSTINTR) {
    734  1.15       uch 		cnt |= PIUCNT_PIUSEQEN;
    735  1.15       uch 		vrpiu_write(sc, PIUCNT_REG_W, cnt);
    736   1.1  takemura 	}
    737   1.1  takemura 
    738   1.6      sato 	return;
    739  1.10  takemura }
    740  1.10  takemura 
    741  1.10  takemura void
    742  1.15       uch vrpiu_tp_up(struct vrpiu_softc *sc)
    743  1.10  takemura {
    744  1.10  takemura 	if (sc->sc_tpstat == VRPIU_TP_STAT_TOUCH) {
    745  1.15       uch 		/*
    746  1.15       uch 		 * pen release
    747  1.15       uch 		 */
    748  1.15       uch 		DPRINTF(("RELEASE\n"));
    749  1.15       uch 		sc->sc_tpstat = VRPIU_TP_STAT_RELEASE;
    750  1.10  takemura 
    751  1.15       uch 		/* clear tp scan timeout	*/
    752  1.15       uch 		callout_stop(&sc->sc_tptimeout);
    753  1.10  takemura 
    754  1.15       uch 		/* button 0 UP */
    755  1.15       uch 		wsmouse_input(sc->sc_wsmousedev, 0, 0, 0, 0, 0);
    756  1.10  takemura 	}
    757  1.10  takemura }
    758  1.10  takemura 
    759  1.10  takemura /* touch panel timeout handler */
    760  1.10  takemura void
    761  1.15       uch vrpiu_tp_timeout(void *v)
    762  1.10  takemura {
    763  1.10  takemura 	struct vrpiu_softc *sc = (struct vrpiu_softc *)v;
    764  1.10  takemura 
    765  1.10  takemura #ifdef VRPIUDEBUG
    766  1.10  takemura 	{
    767  1.15       uch 		unsigned int cnt = vrpiu_read(sc, PIUCNT_REG_W);
    768  1.15       uch 		DPRINTF(("TIMEOUT: stat=%s  reg=%s\n",
    769  1.15       uch 		    (sc->sc_tpstat == VRPIU_TP_STAT_TOUCH)?"touch":"release",
    770  1.15       uch 		    (cnt & PIUCNT_PENSTC)?"touch":"release"));
    771  1.10  takemura 	}
    772  1.10  takemura #endif
    773  1.10  takemura 	vrpiu_tp_up(sc);
    774   1.6      sato }
    775   1.6      sato 
    776   1.6      sato /*
    777   1.6      sato  * PIU interrupt handler.
    778   1.6      sato  */
    779   1.6      sato int
    780  1.15       uch vrpiu_intr(void *arg)
    781   1.6      sato {
    782   1.6      sato         struct vrpiu_softc *sc = arg;
    783   1.6      sato 
    784   1.6      sato 	vrpiu_ad_intr(sc);
    785   1.6      sato 	vrpiu_tp_intr(sc);
    786   1.6      sato 
    787   1.1  takemura 	return 0;
    788   1.6      sato }
    789   1.6      sato 
    790   1.6      sato void
    791  1.15       uch vrpiu_start_powerstate(void *v)
    792   1.6      sato {
    793   1.6      sato 	int mask;
    794   1.6      sato 	struct vrpiu_softc *sc = (struct vrpiu_softc *)v;
    795   1.6      sato 
    796   1.6      sato 	vrpiu_ad_enable(sc);
    797   1.6      sato 	mask = vrpiu_read(sc, PIUAMSK_REG_W);
    798   1.6      sato 	mask &= 0xff8f; /* XXX */
    799   1.6      sato 	vrpiu_write(sc, PIUAMSK_REG_W, mask);
    800   1.6      sato 	vrpiu_write(sc, PIUASCN_REG_W, PIUACN_ADPSSTART);
    801   1.6      sato 	/*
    802   1.6      sato 	 * restart next A/D polling
    803   1.6      sato 	 */
    804   1.6      sato 	callout_reset(&sc->sc_adpoll, hz*vrpiu_ad_poll_interval,
    805  1.15       uch 	    vrpiu_start_powerstate, sc);
    806   1.6      sato }
    807   1.6      sato 
    808   1.6      sato void
    809  1.15       uch vrpiu_calc_powerstate(struct vrpiu_softc *sc)
    810   1.6      sato {
    811  1.15       uch 	extern void vrgiu_diff_io(void);
    812   1.6      sato 	vrpiu_ad_disable(sc);
    813   1.6      sato 	VPRINTF(("vrpiu:AD: %d, %d, %d\n",
    814  1.15       uch 	    sc->sc_battery.value[0],
    815  1.15       uch 	    sc->sc_battery.value[1],
    816  1.15       uch 	    sc->sc_battery.value[2]));
    817   1.6      sato 	sc->sc_battery.nextpoll = hz*vrpiu_ad_poll_interval;
    818  1.14      sato 	vrpiu_send_battery_event(sc);
    819   1.6      sato 	/*
    820   1.6      sato 	 * restart next A/D polling if change polling timming.
    821   1.6      sato 	 */
    822   1.6      sato 	if (sc->sc_battery.nextpoll != hz*vrpiu_ad_poll_interval)
    823  1.15       uch 		callout_reset(&sc->sc_adpoll, sc->sc_battery.nextpoll,
    824  1.15       uch 		    vrpiu_start_powerstate, sc);
    825   1.6      sato 	if (bootverbose)
    826  1.15       uch 		vrgiu_diff_io();
    827  1.36     blymn 
    828   1.6      sato }
    829   1.6      sato 
    830  1.36     blymn static void
    831  1.15       uch vrpiu_power(int why, void *arg)
    832   1.6      sato {
    833   1.6      sato 	struct vrpiu_softc *sc = arg;
    834   1.6      sato 
    835   1.6      sato 	switch (why) {
    836   1.6      sato 	case PWR_STANDBY:
    837   1.6      sato 	case PWR_SUSPEND:
    838  1.15       uch 		break;
    839   1.6      sato 	case PWR_RESUME:
    840  1.15       uch 		callout_reset(&sc->sc_adpoll, hz,
    841  1.15       uch 		    vrpiu_start_powerstate, sc);
    842  1.15       uch 		break;
    843   1.6      sato 	}
    844  1.14      sato }
    845  1.14      sato 
    846  1.14      sato static void
    847  1.15       uch vrpiu_send_battery_event(struct vrpiu_softc *sc)
    848  1.14      sato {
    849  1.14      sato #ifdef VRPIU_ADHOC_BATTERY_EVENT
    850  1.14      sato 	static int batteryhigh = 0;
    851  1.14      sato 	static int batterylow = 0;
    852  1.14      sato 	static int critical = 0;
    853  1.14      sato 
    854  1.36     blymn 	if (sc->sc_battery_spec == NULL
    855  1.15       uch 	    || sc->sc_battery_spec->main_port == -1)
    856  1.14      sato 		return;
    857  1.14      sato 
    858  1.36     blymn 	if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
    859  1.15       uch 	    <= sc->sc_battery_spec->dc_critical) {
    860  1.15       uch 		batteryhigh = 0;
    861  1.15       uch 		config_hook_call(CONFIG_HOOK_PMEVENT,
    862  1.15       uch 		    CONFIG_HOOK_PMEVENT_BATTERY,
    863  1.15       uch 		    (void *)CONFIG_HOOK_BATT_CRITICAL);
    864  1.15       uch 		batterylow = 3;
    865  1.15       uch 		if (critical) {
    866  1.14      sato 			config_hook_call(CONFIG_HOOK_PMEVENT,
    867  1.15       uch 			    CONFIG_HOOK_PMEVENT_SUSPENDREQ,
    868  1.15       uch 			    (void *)0);
    869  1.15       uch 			critical = 0;
    870  1.15       uch 			batterylow = 0;
    871  1.15       uch 		}
    872  1.15       uch 		critical++;
    873  1.36     blymn 	} else if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
    874  1.15       uch 	    <= sc->sc_battery_spec->dc_20p) {
    875  1.15       uch 		batteryhigh = 0;
    876  1.15       uch 		if (batterylow == 1)
    877  1.14      sato 			config_hook_call(CONFIG_HOOK_PMEVENT,
    878  1.15       uch 			    CONFIG_HOOK_PMEVENT_BATTERY,
    879  1.15       uch 			    (void *)CONFIG_HOOK_BATT_20P);
    880  1.15       uch 		config_hook_call(CONFIG_HOOK_PMEVENT,
    881  1.15       uch 		    CONFIG_HOOK_PMEVENT_BATTERY,
    882  1.15       uch 		    (void *)CONFIG_HOOK_BATT_LOW);
    883  1.15       uch 		batterylow = 2;
    884  1.36     blymn 	} else if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
    885  1.15       uch 	    <= sc->sc_battery_spec->dc_50p) {
    886  1.15       uch 		batteryhigh = 0;
    887  1.15       uch 		if (batterylow == 0) {
    888  1.15       uch 			batterylow = 1;
    889  1.15       uch 			config_hook_call(CONFIG_HOOK_PMEVENT,
    890  1.15       uch 			    CONFIG_HOOK_PMEVENT_BATTERY,
    891  1.15       uch 			    (void *)CONFIG_HOOK_BATT_50P);
    892  1.15       uch 		}
    893  1.36     blymn 	} else if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
    894  1.15       uch 	    >= sc->sc_battery_spec->ac_80p) {
    895  1.15       uch 		batterylow = 0;
    896  1.15       uch 		if (batteryhigh == 0) {
    897  1.15       uch 			batteryhigh = 1;
    898  1.15       uch 			config_hook_call(CONFIG_HOOK_PMEVENT,
    899  1.15       uch 			    CONFIG_HOOK_PMEVENT_BATTERY,
    900  1.15       uch 			    (void *)CONFIG_HOOK_BATT_80P);
    901  1.15       uch 			config_hook_call(CONFIG_HOOK_PMEVENT,
    902  1.15       uch 			    CONFIG_HOOK_PMEVENT_BATTERY,
    903  1.15       uch 			    (void *)CONFIG_HOOK_BATT_HIGH);
    904  1.15       uch 		}
    905  1.36     blymn 	}
    906  1.14      sato #else /* VRPIU_ADHOC_BATTERY_EVENT */
    907  1.14      sato 	config_hook_call(CONFIG_HOOK_SET,
    908  1.15       uch 	    CONFIG_HOOK_BATTERYVAL,
    909  1.15       uch 	    (void *)&sc->sc_battery);
    910  1.14      sato #endif /* VRPIU_ADHOC_BATTERY_EVENT */
    911   1.1  takemura }
    912   1.1  takemura 
    913   1.1  takemura #ifdef DEBUG
    914   1.1  takemura void
    915  1.15       uch vrpiu_dump_cntreg(unsigned int cnt)
    916   1.1  takemura {
    917   1.1  takemura 	printf("%s", (cnt & PIUCNT_PENSTC) ? "Touch" : "Release");
    918   1.1  takemura 	printf(" state=");
    919   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_CmdScan)
    920  1.15       uch 		printf("CmdScan");
    921   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_IntervalNextScan)
    922  1.15       uch 		printf("IntervalNextScan");
    923   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_PenDataScan)
    924  1.15       uch 		printf("PenDataScan");
    925   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_WaitPenTouch)
    926  1.15       uch 		printf("WaitPenTouch");
    927   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_RFU)
    928  1.15       uch 		printf("???");
    929   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_ADPortScan)
    930  1.15       uch 		printf("ADPortScan");
    931   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_Standby)
    932  1.15       uch 		printf("Standby");
    933   1.1  takemura 	if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_Disable)
    934  1.15       uch 		printf("Disable");
    935   1.1  takemura 	if (cnt & PIUCNT_PADATSTOP)
    936  1.15       uch 		printf(" AutoStop");
    937   1.1  takemura 	if (cnt & PIUCNT_PADATSTART)
    938  1.15       uch 		printf(" AutoStart");
    939   1.1  takemura 	if (cnt & PIUCNT_PADSCANSTOP)
    940  1.15       uch 		printf(" Stop");
    941   1.1  takemura 	if (cnt & PIUCNT_PADSCANSTART)
    942  1.15       uch 		printf(" Start");
    943   1.1  takemura 	if (cnt & PIUCNT_PADSCANTYPE)
    944  1.15       uch 		printf(" ScanPressure");
    945   1.1  takemura 	if ((cnt & PIUCNT_PIUMODE_MASK) == PIUCNT_PIUMODE_ADCONVERTER)
    946  1.15       uch 		printf(" A/D");
    947   1.1  takemura 	if ((cnt & PIUCNT_PIUMODE_MASK) == PIUCNT_PIUMODE_COORDINATE)
    948  1.15       uch 		printf(" Coordinate");
    949   1.1  takemura 	if (cnt & PIUCNT_PIUSEQEN)
    950  1.15       uch 		printf(" SeqEn");
    951   1.1  takemura 	if ((cnt & PIUCNT_PIUPWR) == 0)
    952  1.15       uch 		printf(" PowerOff");
    953   1.1  takemura 	if ((cnt & PIUCNT_PADRST) == 0)
    954  1.15       uch 		printf(" Reset");
    955   1.1  takemura 	printf("\n");
    956   1.1  takemura }
    957   1.1  takemura #endif
    958