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