ms_ap.c revision 1.5
11.5Slukem/* $NetBSD: ms_ap.c,v 1.5 2003/07/15 02:59:28 lukem Exp $ */ 21.1Stsubai 31.1Stsubai/*- 41.1Stsubai * Copyright (c) 2000 Tsubai Masanari. All rights reserved. 51.1Stsubai * 61.1Stsubai * Redistribution and use in source and binary forms, with or without 71.1Stsubai * modification, are permitted provided that the following conditions 81.1Stsubai * are met: 91.1Stsubai * 1. Redistributions of source code must retain the above copyright 101.1Stsubai * notice, this list of conditions and the following disclaimer. 111.1Stsubai * 2. Redistributions in binary form must reproduce the above copyright 121.1Stsubai * notice, this list of conditions and the following disclaimer in the 131.1Stsubai * documentation and/or other materials provided with the distribution. 141.1Stsubai * 3. The name of the author may not be used to endorse or promote products 151.1Stsubai * derived from this software without specific prior written permission. 161.1Stsubai * 171.1Stsubai * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 181.1Stsubai * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 191.1Stsubai * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 201.1Stsubai * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 211.1Stsubai * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 221.1Stsubai * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 231.1Stsubai * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 241.1Stsubai * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 251.1Stsubai * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 261.1Stsubai * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 271.1Stsubai */ 281.5Slukem 291.5Slukem#include <sys/cdefs.h> 301.5Slukem__KERNEL_RCSID(0, "$NetBSD: ms_ap.c,v 1.5 2003/07/15 02:59:28 lukem Exp $"); 311.1Stsubai 321.1Stsubai#include <sys/param.h> 331.1Stsubai#include <sys/device.h> 341.1Stsubai#include <sys/systm.h> 351.1Stsubai 361.1Stsubai#include <dev/wscons/wsconsio.h> 371.1Stsubai#include <dev/wscons/wsmousevar.h> 381.1Stsubai 391.1Stsubai#include <machine/adrsmap.h> 401.1Stsubai#include <newsmips/apbus/apbusvar.h> 411.1Stsubai 421.1Stsubaistruct msreg { 431.1Stsubai u_int ms_data; 441.1Stsubai u_int ms_stat; 451.1Stsubai u_int ms_intr_en; 461.1Stsubai u_int ms_reset; 471.1Stsubai u_int ms_speed; 481.1Stsubai}; 491.1Stsubai 501.1Stsubaistruct ms_ap_softc { 511.1Stsubai struct device sc_dev; 521.1Stsubai volatile struct msreg *sc_reg; 531.1Stsubai struct device *sc_wsmousedev; 541.1Stsubai int sc_ndata; 551.1Stsubai u_char sc_buf[3]; 561.1Stsubai}; 571.1Stsubai 581.1Stsubaiint ms_ap_match(struct device *, struct cfdata *, void *); 591.1Stsubaivoid ms_ap_attach(struct device *, struct device *, void *); 601.1Stsubaiint ms_ap_intr(void *); 611.1Stsubai 621.1Stsubaiint ms_ap_enable(void *); 631.1Stsubaiint ms_ap_ioctl(void *, u_long, caddr_t, int, struct proc *); 641.1Stsubaivoid ms_ap_disable(void *); 651.1Stsubai 661.4SthorpejCFATTACH_DECL(ms_ap, sizeof(struct ms_ap_softc), 671.4Sthorpej ms_ap_match, ms_ap_attach, NULL, NULL); 681.1Stsubai 691.1Stsubaistruct wsmouse_accessops ms_ap_accessops = { 701.1Stsubai ms_ap_enable, 711.1Stsubai ms_ap_ioctl, 721.1Stsubai ms_ap_disable 731.1Stsubai}; 741.1Stsubai 751.1Stsubaiint 761.1Stsubaims_ap_match(parent, cf, aux) 771.1Stsubai struct device *parent; 781.1Stsubai struct cfdata *cf; 791.1Stsubai void *aux; 801.1Stsubai{ 811.1Stsubai struct apbus_attach_args *apa = aux; 821.1Stsubai 831.1Stsubai if (strcmp(apa->apa_name, "ms") == 0) 841.1Stsubai return 1; 851.1Stsubai 861.1Stsubai return 0; 871.1Stsubai} 881.1Stsubai 891.1Stsubaivoid 901.1Stsubaims_ap_attach(parent, self, aux) 911.1Stsubai struct device *parent, *self; 921.1Stsubai void *aux; 931.1Stsubai{ 941.1Stsubai struct ms_ap_softc *sc = (void *)self; 951.1Stsubai struct apbus_attach_args *apa = aux; 961.1Stsubai volatile struct msreg *reg = (void *)apa->apa_hwbase; 971.1Stsubai struct wsmousedev_attach_args aa; 981.1Stsubai 991.1Stsubai printf(" slot%d addr 0x%lx\n", apa->apa_slotno, apa->apa_hwbase); 1001.1Stsubai 1011.1Stsubai sc->sc_reg = reg; 1021.1Stsubai 1031.1Stsubai reg->ms_reset = 0x03; 1041.1Stsubai reg->ms_speed = 0x01; 1051.1Stsubai reg->ms_intr_en = 0; 1061.1Stsubai 1071.1Stsubai apbus_intr_establish(1, NEWS5000_INT1_KBD, 0, ms_ap_intr, sc, 1081.1Stsubai "", apa->apa_ctlnum); 1091.1Stsubai 1101.1Stsubai aa.accessops = &ms_ap_accessops; 1111.1Stsubai aa.accesscookie = sc; 1121.1Stsubai sc->sc_wsmousedev = config_found(self, &aa, wsmousedevprint); 1131.1Stsubai} 1141.1Stsubai 1151.1Stsubaiint 1161.1Stsubaims_ap_intr(v) 1171.1Stsubai void *v; 1181.1Stsubai{ 1191.1Stsubai struct ms_ap_softc *sc = v; 1201.1Stsubai volatile struct msreg *reg = sc->sc_reg; 1211.1Stsubai int code, index, byte0, byte1, byte2; 1221.1Stsubai int button, dx, dy; 1231.1Stsubai int rv = 0; 1241.1Stsubai 1251.1Stsubai reg->ms_intr_en = 0; 1261.1Stsubai 1271.1Stsubai while (reg->ms_stat & RX_MSRDY) { 1281.1Stsubai rv = 1; 1291.1Stsubai code = reg->ms_data; 1301.1Stsubai index = sc->sc_ndata; 1311.1Stsubai 1321.1Stsubai if (sc->sc_wsmousedev == NULL) 1331.1Stsubai continue; 1341.1Stsubai 1351.1Stsubai if (code & 0x80) { 1361.1Stsubai sc->sc_buf[0] = code; 1371.1Stsubai sc->sc_ndata = 1; 1381.1Stsubai continue; 1391.1Stsubai } 1401.1Stsubai 1411.1Stsubai if (index == 1) { 1421.1Stsubai sc->sc_buf[1] = code; 1431.1Stsubai sc->sc_ndata++; 1441.1Stsubai continue; 1451.1Stsubai } 1461.1Stsubai 1471.1Stsubai if (index == 2) { 1481.1Stsubai sc->sc_buf[2] = code; 1491.1Stsubai sc->sc_ndata++; 1501.1Stsubai 1511.1Stsubai byte0 = sc->sc_buf[0]; 1521.1Stsubai byte1 = sc->sc_buf[1]; 1531.1Stsubai byte2 = sc->sc_buf[2]; 1541.1Stsubai 1551.1Stsubai button = 0; 1561.1Stsubai if (byte0 & 0x01) 1571.1Stsubai button |= 1; 1581.1Stsubai if (byte0 & 0x04) 1591.1Stsubai button |= 2; 1601.1Stsubai if (byte0 & 0x02) 1611.1Stsubai button |= 4; 1621.1Stsubai 1631.1Stsubai if (byte0 & 0x08) 1641.1Stsubai dx = byte1 - 0x80; 1651.1Stsubai else 1661.1Stsubai dx = byte1; 1671.1Stsubai if (byte0 & 0x10) 1681.1Stsubai dy = byte2 - 0x80; 1691.1Stsubai else 1701.1Stsubai dy = byte2; 1711.1Stsubai 1721.1Stsubai wsmouse_input(sc->sc_wsmousedev, button, dx, -dy, 0, 1731.1Stsubai WSMOUSE_INPUT_DELTA); 1741.1Stsubai } 1751.1Stsubai } 1761.1Stsubai 1771.1Stsubai reg->ms_intr_en = 1; 1781.1Stsubai return rv; 1791.1Stsubai} 1801.1Stsubai 1811.1Stsubaiint 1821.1Stsubaims_ap_enable(v) 1831.1Stsubai void *v; 1841.1Stsubai{ 1851.1Stsubai struct ms_ap_softc *sc = v; 1861.1Stsubai volatile struct msreg *reg = sc->sc_reg; 1871.1Stsubai 1881.1Stsubai reg->ms_intr_en = 1; 1891.1Stsubai return 0; 1901.1Stsubai} 1911.1Stsubai 1921.1Stsubaivoid 1931.1Stsubaims_ap_disable(v) 1941.1Stsubai void *v; 1951.1Stsubai{ 1961.1Stsubai struct ms_ap_softc *sc = v; 1971.1Stsubai volatile struct msreg *reg = sc->sc_reg; 1981.1Stsubai 1991.1Stsubai reg->ms_intr_en = 0; 2001.1Stsubai} 2011.1Stsubai 2021.1Stsubaiint 2031.1Stsubaims_ap_ioctl(v, cmd, data, flag, p) 2041.1Stsubai void *v; 2051.1Stsubai u_long cmd; 2061.1Stsubai caddr_t data; 2071.1Stsubai int flag; 2081.1Stsubai struct proc *p; 2091.1Stsubai{ 2101.2Satatat return EPASSTHROUGH; 2111.1Stsubai} 212