8a962f23f2
the original ad-audiomp branch notes: Add MP locking to the audio drivers. Making the audio drivers MP safe is necessary before efforts can be made to make the VM system MP safe. The are two locks per device instance, an ISR lock and a character device lock. The ISR lock replaces calls to splaudio()/splx(), and will be held across calls to device methods which were called at splaudio() before (e.g. trigger_output). The character device lock is held across calls to nearly all of the methods, excluding some only used for initialization, e.g. get_locks. Welcome to 5.99.57.
258 lines
7.5 KiB
C
258 lines
7.5 KiB
C
/* $NetBSD: joy.c,v 1.18 2011/11/23 23:07:32 jmcneill 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.18 2011/11/23 23:07:32 jmcneill 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>
|
|
|
|
/*
|
|
* 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
|
|
|
|
extern struct cfdriver joy_cd;
|
|
|
|
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 = {
|
|
joyopen, joyclose, joyread, nowrite, joyioctl,
|
|
nostop, notty, nopoll, nommap, nokqfilter, 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;
|
|
}
|