Home | History | Annotate | Line # | Download | only in dev
optpoint.c revision 1.3.12.1
      1  1.3.12.1      tron /*	$NetBSD: optpoint.c,v 1.3.12.1 2006/05/24 15:47:56 tron Exp $ */
      2       1.1  hamajima 
      3       1.1  hamajima /*-
      4       1.1  hamajima  * Copyright (c) 2005 HAMAJIMA Katsuomi. All rights reserved.
      5       1.1  hamajima  *
      6       1.1  hamajima  * Redistribution and use in source and binary forms, with or without
      7       1.1  hamajima  * modification, are permitted provided that the following conditions
      8       1.1  hamajima  * are met:
      9       1.1  hamajima  * 1. Redistributions of source code must retain the above copyright
     10       1.1  hamajima  *    notice, this list of conditions and the following disclaimer.
     11       1.1  hamajima  * 2. Redistributions in binary form must reproduce the above copyright
     12       1.1  hamajima  *    notice, this list of conditions and the following disclaimer in the
     13       1.1  hamajima  *    documentation and/or other materials provided with the distribution.
     14       1.1  hamajima  *
     15       1.1  hamajima  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     16       1.1  hamajima  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     17       1.1  hamajima  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     18       1.1  hamajima  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     19       1.1  hamajima  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     20       1.1  hamajima  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     21       1.1  hamajima  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     22       1.1  hamajima  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     23       1.1  hamajima  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     24       1.1  hamajima  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     25       1.1  hamajima  * SUCH DAMAGE.
     26       1.1  hamajima  */
     27       1.1  hamajima 
     28       1.1  hamajima /*
     29       1.1  hamajima  * OptOpint on Telios HC-AJ2
     30       1.1  hamajima  */
     31       1.1  hamajima 
     32       1.1  hamajima #include <sys/cdefs.h>
     33       1.1  hamajima 
     34  1.3.12.1      tron __KERNEL_RCSID(0, "$NetBSD: optpoint.c,v 1.3.12.1 2006/05/24 15:47:56 tron Exp $");
     35       1.1  hamajima 
     36       1.1  hamajima #include <sys/param.h>
     37       1.1  hamajima #include <sys/systm.h>
     38       1.1  hamajima #include <sys/device.h>
     39       1.1  hamajima #include <machine/bus.h>
     40       1.2  hamajima #include <machine/config_hook.h>
     41       1.1  hamajima #include <dev/hpc/hpciovar.h>
     42       1.1  hamajima #include <dev/wscons/wsconsio.h>
     43       1.1  hamajima #include <dev/wscons/wsmousevar.h>
     44       1.1  hamajima #include <hpcmips/tx/tx39var.h>
     45       1.1  hamajima #include <hpcmips/tx/tx39spivar.h>
     46       1.1  hamajima #include <hpcmips/tx/tx39icureg.h>
     47       1.1  hamajima 
     48       1.1  hamajima #undef	OPTPOINTDEBUG
     49       1.1  hamajima 
     50       1.1  hamajima #ifdef OPTPOINTDEBUG
     51       1.1  hamajima #define	DPRINTF(arg) printf arg
     52       1.1  hamajima #else
     53       1.1  hamajima #define	DPRINTF(arg)
     54       1.1  hamajima #endif
     55       1.1  hamajima 
     56       1.1  hamajima struct optpoint_softc {
     57       1.1  hamajima 	struct device sc_dev;
     58       1.1  hamajima 	tx_chipset_tag_t sc_tc;
     59       1.1  hamajima 	struct tx39spi_softc *sc_spi;
     60       1.1  hamajima 	struct hpcio_chip *sc_hc;
     61       1.1  hamajima 	struct device *sc_wsmousedev;
     62       1.2  hamajima 	void *sc_powerhook;	/* power management hook */
     63       1.1  hamajima 	char packet[4];
     64       1.1  hamajima 	int index;	/* number of bytes received for this packet */
     65       1.1  hamajima 	u_int buttons;	/* mouse button status */
     66       1.1  hamajima 	int enabled;
     67       1.1  hamajima };
     68       1.1  hamajima 
     69       1.1  hamajima static int optpoint_match(struct device *, struct cfdata *, void *);
     70       1.1  hamajima static void optpoint_attach(struct device *, struct device *, void *);
     71       1.1  hamajima static int optpoint_intr(void *);
     72       1.1  hamajima static int optpoint_enable(void *);
     73       1.1  hamajima static void optpoint_disable(void *);
     74  1.3.12.1      tron static int optpoint_ioctl(void *, u_long, caddr_t, int, struct lwp *);
     75       1.1  hamajima static int optpoint_initialize(void *);
     76       1.1  hamajima static void optpoint_send(struct optpoint_softc *, int);
     77       1.1  hamajima static int optpoint_recv(struct optpoint_softc *);
     78       1.2  hamajima static int optpoint_power(void *, int, long, void *);
     79       1.1  hamajima 
     80       1.1  hamajima #define LBUTMASK 0x01
     81       1.1  hamajima #define RBUTMASK 0x02
     82       1.1  hamajima 
     83       1.1  hamajima #define TX39_INTRSTATUS4_OPTPOINTINT	TX39_INTRSTATUS4_CARDIORDNEGINT
     84       1.1  hamajima #define TX39_IO_MFIO_CARDREG	11
     85       1.1  hamajima #define TX39_IO_MFIO_CARDIOWR	10
     86       1.1  hamajima #define TX39_IO_MFIO_CARDIORD	9
     87       1.1  hamajima #define TELIOS_MFIO_OPTP_T_RDY		TX39_IO_MFIO_CARDREG
     88       1.1  hamajima #define TELIOS_MFIO_OPTP_C_REQ		TX39_IO_MFIO_CARDIOWR
     89       1.1  hamajima #define TELIOS_MFIO_OPTP_S_ENB_N	TX39_IO_MFIO_CARDIORD
     90       1.1  hamajima 
     91       1.1  hamajima CFATTACH_DECL(optpoint, sizeof(struct optpoint_softc),
     92       1.1  hamajima     optpoint_match, optpoint_attach, NULL, NULL);
     93       1.1  hamajima 
     94       1.1  hamajima const struct wsmouse_accessops optpoint_accessops = {
     95       1.1  hamajima 	optpoint_enable,
     96       1.1  hamajima 	optpoint_ioctl,
     97       1.1  hamajima 	optpoint_disable,
     98       1.1  hamajima };
     99       1.1  hamajima 
    100       1.1  hamajima int
    101       1.1  hamajima optpoint_match(struct device *parent, struct cfdata *cf, void *aux)
    102       1.1  hamajima {
    103       1.1  hamajima 	return (ATTACH_NORMAL);
    104       1.1  hamajima }
    105       1.1  hamajima 
    106       1.1  hamajima void
    107       1.1  hamajima optpoint_attach(struct device *parent, struct device *self, void *aux)
    108       1.1  hamajima {
    109       1.1  hamajima 	struct txspi_attach_args *ta = aux;
    110       1.1  hamajima 	struct optpoint_softc *sc = (void*)self;
    111       1.1  hamajima 	struct tx39spi_softc *spi = sc->sc_spi = (void*)parent;
    112       1.1  hamajima 	tx_chipset_tag_t tc = sc->sc_tc = ta->sa_tc;
    113       1.1  hamajima 	struct wsmousedev_attach_args wsmaa;
    114       1.1  hamajima 
    115       1.1  hamajima 	sc->sc_hc = tc->tc_iochip[MFIO];
    116       1.1  hamajima 	sc->enabled = 0;
    117       1.1  hamajima 
    118       1.1  hamajima 	/* Specific SPI settings for OptPoint of HC-AJ2 */
    119       1.1  hamajima 	tx39spi_delayval(spi, 0);
    120       1.1  hamajima 	tx39spi_baudrate(spi, 4);	/* SPICLK Rate = 737.3 kHz */
    121       1.1  hamajima 	tx39spi_word(spi, 0);		/* Use 8bits of data */
    122       1.1  hamajima 	tx39spi_phapol(spi, 0);
    123       1.1  hamajima 	tx39spi_clkpol(spi, 1);
    124       1.1  hamajima 	tx39spi_lsb(spi, 0);		/* MSB first */
    125       1.1  hamajima 
    126       1.1  hamajima 	optpoint_enable(sc);
    127       1.1  hamajima 	printf("\n");
    128       1.1  hamajima 
    129       1.1  hamajima 	wsmaa.accessops = &optpoint_accessops;
    130       1.1  hamajima 	wsmaa.accesscookie = sc;
    131       1.1  hamajima 	/* attach the wsmouse */
    132       1.1  hamajima 	sc->sc_wsmousedev = config_found(self, &wsmaa, wsmousedevprint);
    133       1.2  hamajima 
    134       1.2  hamajima 	/* Add a hard power hook to power saving */
    135       1.2  hamajima 	sc->sc_powerhook = config_hook(CONFIG_HOOK_PMEVENT,
    136       1.2  hamajima 				       CONFIG_HOOK_PMEVENT_HARDPOWER,
    137       1.2  hamajima 				       CONFIG_HOOK_SHARE,
    138       1.2  hamajima 				       optpoint_power, sc);
    139       1.2  hamajima #ifdef DIAGNOSTIC
    140       1.2  hamajima 	if (sc->sc_powerhook == 0)
    141       1.2  hamajima 		printf("%s: unable to establish hard power hook",
    142       1.2  hamajima 		       sc->sc_dev.dv_xname);
    143       1.2  hamajima #endif
    144       1.1  hamajima }
    145       1.1  hamajima 
    146       1.1  hamajima int
    147       1.1  hamajima optpoint_intr(void *self)
    148       1.1  hamajima {
    149       1.1  hamajima 	struct optpoint_softc *sc = (void*)self;
    150       1.1  hamajima 	tx_chipset_tag_t tc = sc->sc_tc;
    151       1.1  hamajima 	char data = optpoint_recv(sc) & 0xff;
    152       1.1  hamajima 
    153       1.1  hamajima #ifdef DIAGNOSTIC
    154       1.1  hamajima 	if (sc->index >= 3){
    155       1.1  hamajima 		printf("%s: Receive buffer overflow\n", sc->sc_dev.dv_xname);
    156       1.1  hamajima 		sc->index = 0;
    157       1.1  hamajima 		memset(sc->packet, 0, 3);
    158       1.1  hamajima 	}
    159       1.1  hamajima #endif
    160       1.1  hamajima 	if ((sc->index == 1) && (data & 0xcc) != 0x08){
    161       1.1  hamajima 		DPRINTF(("%s: Bad second byte (0x%02x)\n",
    162       1.1  hamajima 			 sc->sc_dev.dv_xname, data));
    163       1.1  hamajima 		tx_conf_write(tc, TX39_INTRCLEAR4_REG,
    164       1.1  hamajima 				  TX39_INTRSTATUS4_OPTPOINTINT);
    165       1.1  hamajima 		return 0;
    166       1.1  hamajima 	}
    167       1.1  hamajima 
    168       1.1  hamajima 	sc->packet[sc->index++] = data;
    169       1.1  hamajima 	if (sc->index >= 3){
    170       1.2  hamajima 		u_int newbuttons = ((sc->packet[1] & LBUTMASK) ? 0x1 : 0)
    171       1.2  hamajima 				 | ((sc->packet[1] & RBUTMASK) ? 0x2 : 0);
    172       1.1  hamajima 		int dx = sc->packet[2];
    173       1.1  hamajima 		int dy = sc->packet[0];
    174       1.1  hamajima 		u_int changed = (sc->buttons ^ newbuttons);
    175       1.1  hamajima 
    176       1.1  hamajima 		if (dx || dy || changed){
    177       1.2  hamajima 			DPRINTF(("%s: buttons=0x%x, dx=%d, dy=%d\n",
    178       1.2  hamajima 				 sc->sc_dev.dv_xname, newbuttons, dx, dy));
    179       1.2  hamajima 			wsmouse_input(sc->sc_wsmousedev, newbuttons, dx, dy, 0,
    180       1.1  hamajima 				      WSMOUSE_INPUT_DELTA);
    181       1.1  hamajima 		}
    182       1.1  hamajima 		sc->buttons = newbuttons;
    183       1.1  hamajima 		sc->index = 0;
    184       1.1  hamajima 		memset(sc->packet, 0, 3);
    185       1.1  hamajima 	}
    186       1.1  hamajima 	tx_conf_write(tc, TX39_INTRCLEAR4_REG, TX39_INTRSTATUS4_OPTPOINTINT);
    187       1.1  hamajima 
    188       1.1  hamajima 	return 0;
    189       1.1  hamajima }
    190       1.1  hamajima 
    191       1.1  hamajima int
    192       1.1  hamajima optpoint_enable(void *self)
    193       1.1  hamajima {
    194       1.1  hamajima 	struct optpoint_softc *sc = (void*)self;
    195       1.1  hamajima 
    196       1.1  hamajima 	if (!sc->enabled){
    197       1.1  hamajima 		tx_chipset_tag_t tc = sc->sc_tc;
    198       1.1  hamajima 		struct hpcio_chip *hc = sc->sc_hc;
    199       1.1  hamajima 		int s = spltty();
    200       1.1  hamajima 
    201       1.2  hamajima 		DPRINTF(("%s: enable\n", sc->sc_dev.dv_xname));
    202       1.2  hamajima 
    203       1.1  hamajima 		sc->enabled = 1;
    204       1.1  hamajima 		sc->index = 0;
    205       1.1  hamajima 		sc->buttons = 0;
    206       1.1  hamajima 		sc->packet[0] = 0xf5;	/* Disable */
    207       1.1  hamajima 		sc->packet[1] = 0xf2;	/* Set Stream Mode */
    208       1.1  hamajima 		sc->packet[2] = 0xf8;	/* Stanby */
    209       1.1  hamajima 		sc->packet[3] = 0xf4;	/* Enable */
    210       1.1  hamajima 
    211       1.1  hamajima 		tx39spi_enable(sc->sc_spi, 1);
    212       1.1  hamajima 		tx_intr_establish(tc, MAKEINTR(4, TX39_INTRSTATUS4_OPTPOINTINT),
    213       1.1  hamajima 				  IST_EDGE, IPL_TTY, optpoint_initialize, sc);
    214       1.1  hamajima 		(*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_C_REQ, 1);
    215       1.1  hamajima 		(*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_T_RDY, 1);
    216       1.1  hamajima 		splx(s);
    217       1.1  hamajima 	}
    218       1.1  hamajima 
    219       1.1  hamajima         return 0;
    220       1.1  hamajima }
    221       1.1  hamajima 
    222       1.1  hamajima void
    223       1.1  hamajima optpoint_disable(void *self)
    224       1.1  hamajima {
    225       1.1  hamajima 	struct optpoint_softc *sc = (void*)self;
    226       1.1  hamajima 
    227       1.1  hamajima 	if (sc->enabled){
    228       1.1  hamajima 		tx_chipset_tag_t tc = sc->sc_tc;
    229       1.1  hamajima 		struct hpcio_chip *hc = sc->sc_hc;
    230       1.1  hamajima 		int s = spltty();
    231       1.1  hamajima 
    232       1.2  hamajima 		DPRINTF(("%s: disable\n", sc->sc_dev.dv_xname));
    233       1.2  hamajima 
    234       1.1  hamajima 		sc->enabled = 0;
    235       1.1  hamajima 		(*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_C_REQ, 0);
    236       1.1  hamajima 		(*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_T_RDY, 0);
    237       1.1  hamajima 		tx_intr_disestablish(tc,
    238       1.1  hamajima 			    (void *)MAKEINTR(4, TX39_INTRSTATUS4_OPTPOINTINT));
    239       1.1  hamajima 		tx39spi_enable(sc->sc_spi, 0);
    240       1.1  hamajima 		splx(s);
    241       1.1  hamajima 	}
    242       1.1  hamajima }
    243       1.1  hamajima 
    244       1.1  hamajima int
    245  1.3.12.1      tron optpoint_ioctl(void *self, u_long cmd, caddr_t data, int flag, struct lwp *l)
    246       1.1  hamajima {
    247       1.1  hamajima 	switch (cmd) {
    248       1.1  hamajima 	case WSMOUSEIO_GTYPE:
    249       1.1  hamajima 		*(u_int *)data = WSMOUSE_TYPE_PS2;
    250       1.1  hamajima 		break;
    251       1.1  hamajima 
    252       1.1  hamajima 	default:
    253       1.1  hamajima 		return (EPASSTHROUGH);
    254       1.1  hamajima 	}
    255       1.1  hamajima         return 0;
    256       1.1  hamajima }
    257       1.1  hamajima 
    258       1.1  hamajima int
    259       1.1  hamajima optpoint_initialize(void *self)
    260       1.1  hamajima {
    261       1.1  hamajima 	struct optpoint_softc *sc = (void*)self;
    262       1.1  hamajima 	struct hpcio_chip *hc = sc->sc_hc;
    263       1.1  hamajima 	tx_chipset_tag_t tc = sc->sc_tc;
    264       1.1  hamajima 
    265       1.1  hamajima 	if (sc->index < 4){
    266       1.1  hamajima 		optpoint_send(sc, sc->packet[sc->index++]);
    267       1.1  hamajima 		(*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_C_REQ, 1);
    268       1.1  hamajima 		(*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_T_RDY, 1);
    269       1.1  hamajima 	} else {
    270       1.1  hamajima 		tx_intr_disestablish(tc,
    271       1.1  hamajima 			    (void *)MAKEINTR(4, TX39_INTRSTATUS4_OPTPOINTINT));
    272       1.1  hamajima 		sc->index = 0;
    273       1.1  hamajima 		memset(sc->packet, 0, 3);
    274       1.1  hamajima 		tx_intr_establish(tc,
    275       1.1  hamajima 				  MAKEINTR(4, TX39_INTRSTATUS4_OPTPOINTINT),
    276       1.1  hamajima 				  IST_EDGE, IPL_TTY, optpoint_intr, sc);
    277       1.1  hamajima 		(*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_C_REQ, 0);
    278       1.1  hamajima 		(*hc->hc_portwrite)(hc, TELIOS_MFIO_OPTP_T_RDY, 1);
    279       1.1  hamajima 	}
    280       1.1  hamajima 	tx_conf_write(tc, TX39_INTRCLEAR4_REG, TX39_INTRSTATUS4_OPTPOINTINT);
    281       1.1  hamajima 
    282       1.1  hamajima 	return 0;
    283       1.1  hamajima }
    284       1.1  hamajima 
    285       1.1  hamajima void
    286       1.1  hamajima optpoint_send(struct optpoint_softc *sc, int data)
    287       1.1  hamajima {
    288       1.1  hamajima 	struct hpcio_chip *hc = sc->sc_hc;
    289       1.1  hamajima 
    290       1.1  hamajima 	while ((*hc->hc_portread)(hc, TELIOS_MFIO_OPTP_S_ENB_N))
    291       1.1  hamajima 		;
    292       1.1  hamajima 	tx39spi_put_word(sc->sc_spi, data & 0xff);
    293       1.1  hamajima }
    294       1.1  hamajima 
    295       1.1  hamajima int
    296       1.1  hamajima optpoint_recv(struct optpoint_softc *sc)
    297       1.1  hamajima {
    298       1.1  hamajima 	struct hpcio_chip *hc = sc->sc_hc;
    299       1.1  hamajima 
    300       1.1  hamajima 	optpoint_send(sc, 0x00);
    301       1.1  hamajima 	while ((*hc->hc_portread)(hc, TELIOS_MFIO_OPTP_S_ENB_N))
    302       1.1  hamajima 		;
    303       1.1  hamajima 	return tx39spi_get_word(sc->sc_spi) & 0xff;
    304       1.1  hamajima }
    305       1.2  hamajima 
    306       1.2  hamajima int
    307       1.2  hamajima optpoint_power(void *self, int type, long id, void *msg)
    308       1.2  hamajima {
    309       1.2  hamajima 	struct optpoint_softc *sc = (void *)self;
    310       1.2  hamajima 	int why = (int)msg;
    311       1.2  hamajima 
    312       1.2  hamajima 	switch (why) {
    313       1.2  hamajima 	case PWR_RESUME:
    314       1.2  hamajima 		/* power on */
    315       1.2  hamajima 		optpoint_enable(sc);
    316       1.2  hamajima 		break;
    317       1.2  hamajima 	case PWR_SUSPEND:
    318       1.2  hamajima 		/* FALLTHROUGH */
    319       1.2  hamajima 	case PWR_STANDBY:
    320       1.2  hamajima 		/* power off */
    321       1.2  hamajima 		optpoint_disable(sc);
    322       1.2  hamajima 		break;
    323       1.2  hamajima 	}
    324       1.2  hamajima 
    325       1.2  hamajima 	return 0;
    326       1.2  hamajima }
    327