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