1 /* $NetBSD: joy.c,v 1.6 2003/06/29 22:30:12 fvdl Exp $ */ 2 3 /*- 4 * Copyright (c) 1995 Jean-Marc Zucconi 5 * All rights reserved. 6 * 7 * Ported to NetBSD by Matthieu Herrb <matthieu@laas.fr> 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer 14 * in this position and unchanged. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 3. The name of the author may not be used to endorse or promote products 19 * derived from this software without specific prior written permission 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 22 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 23 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 24 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 25 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 26 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 27 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 28 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 30 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 31 * 32 */ 33 34 #include <sys/cdefs.h> 35 __KERNEL_RCSID(0, "$NetBSD: joy.c,v 1.6 2003/06/29 22:30:12 fvdl Exp $"); 36 37 #include <sys/param.h> 38 #include <sys/systm.h> 39 #include <sys/kernel.h> 40 #include <sys/device.h> 41 #include <sys/errno.h> 42 #include <sys/conf.h> 43 #include <sys/event.h> 44 45 #include <machine/bus.h> 46 47 #include <machine/cpu.h> 48 #include <machine/pio.h> 49 #include <machine/joystick.h> 50 51 #include <dev/isa/isavar.h> 52 #include <dev/isa/isareg.h> 53 54 #include <dev/ic/joyvar.h> 55 56 /* 57 * The game port can manage 4 buttons and 4 variable resistors (usually 2 58 * joysticks, each with 2 buttons and 2 pots.) via the port at address 0x201. 59 * Getting the state of the buttons is done by reading the game port; 60 * buttons 1-4 correspond to bits 4-7 and resistors 1-4 (X1, Y1, X2, Y2) 61 * to bits 0-3. If button 1 (resp 2, 3, 4) is pressed, the bit 4 (resp 5, 62 * 6, 7) is set to 0 to get the value of a resistor, write the value 0xff 63 * at port and wait until the corresponding bit returns to 0. 64 */ 65 66 /* 67 * The formulae below only work if u is ``not too large''. See also 68 * the discussion in microtime.s 69 */ 70 #define USEC2TICKS(u) (((u) * 19549) >> 14) 71 #define TICKS2USEC(u) (((u) * 3433) >> 12) 72 73 74 #define JOYPART(d) (minor(d) & 1) 75 #define JOYUNIT(d) minor(d) >> 1 & 3 76 77 #ifndef JOY_TIMEOUT 78 #define JOY_TIMEOUT 2000 /* 2 milliseconds */ 79 #endif 80 81 extern struct cfdriver joy_cd; 82 83 dev_type_open(joyopen); 84 dev_type_close(joyclose); 85 dev_type_read(joyread); 86 dev_type_ioctl(joyioctl); 87 88 const struct cdevsw joy_cdevsw = { 89 joyopen, joyclose, joyread, nowrite, joyioctl, 90 nostop, notty, nopoll, nommap, nokqfilter, 91 }; 92 93 void 94 joyattach(sc) 95 struct joy_softc *sc; 96 { 97 98 sc->timeout[0] = sc->timeout[1] = 0; 99 bus_space_write_1(sc->sc_iot, sc->sc_ioh, 0, 0xff); 100 DELAY(10000); /* 10 ms delay */ 101 printf("%s: joystick %sconnected\n", sc->sc_dev.dv_xname, 102 (bus_space_read_1(sc->sc_iot, sc->sc_ioh, 0) & 0x0f) == 0x0f ? 103 "not " : ""); 104 105 sc->sc_timer_freq = joy_timer_freq(); 106 } 107 108 int 109 joyopen(dev, flag, mode, p) 110 dev_t dev; 111 int flag, mode; 112 struct proc *p; 113 { 114 int unit = JOYUNIT(dev); 115 int i = JOYPART(dev); 116 struct joy_softc *sc; 117 118 if (unit >= joy_cd.cd_ndevs) 119 return (ENXIO); 120 sc = joy_cd.cd_devs[unit]; 121 if (sc == 0) 122 return (ENXIO); 123 124 if (sc->timeout[i]) 125 return (EBUSY); 126 127 sc->x_off[i] = sc->y_off[i] = 0; 128 sc->timeout[i] = JOY_TIMEOUT; 129 return (0); 130 } 131 132 int 133 joyclose(dev, flag, mode, p) 134 dev_t dev; 135 int flag, mode; 136 struct proc *p; 137 { 138 int unit = JOYUNIT(dev); 139 int i = JOYPART(dev); 140 struct joy_softc *sc = joy_cd.cd_devs[unit]; 141 142 sc->timeout[i] = 0; 143 return (0); 144 } 145 146 int 147 joyread(dev, uio, flag) 148 dev_t dev; 149 struct uio *uio; 150 int flag; 151 { 152 int unit = JOYUNIT(dev); 153 struct joy_softc *sc = joy_cd.cd_devs[unit]; 154 bus_space_tag_t iot = sc->sc_iot; 155 bus_space_handle_t ioh = sc->sc_ioh; 156 struct joystick c; 157 int i, t0, t1, s; 158 int state = 0, x = 0, y = 0; 159 160 s = splhigh(); /* XXX */ 161 bus_space_write_1(iot, ioh, 0, 0xff); 162 t0 = joy_get_tick(); 163 t1 = t0; 164 i = USEC2TICKS(sc->timeout[JOYPART(dev)]); 165 while (t0 - t1 < i) { 166 state = bus_space_read_1(iot, ioh, 0); 167 if (JOYPART(dev) == 1) 168 state >>= 2; 169 t1 = joy_get_tick(); 170 if (t1 > t0) 171 t1 -= sc->sc_timer_freq / hz; 172 if (!x && !(state & 0x01)) 173 x = t1; 174 if (!y && !(state & 0x02)) 175 y = t1; 176 if (x && y) 177 break; 178 } 179 splx(s); /* XXX */ 180 181 c.x = x ? sc->x_off[JOYPART(dev)] + TICKS2USEC(t0 - x) : 0x80000000; 182 c.y = y ? sc->y_off[JOYPART(dev)] + TICKS2USEC(t0 - y) : 0x80000000; 183 state >>= 4; 184 c.b1 = ~state & 1; 185 c.b2 = ~(state >> 1) & 1; 186 return (uiomove(&c, sizeof(struct joystick), uio)); 187 } 188 189 int 190 joyioctl(dev, cmd, data, flag, p) 191 dev_t dev; 192 u_long cmd; 193 caddr_t data; 194 int flag; 195 struct proc *p; 196 { 197 int unit = JOYUNIT(dev); 198 struct joy_softc *sc = joy_cd.cd_devs[unit]; 199 int i = JOYPART(dev); 200 int x; 201 202 switch (cmd) { 203 case JOY_SETTIMEOUT: 204 x = *(int *) data; 205 if (x < 1 || x > 10000) /* 10ms maximum! */ 206 return (EINVAL); 207 sc->timeout[i] = x; 208 break; 209 case JOY_GETTIMEOUT: 210 *(int *) data = sc->timeout[i]; 211 break; 212 case JOY_SET_X_OFFSET: 213 sc->x_off[i] = *(int *) data; 214 break; 215 case JOY_SET_Y_OFFSET: 216 sc->y_off[i] = *(int *) data; 217 break; 218 case JOY_GET_X_OFFSET: 219 *(int *) data = sc->x_off[i]; 220 break; 221 case JOY_GET_Y_OFFSET: 222 *(int *) data = sc->y_off[i]; 223 break; 224 default: 225 return (ENXIO); 226 } 227 return 0; 228 } 229