Aren/NetBSD
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
6929f9f471
NetBSD/sys/arch/hpcmips/vr/vrpiu.c
takemura 6929f9f471 Removed __vrcmu_supply() and __vrgiu_out(), which are need to enable serial 
port before auto configuration.

Boot loaders (pbsdboot and hpcboot) are responsible to enable the port because
the kernel can't enable serial port for console any more.
2002-02-02 10:50:08 +00:00

903 lines
22 KiB
C
Raw Blame History

/* $NetBSD: vrpiu.c,v 1.20 2002/02/02 10:50:10 takemura Exp $ */
/*
* Copyright (c) 1999-2002 TAKEMURA Shin All rights reserved.
* Copyright (c) 2000-2001 SATO Kazumi, All rights reserved.
* Copyright (c) 1999-2001 PocketBSD Project. All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
*/
/*
* A/D polling part written by SATO Kazumi.
*/
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/kernel.h>
#include <sys/callout.h>
#include <sys/boot_flag.h>
#include <dev/wscons/wsconsio.h>
#include <dev/wscons/wsmousevar.h>
#include <machine/bus.h>
#include <machine/platid.h>
#include <machine/platid_mask.h>
#include <machine/config_hook.h>
#include <dev/hpc/tpcalibvar.h>
#include <dev/hpc/hpcbatteryvar.h>
#include <dev/hpc/hpcbatterytable.h>
#include <hpcmips/vr/vrcpudef.h>
#include <hpcmips/vr/vripif.h>
#include <hpcmips/vr/cmureg.h>
#include <hpcmips/vr/vrpiuvar.h>
#include <hpcmips/vr/vrpiureg.h>
/*
* contant and macro definitions
*/
#define VRPIUDEBUG
#ifdef VRPIUDEBUG
int vrpiu_debug = 0;
#define DPRINTF(arg) if (vrpiu_debug) printf arg;
#define VPRINTF(arg) if (bootverbose || vrpiu_debug) printf arg;
#else
#define DPRINTF(arg)
#define VPRINTF(arg) if (bootverbose) printf arg;
#endif
#ifndef VRPIU_NO_ADHOC_BATTERY_EVENT
#define VRPIU_ADHOC_BATTERY_EVENT /* currently... */
#endif /* VRPIU_NO_ADHOC_BATTERY_EVENT */
#ifndef VRPIU_AD_POLL_INTERVAL
#define VRPIU_AD_POLL_INTERVAL 60 /* interval is 60 sec */
#endif /* VRPIU_AD_POLL_INTERTVAL */
#define PIUSIVL_SCANINTVAL_MIN 333 /* 10msec */
#define PIUSIVL_SCANINTVAL_MAX PIUSIVL_SCANINTVAL_MASK /* 60msec */
#define VRPIU_TP_SCAN_TIMEOUT (hz/10) /* timeout is 100msec */
#define TP_INTR (PIUINT_ALLINTR & ~PIUINT_PADADPINTR)
#define AD_INTR (PIUINT_PADADPINTR)
/*
* data types
*/
/* struct vrpiu_softc is defined in vrpiuvar.h */
/*
* function prototypes
*/
static int vrpiumatch(struct device *, struct cfdata *, void *);
static void vrpiuattach(struct device *, struct device *, void *);
static void vrpiu_write(struct vrpiu_softc *, int, unsigned short);
static u_short vrpiu_read(struct vrpiu_softc *, int);
static int vrpiu_intr(void *);
static void vrpiu_tp_intr(struct vrpiu_softc *);
static void vrpiu_ad_intr(struct vrpiu_softc *);
#ifdef DEBUG
static void vrpiu_dump_cntreg(unsigned int);
#endif
static int vrpiu_tp_enable(void *);
static int vrpiu_tp_ioctl(void *, u_long, caddr_t, int, struct proc *);
static void vrpiu_tp_disable(void *);
static void vrpiu_tp_up(struct vrpiu_softc *);
static void vrpiu_tp_timeout(void *);
int vrpiu_ad_enable(void *);
void vrpiu_ad_disable(void *);
static void vrpiu_start_powerstate(void *);
static void vrpiu_calc_powerstate(struct vrpiu_softc *);
static void vrpiu_send_battery_event(struct vrpiu_softc *);
static void vrpiu_power(int, void *);
static u_int scan_interval(u_int data);
/* mra is defined in mra.c */
int mra_Y_AX1_BX2_C(int *y, int ys, int *x1, int x1s, int *x2, int x2s,
int n, int scale, int *a, int *b, int *c);
/*
* static or global variables
*/
struct cfattach vrpiu_ca = {
sizeof(struct vrpiu_softc), vrpiumatch, vrpiuattach
};
const struct wsmouse_accessops vrpiu_accessops = {
vrpiu_tp_enable,
vrpiu_tp_ioctl,
vrpiu_tp_disable,
};
int vrpiu_ad_poll_interval = VRPIU_AD_POLL_INTERVAL;
/*
* function definitions
*/
static inline void
vrpiu_write(struct vrpiu_softc *sc, int port, unsigned short val)
{
bus_space_write_2(sc->sc_iot, sc->sc_ioh, port, val);
}
static inline u_short
vrpiu_read(struct vrpiu_softc *sc, int port)
{
return (bus_space_read_2(sc->sc_iot, sc->sc_ioh, port));
}
static int
vrpiumatch(struct device *parent, struct cfdata *cf, void *aux)
{
return (1);
}
static void
vrpiuattach(struct device *parent, struct device *self, void *aux)
{
struct vrpiu_softc *sc = (struct vrpiu_softc *)self;
struct vrip_attach_args *va = aux;
struct wsmousedev_attach_args wsmaa;
bus_space_tag_t iot = va->va_iot;
bus_space_handle_t ioh;
struct platid_data *p;
if (bus_space_map(iot, va->va_addr, 1, 0, &ioh)) {
printf(": can't map bus space\n");
return;
}
sc->sc_iot = iot;
sc->sc_ioh = ioh;
sc->sc_unit = va->va_unit;
sc->sc_vrip = va->va_vc;
sc->sc_interval = scan_interval(WSMOUSE_RES_DEFAULT);
if ((p = platid_search_data(&platid, hpcbattery_parameters)) == NULL)
sc->sc_battery_spec = NULL;
else
sc->sc_battery_spec = p->data;
/*
* disable device until vrpiu_enable called
*/
sc->sc_tpstat = VRPIU_TP_STAT_DISABLE;
/* initialize touch panel timeout structure */
callout_init(&sc->sc_tptimeout);
/* initialize calibration context */
tpcalib_init(&sc->sc_tpcalib);
#if 1
/*
* XXX, calibrate parameters
*/
{
int i;
static const struct {
platid_mask_t *mask;
struct wsmouse_calibcoords coords;
} calibrations[] = {
{ &platid_mask_MACH_NEC_MCR_700,
{ 0, 0, 799, 599,
4,
{ { 115, 80, 0, 0 },
{ 115, 966, 0, 599 },
{ 912, 80, 799, 0 },
{ 912, 966, 799, 599 } } } },
{ &platid_mask_MACH_NEC_MCR_700A,
{ 0, 0, 799, 599,
4,
{ { 115, 80, 0, 0 },
{ 115, 966, 0, 599 },
{ 912, 80, 799, 0 },
{ 912, 966, 799, 599 } } } },
{ &platid_mask_MACH_NEC_MCR_730,
{ 0, 0, 799, 599,
4,
{ { 115, 80, 0, 0 },
{ 115, 966, 0, 599 },
{ 912, 80, 799, 0 },
{ 912, 966, 799, 599 } } } },
{ NULL, /* samples got on my MC-R500 */
{ 0, 0, 639, 239,
5,
{ { 502, 486, 320, 120 },
{ 55, 109, 0, 0 },
{ 54, 913, 0, 239 },
{ 973, 924, 639, 239 },
{ 975, 123, 639, 0 } } } },
};
for (i = 0; ; i++) {
if (calibrations[i].mask == NULL
|| platid_match(&platid, calibrations[i].mask))
break;
}
tpcalib_ioctl(&sc->sc_tpcalib, WSMOUSEIO_SCALIBCOORDS,
(caddr_t)&calibrations[i].coords, 0, 0);
}
#endif
/* install interrupt handler and enable interrupt */
if (!(sc->sc_handler =
vrip_intr_establish(sc->sc_vrip, sc->sc_unit, 0, IPL_TTY,
vrpiu_intr, sc))) {
printf (": can't map interrupt line.\n");
return;
}
/* mask level2 interrupt, stop scan sequencer and mask clock to piu */
vrpiu_tp_disable(sc);
printf("\n");
wsmaa.accessops = &vrpiu_accessops;
wsmaa.accesscookie = sc;
/*
* attach the wsmouse
*/
sc->sc_wsmousedev = config_found(self, &wsmaa, wsmousedevprint);
/*
* power management events
*/
sc->sc_power_hook = powerhook_establish(vrpiu_power, sc);
/*
* init A/D port polling.
*/
sc->sc_battery.n_values = 3;
sc->sc_battery.value[0] = -1;
sc->sc_battery.value[1] = -1;
sc->sc_battery.value[2] = -1;
sc->sc_battery.nextpoll = hz*vrpiu_ad_poll_interval;
callout_init(&sc->sc_adpoll);
callout_reset(&sc->sc_adpoll, hz, vrpiu_start_powerstate, sc);
}
/*
* calculate interval value
* input: WSMOUSE_RES_MIN - WSMOUSE_RES_MAX
* output: value for PIUSIVL_REG
*/
static u_int
scan_interval(u_int data)
{
int scale;
if (data < WSMOUSE_RES_MIN)
data = WSMOUSE_RES_MIN;
if (WSMOUSE_RES_MAX < data)
data = WSMOUSE_RES_MAX;
scale = WSMOUSE_RES_MAX - WSMOUSE_RES_MIN;
data += WSMOUSE_RES_MIN;
return PIUSIVL_SCANINTVAL_MIN +
(PIUSIVL_SCANINTVAL_MAX - PIUSIVL_SCANINTVAL_MIN) *
(scale - data) / scale;
}
int
vrpiu_ad_enable(void *v)
{
struct vrpiu_softc *sc = v;
int s;
unsigned int cnt;
DPRINTF(("%s(%d): vrpiu_ad_enable(): interval=0x%03x\n",
__FILE__, __LINE__, sc->sc_interval));
if (sc->sc_adstat != VRPIU_AD_STAT_DISABLE)
return EBUSY;
/* supply clock to PIU */
vrip_power(sc->sc_vrip, sc->sc_unit, 1);
/* set scan interval */
vrpiu_write(sc, PIUSIVL_REG_W, sc->sc_interval);
s = spltty();
/* clear interrupt status */
vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
/* Disable -> Standby */
cnt = PIUCNT_PIUPWR |
PIUCNT_PIUMODE_COORDINATE |
PIUCNT_PADATSTART | PIUCNT_PADATSTOP;
vrpiu_write(sc, PIUCNT_REG_W, cnt);
/* Level2 interrupt register setting */
vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, AD_INTR, 1);
/* save pen status, touch or release */
cnt = vrpiu_read(sc, PIUCNT_REG_W);
/*
* Enable scan sequencer operation
* Standby -> WaitPenTouch
*/
cnt |= PIUCNT_PIUSEQEN;
vrpiu_write(sc, PIUCNT_REG_W, cnt);
sc->sc_adstat = VRPIU_AD_STAT_ENABLE;
splx(s);
return 0;
}
void
vrpiu_ad_disable(void *v)
{
struct vrpiu_softc *sc = v;
DPRINTF(("%s(%d): vrpiu_ad_disable()\n", __FILE__, __LINE__));
/* Set level2 interrupt register to mask interrupts */
vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, AD_INTR, 0);
sc->sc_adstat = VRPIU_AD_STAT_DISABLE;
if (sc->sc_tpstat == VRPIU_TP_STAT_DISABLE){
/* Disable scan sequencer operation and power off */
vrpiu_write(sc, PIUCNT_REG_W, 0);
/* mask clock to PIU */
vrip_power(sc->sc_vrip, sc->sc_unit, 0);
}
}
int
vrpiu_tp_enable(void *v)
{
struct vrpiu_softc *sc = v;
int s;
unsigned int cnt;
DPRINTF(("%s(%d): vrpiu_tp_enable(): interval=0x%03x\n",
__FILE__, __LINE__, sc->sc_interval));
if (sc->sc_tpstat != VRPIU_TP_STAT_DISABLE)
return EBUSY;
/* supply clock to PIU */
vrip_power(sc->sc_vrip, sc->sc_unit, 1);
/* set scan interval */
vrpiu_write(sc, PIUSIVL_REG_W, sc->sc_interval);
s = spltty();
/* clear interrupt status */
vrpiu_write(sc, PIUINT_REG_W, TP_INTR);
/* Disable -> Standby */
cnt = PIUCNT_PIUPWR |
PIUCNT_PIUMODE_COORDINATE |
PIUCNT_PADATSTART | PIUCNT_PADATSTOP;
vrpiu_write(sc, PIUCNT_REG_W, cnt);
/* Level2 interrupt register setting */
vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, TP_INTR, 1);
/* save pen status, touch or release */
cnt = vrpiu_read(sc, PIUCNT_REG_W);
/*
* Enable scan sequencer operation
* Standby -> WaitPenTouch
*/
cnt |= PIUCNT_PIUSEQEN;
vrpiu_write(sc, PIUCNT_REG_W, cnt);
/* transit status DISABLE -> TOUCH or RELEASE */
sc->sc_tpstat = (cnt & PIUCNT_PENSTC) ?
VRPIU_TP_STAT_TOUCH : VRPIU_TP_STAT_RELEASE;
splx(s);
return 0;
}
void
vrpiu_tp_disable(void *v)
{
struct vrpiu_softc *sc = v;
DPRINTF(("%s(%d): vrpiu_tp_disable()\n", __FILE__, __LINE__));
/* Set level2 interrupt register to mask interrupts */
vrip_intr_setmask2(sc->sc_vrip, sc->sc_handler, TP_INTR, 0);
sc->sc_tpstat = VRPIU_TP_STAT_DISABLE;
if (sc->sc_adstat == VRPIU_AD_STAT_DISABLE){
/* Disable scan sequencer operation and power off */
vrpiu_write(sc, PIUCNT_REG_W, 0);
/* mask clock to PIU */
vrip_power(sc->sc_vrip, sc->sc_unit, 0);
}
}
int
vrpiu_tp_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
{
struct vrpiu_softc *sc = v;
DPRINTF(("%s(%d): vrpiu_tp_ioctl(%08lx)\n", __FILE__, __LINE__, cmd));
switch (cmd) {
case WSMOUSEIO_GTYPE:
*(u_int *)data = WSMOUSE_TYPE_TPANEL;
break;
case WSMOUSEIO_SRES:
{
int tp_enable;
int ad_enable;
tp_enable = (sc->sc_tpstat != VRPIU_TP_STAT_DISABLE);
ad_enable = (sc->sc_adstat != VRPIU_AD_STAT_DISABLE);
if (tp_enable)
vrpiu_tp_disable(sc);
if (ad_enable)
vrpiu_ad_disable(sc);
sc->sc_interval = scan_interval(*(u_int *)data);
DPRINTF(("%s(%d): WSMOUSEIO_SRES: *data=%d, interval=0x%03x\n",
__FILE__, __LINE__, *(u_int *)data, sc->sc_interval));
if (sc->sc_interval < PIUSIVL_SCANINTVAL_MIN)
sc->sc_interval = PIUSIVL_SCANINTVAL_MIN;
if (PIUSIVL_SCANINTVAL_MAX < sc->sc_interval)
sc->sc_interval = PIUSIVL_SCANINTVAL_MAX;
if (tp_enable)
vrpiu_tp_enable(sc);
if (ad_enable)
vrpiu_ad_enable(sc);
}
break;
case WSMOUSEIO_SCALIBCOORDS:
case WSMOUSEIO_GCALIBCOORDS:
return tpcalib_ioctl(&sc->sc_tpcalib, cmd, data, flag, p);
default:
return (-1);
}
return (0);
}
/*
* PIU AD interrupt handler.
*/
void
vrpiu_ad_intr(struct vrpiu_softc *sc)
{
unsigned int i;
unsigned int intrstat;
intrstat = vrpiu_read(sc, PIUINT_REG_W);
if (sc->sc_adstat == VRPIU_AD_STAT_DISABLE) {
/*
* the device isn't enabled. just clear interrupt.
*/
vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
return;
}
if (intrstat & PIUINT_PADADPINTR) {
sc->sc_battery.value[0] = (unsigned int)
vrpiu_read(sc, PIUAB(0));
sc->sc_battery.value[1] = (unsigned int)
vrpiu_read(sc, PIUAB(1));
sc->sc_battery.value[2] = (unsigned int)
vrpiu_read(sc, PIUAB(2));
}
if (intrstat & PIUINT_PADADPINTR) {
for (i = 0; i < 3; i++) {
if (sc->sc_battery.value[i] & PIUAB_VALID)
sc->sc_battery.value[i] &= PIUAB_PADDATA_MASK;
else
sc->sc_battery.value[i] = 0;
}
vrpiu_calc_powerstate(sc);
}
vrpiu_write(sc, PIUINT_REG_W, AD_INTR);
return;
}
/*
* PIU TP interrupt handler.
*/
void
vrpiu_tp_intr(struct vrpiu_softc *sc)
{
unsigned int cnt, i;
unsigned int intrstat, page;
int tpx0, tpx1, tpy0, tpy1;
int x, y, xraw, yraw;
intrstat = vrpiu_read(sc, PIUINT_REG_W);
if (sc->sc_tpstat == VRPIU_TP_STAT_DISABLE) {
/*
* the device isn't enabled. just clear interrupt.
*/
vrpiu_write(sc, PIUINT_REG_W, intrstat & TP_INTR);
return;
}
page = (intrstat & PIUINT_OVP) ? 1 : 0;
if (intrstat & (PIUINT_PADPAGE0INTR | PIUINT_PADPAGE1INTR)) {
tpx0 = vrpiu_read(sc, PIUPB(page, 0));
tpx1 = vrpiu_read(sc, PIUPB(page, 1));
tpy0 = vrpiu_read(sc, PIUPB(page, 2));
tpy1 = vrpiu_read(sc, PIUPB(page, 3));
}
if (intrstat & PIUINT_PADDLOSTINTR) {
page = page ? 0 : 1;
for (i = 0; i < 4; i++)
vrpiu_read(sc, PIUPB(page, i));
}
cnt = vrpiu_read(sc, PIUCNT_REG_W);
#ifdef DEBUG
if (vrpiu_debug)
vrpiu_dump_cntreg(cnt);
#endif
/* clear interrupt status */
vrpiu_write(sc, PIUINT_REG_W, intrstat & TP_INTR);
#if 0
DPRINTF(("vrpiu_intr: OVP=%d", page));
if (intrstat & PIUINT_PADCMDINTR)
DPRINTF((" CMD"));
if (intrstat & PIUINT_PADADPINTR)
DPRINTF((" A/D"));
if (intrstat & PIUINT_PADPAGE1INTR)
DPRINTF((" PAGE1"));
if (intrstat & PIUINT_PADPAGE0INTR)
DPRINTF((" PAGE0"));
if (intrstat & PIUINT_PADDLOSTINTR)
DPRINTF((" DLOST"));
if (intrstat & PIUINT_PENCHGINTR)
DPRINTF((" PENCHG"));
DPRINTF(("\n"));
#endif
if (intrstat & (PIUINT_PADPAGE0INTR | PIUINT_PADPAGE1INTR)) {
/*
* just ignore scan data if status isn't Touch.
*/
if (sc->sc_tpstat == VRPIU_TP_STAT_TOUCH) {
/* reset tp scan timeout */
callout_reset(&sc->sc_tptimeout, VRPIU_TP_SCAN_TIMEOUT,
vrpiu_tp_timeout, sc);
if (!((tpx0 & PIUPB_VALID) && (tpx1 & PIUPB_VALID) &&
(tpy0 & PIUPB_VALID) && (tpy1 & PIUPB_VALID))) {
printf("vrpiu: internal error,"
" data is not valid!\n");
} else {
tpx0 &= PIUPB_PADDATA_MASK;
tpx1 &= PIUPB_PADDATA_MASK;
tpy0 &= PIUPB_PADDATA_MASK;
tpy1 &= PIUPB_PADDATA_MASK;
#define ISVALID(n, c, m) ((c) - (m) < (n) && (n) < (c) + (m))
if (ISVALID(tpx0 + tpx1, 1024, 200) &&
ISVALID(tpy0 + tpy1, 1024, 200)) {
#if 0
DPRINTF(("%04x %04x %04x %04x\n",
tpx0, tpx1, tpy0, tpy1));
DPRINTF(("%3d %3d (%4d %4d)->", tpx0,
tpy0, tpx0 + tpx1, tpy0 + tpy1));
#endif
xraw = tpy1 * 1024 / (tpy0 + tpy1);
yraw = tpx1 * 1024 / (tpx0 + tpx1);
DPRINTF(("%3d %3d", xraw, yraw));
tpcalib_trans(&sc->sc_tpcalib, xraw,
yraw, &x, &y);
DPRINTF(("->%4d %4d", x, y));
wsmouse_input(sc->sc_wsmousedev,
1, /* button 0 down */
x, /* x */
y, /* y */
0, /* z */
WSMOUSE_INPUT_ABSOLUTE_X |
WSMOUSE_INPUT_ABSOLUTE_Y);
DPRINTF(("\n"));
}
}
}
}
if (cnt & PIUCNT_PENSTC) {
if (sc->sc_tpstat == VRPIU_TP_STAT_RELEASE) {
/*
* pen touch
*/
DPRINTF(("PEN TOUCH\n"));
sc->sc_tpstat = VRPIU_TP_STAT_TOUCH;
/*
* We should not report button down event while
* we don't know where it occur.
*/
/* set tp scan timeout */
callout_reset(&sc->sc_tptimeout, VRPIU_TP_SCAN_TIMEOUT,
vrpiu_tp_timeout, sc);
}
} else {
vrpiu_tp_up(sc);
}
if (intrstat & PIUINT_PADDLOSTINTR) {
cnt |= PIUCNT_PIUSEQEN;
vrpiu_write(sc, PIUCNT_REG_W, cnt);
}
return;
}
void
vrpiu_tp_up(struct vrpiu_softc *sc)
{
if (sc->sc_tpstat == VRPIU_TP_STAT_TOUCH) {
/*
* pen release
*/
DPRINTF(("RELEASE\n"));
sc->sc_tpstat = VRPIU_TP_STAT_RELEASE;
/* clear tp scan timeout */
callout_stop(&sc->sc_tptimeout);
/* button 0 UP */
wsmouse_input(sc->sc_wsmousedev, 0, 0, 0, 0, 0);
}
}
/* touch panel timeout handler */
void
vrpiu_tp_timeout(void *v)
{
struct vrpiu_softc *sc = (struct vrpiu_softc *)v;
#ifdef VRPIUDEBUG
{
unsigned int cnt = vrpiu_read(sc, PIUCNT_REG_W);
DPRINTF(("TIMEOUT: stat=%s reg=%s\n",
(sc->sc_tpstat == VRPIU_TP_STAT_TOUCH)?"touch":"release",
(cnt & PIUCNT_PENSTC)?"touch":"release"));
}
#endif
vrpiu_tp_up(sc);
}
/*
* PIU interrupt handler.
*/
int
vrpiu_intr(void *arg)
{
struct vrpiu_softc *sc = arg;
vrpiu_ad_intr(sc);
vrpiu_tp_intr(sc);
return 0;
}
void
vrpiu_start_powerstate(void *v)
{
int mask;
struct vrpiu_softc *sc = (struct vrpiu_softc *)v;
vrpiu_ad_enable(sc);
mask = vrpiu_read(sc, PIUAMSK_REG_W);
mask &= 0xff8f; /* XXX */
vrpiu_write(sc, PIUAMSK_REG_W, mask);
vrpiu_write(sc, PIUASCN_REG_W, PIUACN_ADPSSTART);
/*
* restart next A/D polling
*/
callout_reset(&sc->sc_adpoll, hz*vrpiu_ad_poll_interval,
vrpiu_start_powerstate, sc);
}
void
vrpiu_calc_powerstate(struct vrpiu_softc *sc)
{
extern void vrgiu_diff_io(void);
vrpiu_ad_disable(sc);
VPRINTF(("vrpiu:AD: %d, %d, %d\n",
sc->sc_battery.value[0],
sc->sc_battery.value[1],
sc->sc_battery.value[2]));
sc->sc_battery.nextpoll = hz*vrpiu_ad_poll_interval;
vrpiu_send_battery_event(sc);
/*
* restart next A/D polling if change polling timming.
*/
if (sc->sc_battery.nextpoll != hz*vrpiu_ad_poll_interval)
callout_reset(&sc->sc_adpoll, sc->sc_battery.nextpoll,
vrpiu_start_powerstate, sc);
if (bootverbose)
vrgiu_diff_io();
}
static void
vrpiu_power(int why, void *arg)
{
struct vrpiu_softc *sc = arg;
switch (why) {
case PWR_STANDBY:
case PWR_SUSPEND:
break;
case PWR_RESUME:
callout_reset(&sc->sc_adpoll, hz,
vrpiu_start_powerstate, sc);
break;
}
}
static void
vrpiu_send_battery_event(struct vrpiu_softc *sc)
{
#ifdef VRPIU_ADHOC_BATTERY_EVENT
static int batteryhigh = 0;
static int batterylow = 0;
static int critical = 0;
if (sc->sc_battery_spec == NULL
|| sc->sc_battery_spec->main_port == -1)
return;
if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
<= sc->sc_battery_spec->dc_critical) {
batteryhigh = 0;
config_hook_call(CONFIG_HOOK_PMEVENT,
CONFIG_HOOK_PMEVENT_BATTERY,
(void *)CONFIG_HOOK_BATT_CRITICAL);
batterylow = 3;
if (critical) {
config_hook_call(CONFIG_HOOK_PMEVENT,
CONFIG_HOOK_PMEVENT_SUSPENDREQ,
(void *)0);
critical = 0;
batterylow = 0;
}
critical++;
} else if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
<= sc->sc_battery_spec->dc_20p) {
batteryhigh = 0;
if (batterylow == 1)
config_hook_call(CONFIG_HOOK_PMEVENT,
CONFIG_HOOK_PMEVENT_BATTERY,
(void *)CONFIG_HOOK_BATT_20P);
config_hook_call(CONFIG_HOOK_PMEVENT,
CONFIG_HOOK_PMEVENT_BATTERY,
(void *)CONFIG_HOOK_BATT_LOW);
batterylow = 2;
} else if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
<= sc->sc_battery_spec->dc_50p) {
batteryhigh = 0;
if (batterylow == 0) {
batterylow = 1;
config_hook_call(CONFIG_HOOK_PMEVENT,
CONFIG_HOOK_PMEVENT_BATTERY,
(void *)CONFIG_HOOK_BATT_50P);
}
} else if (sc->sc_battery.value[sc->sc_battery_spec->main_port]
>= sc->sc_battery_spec->ac_80p) {
batterylow = 0;
if (batteryhigh == 0) {
batteryhigh = 1;
config_hook_call(CONFIG_HOOK_PMEVENT,
CONFIG_HOOK_PMEVENT_BATTERY,
(void *)CONFIG_HOOK_BATT_80P);
config_hook_call(CONFIG_HOOK_PMEVENT,
CONFIG_HOOK_PMEVENT_BATTERY,
(void *)CONFIG_HOOK_BATT_HIGH);
}
}
#else /* VRPIU_ADHOC_BATTERY_EVENT */
config_hook_call(CONFIG_HOOK_SET,
CONFIG_HOOK_BATTERYVAL,
(void *)&sc->sc_battery);
#endif /* VRPIU_ADHOC_BATTERY_EVENT */
}
#ifdef DEBUG
void
vrpiu_dump_cntreg(unsigned int cnt)
{
printf("%s", (cnt & PIUCNT_PENSTC) ? "Touch" : "Release");
printf(" state=");
if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_CmdScan)
printf("CmdScan");
if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_IntervalNextScan)
printf("IntervalNextScan");
if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_PenDataScan)
printf("PenDataScan");
if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_WaitPenTouch)
printf("WaitPenTouch");
if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_RFU)
printf("???");
if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_ADPortScan)
printf("ADPortScan");
if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_Standby)
printf("Standby");
if ((cnt & PIUCNT_PADSTATE_MASK) == PIUCNT_PADSTATE_Disable)
printf("Disable");
if (cnt & PIUCNT_PADATSTOP)
printf(" AutoStop");
if (cnt & PIUCNT_PADATSTART)
printf(" AutoStart");
if (cnt & PIUCNT_PADSCANSTOP)
printf(" Stop");
if (cnt & PIUCNT_PADSCANSTART)
printf(" Start");
if (cnt & PIUCNT_PADSCANTYPE)
printf(" ScanPressure");
if ((cnt & PIUCNT_PIUMODE_MASK) == PIUCNT_PIUMODE_ADCONVERTER)
printf(" A/D");
if ((cnt & PIUCNT_PIUMODE_MASK) == PIUCNT_PIUMODE_COORDINATE)
printf(" Coordinate");
if (cnt & PIUCNT_PIUSEQEN)
printf(" SeqEn");
if ((cnt & PIUCNT_PIUPWR) == 0)
printf(" PowerOff");
if ((cnt & PIUCNT_PADRST) == 0)
printf(" Reset");
printf("\n");
}
#endif
Reference in New Issue View Git Blame Copy Permalink