FreeBSD/Linux Kernel Cross Reference
sys/dev/ic/joy.c

     /*      $NetBSD: joy.c,v 1.21 2017/10/28 04:53:55 riastradh Exp $       */
     
     /*-
      * Copyright (c) 2008 The NetBSD Foundation, Inc.
      * All rights reserved.
      *
      * This code is derived from software developed for The NetBSD Foundation
      * by Andrew Doran.
      *
     * Redistribution and use in source and binary forms, with or without
     * modification, are permitted provided that the following conditions
     * are met:
     * 1. Redistributions of source code must retain the above copyright
     *    notice, this list of conditions and the following disclaimer.
     * 2. Redistributions in binary form must reproduce the above copyright
     *    notice, this list of conditions and the following disclaimer in the
     *    documentation and/or other materials provided with the distribution.
     *
     * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     * POSSIBILITY OF SUCH DAMAGE.
     */
    
    /*-
     * Copyright (c) 1995 Jean-Marc Zucconi
     * All rights reserved.
     *
     * Ported to NetBSD by Matthieu Herrb <matthieu@laas.fr>
     *
     * Redistribution and use in source and binary forms, with or without
     * modification, are permitted provided that the following conditions
     * are met:
     * 1. Redistributions of source code must retain the above copyright
     *    notice, this list of conditions and the following disclaimer
     *    in this position and unchanged.
     * 2. Redistributions in binary form must reproduce the above copyright
     *    notice, this list of conditions and the following disclaimer in the
     *    documentation and/or other materials provided with the distribution.
     * 3. The name of the author may not be used to endorse or promote products
     *    derived from this software without specific prior written permission
     *
     * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     *
     */
    
    #include <sys/cdefs.h>
    __KERNEL_RCSID(0, "$NetBSD: joy.c,v 1.21 2017/10/28 04:53:55 riastradh Exp $");
    
    #include <sys/param.h>
    #include <sys/systm.h>
    #include <sys/kernel.h>
    #include <sys/device.h>
    #include <sys/errno.h>
    #include <sys/conf.h>
    #include <sys/event.h>
    #include <sys/vnode.h>
    #include <sys/bus.h>
    #include <sys/joystick.h>
    
    #include <dev/ic/joyvar.h>
    
    #include "ioconf.h"
    
    /*
     * The game port can manage 4 buttons and 4 variable resistors (usually 2
     * joysticks, each with 2 buttons and 2 pots.) via the port at address 0x201.
     * Getting the state of the buttons is done by reading the game port;
     * buttons 1-4 correspond to bits 4-7 and resistors 1-4 (X1, Y1, X2, Y2)
     * to bits 0-3.  If button 1 (resp 2, 3, 4) is pressed, the bit 4 (resp 5,
     * 6, 7) is set to 0 to get the value of a resistor, write the value 0xff
     * at port and wait until the corresponding bit returns to 0.
     */
    
    
    #define JOYPART(d) (minor(d) & 1)
    #define JOYUNIT(d) (minor(d) >> 1)
    
    #ifndef JOY_TIMEOUT
    #define JOY_TIMEOUT   2000      /* 2 milliseconds */
    #endif
    
    static dev_type_open(joyopen);
   static dev_type_close(joyclose);
   static dev_type_read(joyread);
   static dev_type_ioctl(joyioctl);
   
   const struct cdevsw joy_cdevsw = {
           .d_open = joyopen,
           .d_close = joyclose,
           .d_read = joyread,
           .d_write = nowrite,
           .d_ioctl = joyioctl,
           .d_stop = nostop,
           .d_tty = notty,
           .d_poll = nopoll,
           .d_mmap = nommap,
           .d_kqfilter = nokqfilter,
           .d_discard = nodiscard,
           .d_flag = D_OTHER | D_MPSAFE
   };
   
   void
   joyattach(struct joy_softc *sc)
   {
   
           if (sc->sc_lock == NULL) {
                   panic("joyattach: no lock");
           }
   
           sc->timeout[0] = 0;
           sc->timeout[1] = 0;
   
           mutex_enter(sc->sc_lock);
           bus_space_write_1(sc->sc_iot, sc->sc_ioh, 0, 0xff);
           DELAY(10000);           /* 10 ms delay */
           aprint_normal_dev(sc->sc_dev, "joystick %sconnected\n",
               (bus_space_read_1(sc->sc_iot, sc->sc_ioh, 0) & 0x0f) == 0x0f ?
               "not " : "");
           mutex_exit(sc->sc_lock);
   }
   
   int
   joydetach(struct joy_softc *sc, int flags)
   {
           int maj, mn;
   
           maj = cdevsw_lookup_major(&joy_cdevsw);
           mn = device_unit(sc->sc_dev) << 1;
           vdevgone(maj, mn, mn, VCHR);
           vdevgone(maj, mn + 1, mn + 1, VCHR);
   
           return 0;
   }
   
   static int
   joyopen(dev_t dev, int flag, int mode, struct lwp *l)
   {
           int unit = JOYUNIT(dev);
           int i = JOYPART(dev);
           struct joy_softc *sc;
   
           sc = device_lookup_private(&joy_cd, unit);
           if (sc == NULL)
                   return ENXIO;
   
           mutex_enter(sc->sc_lock);
           if (sc->timeout[i]) {
                   mutex_exit(sc->sc_lock);
                   return EBUSY;
           }
           sc->x_off[i] = sc->y_off[i] = 0;
           sc->timeout[i] = JOY_TIMEOUT;
           mutex_exit(sc->sc_lock);
           return 0;
   }
   
   static int
   joyclose(dev_t dev, int flag, int mode, struct lwp *l)
   {
           int unit = JOYUNIT(dev);
           int i = JOYPART(dev);
           struct joy_softc *sc = device_lookup_private(&joy_cd, unit);
   
           mutex_enter(sc->sc_lock);
           sc->timeout[i] = 0;
           mutex_exit(sc->sc_lock);
           return 0;
   }
   
   static int
   joyread(dev_t dev, struct uio *uio, int flag)
   {
           int unit = JOYUNIT(dev);
           struct joy_softc *sc = device_lookup_private(&joy_cd, unit);
           bus_space_tag_t iot = sc->sc_iot;
           bus_space_handle_t ioh = sc->sc_ioh;
           struct joystick c;
           struct timeval start, now, diff;
           int state = 0, x = 0, y = 0, i;
   
           mutex_enter(sc->sc_lock);
           bus_space_write_1(iot, ioh, 0, 0xff);
           microtime(&start);
           now = start; /* structure assignment */
           i = sc->timeout[JOYPART(dev)];
           for (;;) {
                   timersub(&now, &start, &diff);
                   if (diff.tv_sec > 0 || diff.tv_usec > i)
                           break;
                   state = bus_space_read_1(iot, ioh, 0);
                   if (JOYPART(dev) == 1)
                           state >>= 2;
                   if (!x && !(state & 0x01))
                           x = diff.tv_usec;
                   if (!y && !(state & 0x02))
                           y = diff.tv_usec;
                   if (x && y)
                           break;
                   microtime(&now);
           }
           mutex_exit(sc->sc_lock);
   
           c.x = x ? sc->x_off[JOYPART(dev)] + x : 0x80000000;
           c.y = y ? sc->y_off[JOYPART(dev)] + y : 0x80000000;
           state >>= 4;
           c.b1 = ~state & 1;
           c.b2 = ~(state >> 1) & 1;
           return uiomove(&c, sizeof(struct joystick), uio);
   }
   
   static int
   joyioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
   {
           int unit = JOYUNIT(dev);
           struct joy_softc *sc = device_lookup_private(&joy_cd, unit);
           int i = JOYPART(dev), x, error;
   
           mutex_enter(sc->sc_lock);
           error = 0;
           switch (cmd) {
           case JOY_SETTIMEOUT:
                   x = *(int *)data;
                   if (x < 1 || x > 10000) {       /* 10ms maximum! */
                           error = EINVAL;
                           break;
                   }
                   sc->timeout[i] = x;
                   break;
           case JOY_GETTIMEOUT:
                   *(int *)data = sc->timeout[i];
                   break;
           case JOY_SET_X_OFFSET:
                   sc->x_off[i] = *(int *)data;
                   break;
           case JOY_SET_Y_OFFSET:
                   sc->y_off[i] = *(int *)data;
                   break;
           case JOY_GET_X_OFFSET:
                   *(int *)data = sc->x_off[i];
                   break;
           case JOY_GET_Y_OFFSET:
                   *(int *)data = sc->y_off[i];
                   break;
           default:
                   error = ENXIO;
                   break;
           }
           mutex_exit(sc->sc_lock);
           return error;
   }

Cache object: 0486e054b9d2547c9318b83440ef52f9