Home | History | Annotate | Line # | Download | only in dev
optpoint.c revision 1.2.4.1
      1  1.2.4.1      yamt /*	$NetBSD: optpoint.c,v 1.2.4.1 2006/06/21 14:51:50 yamt 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.2.4.1      yamt __KERNEL_RCSID(0, "$NetBSD: optpoint.c,v 1.2.4.1 2006/06/21 14:51:50 yamt 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.2.4.1      yamt 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.2.4.1      yamt 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