forked from Minki/linux
4e57b68178
I recently picked up my older work to remove unnecessary #includes of sched.h, starting from a patch by Dave Jones to not include sched.h from module.h. This reduces the number of indirect includes of sched.h by ~300. Another ~400 pointless direct includes can be removed after this disentangling (patch to follow later). However, quite a few indirect includes need to be fixed up for this. In order to feed the patches through -mm with as little disturbance as possible, I've split out the fixes I accumulated up to now (complete for i386 and x86_64, more archs to follow later) and post them before the real patch. This way this large part of the patch is kept simple with only adding #includes, and all hunks are independent of each other. So if any hunk rejects or gets in the way of other patches, just drop it. My scripts will pick it up again in the next round. Signed-off-by: Tim Schmielau <tim@physik3.uni-rostock.de> Signed-off-by: Andrew Morton <akpm@osdl.org> Signed-off-by: Linus Torvalds <torvalds@osdl.org>
274 lines
6.5 KiB
C
274 lines
6.5 KiB
C
/*
|
|
* $Id: cobra.c,v 1.19 2002/01/22 20:26:52 vojtech Exp $
|
|
*
|
|
* Copyright (c) 1999-2001 Vojtech Pavlik
|
|
*/
|
|
|
|
/*
|
|
* Creative Labs Blaster GamePad Cobra driver for Linux
|
|
*/
|
|
|
|
/*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*
|
|
* Should you need to contact me, the author, you can do so either by
|
|
* e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
|
|
* Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/init.h>
|
|
#include <linux/gameport.h>
|
|
#include <linux/input.h>
|
|
#include <linux/jiffies.h>
|
|
|
|
#define DRIVER_DESC "Creative Labs Blaster GamePad Cobra driver"
|
|
|
|
MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
|
|
MODULE_DESCRIPTION(DRIVER_DESC);
|
|
MODULE_LICENSE("GPL");
|
|
|
|
#define COBRA_MAX_STROBE 45 /* 45 us max wait for first strobe */
|
|
#define COBRA_LENGTH 36
|
|
|
|
static int cobra_btn[] = { BTN_START, BTN_SELECT, BTN_TL, BTN_TR, BTN_X, BTN_Y, BTN_Z, BTN_A, BTN_B, BTN_C, BTN_TL2, BTN_TR2, 0 };
|
|
|
|
struct cobra {
|
|
struct gameport *gameport;
|
|
struct input_dev *dev[2];
|
|
int reads;
|
|
int bads;
|
|
unsigned char exists;
|
|
char phys[2][32];
|
|
};
|
|
|
|
static unsigned char cobra_read_packet(struct gameport *gameport, unsigned int *data)
|
|
{
|
|
unsigned long flags;
|
|
unsigned char u, v, w;
|
|
__u64 buf[2];
|
|
int r[2], t[2];
|
|
int i, j, ret;
|
|
|
|
int strobe = gameport_time(gameport, COBRA_MAX_STROBE);
|
|
|
|
for (i = 0; i < 2; i++) {
|
|
r[i] = buf[i] = 0;
|
|
t[i] = COBRA_MAX_STROBE;
|
|
}
|
|
|
|
local_irq_save(flags);
|
|
|
|
u = gameport_read(gameport);
|
|
|
|
do {
|
|
t[0]--; t[1]--;
|
|
v = gameport_read(gameport);
|
|
for (i = 0, w = u ^ v; i < 2 && w; i++, w >>= 2)
|
|
if (w & 0x30) {
|
|
if ((w & 0x30) < 0x30 && r[i] < COBRA_LENGTH && t[i] > 0) {
|
|
buf[i] |= (__u64)((w >> 5) & 1) << r[i]++;
|
|
t[i] = strobe;
|
|
u = v;
|
|
} else t[i] = 0;
|
|
}
|
|
} while (t[0] > 0 || t[1] > 0);
|
|
|
|
local_irq_restore(flags);
|
|
|
|
ret = 0;
|
|
|
|
for (i = 0; i < 2; i++) {
|
|
|
|
if (r[i] != COBRA_LENGTH) continue;
|
|
|
|
for (j = 0; j < COBRA_LENGTH && (buf[i] & 0x04104107f) ^ 0x041041040; j++)
|
|
buf[i] = (buf[i] >> 1) | ((__u64)(buf[i] & 1) << (COBRA_LENGTH - 1));
|
|
|
|
if (j < COBRA_LENGTH) ret |= (1 << i);
|
|
|
|
data[i] = ((buf[i] >> 7) & 0x000001f) | ((buf[i] >> 8) & 0x00003e0)
|
|
| ((buf[i] >> 9) & 0x0007c00) | ((buf[i] >> 10) & 0x00f8000)
|
|
| ((buf[i] >> 11) & 0x1f00000);
|
|
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void cobra_poll(struct gameport *gameport)
|
|
{
|
|
struct cobra *cobra = gameport_get_drvdata(gameport);
|
|
struct input_dev *dev;
|
|
unsigned int data[2];
|
|
int i, j, r;
|
|
|
|
cobra->reads++;
|
|
|
|
if ((r = cobra_read_packet(gameport, data)) != cobra->exists) {
|
|
cobra->bads++;
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < 2; i++)
|
|
if (cobra->exists & r & (1 << i)) {
|
|
|
|
dev = cobra->dev[i];
|
|
|
|
input_report_abs(dev, ABS_X, ((data[i] >> 4) & 1) - ((data[i] >> 3) & 1));
|
|
input_report_abs(dev, ABS_Y, ((data[i] >> 2) & 1) - ((data[i] >> 1) & 1));
|
|
|
|
for (j = 0; cobra_btn[j]; j++)
|
|
input_report_key(dev, cobra_btn[j], data[i] & (0x20 << j));
|
|
|
|
input_sync(dev);
|
|
|
|
}
|
|
}
|
|
|
|
static int cobra_open(struct input_dev *dev)
|
|
{
|
|
struct cobra *cobra = dev->private;
|
|
|
|
gameport_start_polling(cobra->gameport);
|
|
return 0;
|
|
}
|
|
|
|
static void cobra_close(struct input_dev *dev)
|
|
{
|
|
struct cobra *cobra = dev->private;
|
|
|
|
gameport_stop_polling(cobra->gameport);
|
|
}
|
|
|
|
static int cobra_connect(struct gameport *gameport, struct gameport_driver *drv)
|
|
{
|
|
struct cobra *cobra;
|
|
struct input_dev *input_dev;
|
|
unsigned int data[2];
|
|
int i, j;
|
|
int err;
|
|
|
|
cobra = kzalloc(sizeof(struct cobra), GFP_KERNEL);
|
|
if (!cobra)
|
|
return -ENOMEM;
|
|
|
|
cobra->gameport = gameport;
|
|
|
|
gameport_set_drvdata(gameport, cobra);
|
|
|
|
err = gameport_open(gameport, drv, GAMEPORT_MODE_RAW);
|
|
if (err)
|
|
goto fail1;
|
|
|
|
cobra->exists = cobra_read_packet(gameport, data);
|
|
|
|
for (i = 0; i < 2; i++)
|
|
if ((cobra->exists >> i) & data[i] & 1) {
|
|
printk(KERN_WARNING "cobra.c: Device %d on %s has the Ext bit set. ID is: %d"
|
|
" Contact vojtech@ucw.cz\n", i, gameport->phys, (data[i] >> 2) & 7);
|
|
cobra->exists &= ~(1 << i);
|
|
}
|
|
|
|
if (!cobra->exists) {
|
|
err = -ENODEV;
|
|
goto fail2;
|
|
}
|
|
|
|
gameport_set_poll_handler(gameport, cobra_poll);
|
|
gameport_set_poll_interval(gameport, 20);
|
|
|
|
for (i = 0; i < 2; i++) {
|
|
if (~(cobra->exists >> i) & 1)
|
|
continue;
|
|
|
|
cobra->dev[i] = input_dev = input_allocate_device();
|
|
if (!input_dev) {
|
|
err = -ENOMEM;
|
|
goto fail3;
|
|
}
|
|
|
|
sprintf(cobra->phys[i], "%s/input%d", gameport->phys, i);
|
|
|
|
input_dev->name = "Creative Labs Blaster GamePad Cobra";
|
|
input_dev->phys = cobra->phys[i];
|
|
input_dev->id.bustype = BUS_GAMEPORT;
|
|
input_dev->id.vendor = GAMEPORT_ID_VENDOR_CREATIVE;
|
|
input_dev->id.product = 0x0008;
|
|
input_dev->id.version = 0x0100;
|
|
input_dev->cdev.dev = &gameport->dev;
|
|
input_dev->private = cobra;
|
|
|
|
input_dev->open = cobra_open;
|
|
input_dev->close = cobra_close;
|
|
|
|
input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS);
|
|
input_set_abs_params(input_dev, ABS_X, -1, 1, 0, 0);
|
|
input_set_abs_params(input_dev, ABS_Y, -1, 1, 0, 0);
|
|
for (j = 0; cobra_btn[j]; j++)
|
|
set_bit(cobra_btn[j], input_dev->keybit);
|
|
|
|
input_register_device(cobra->dev[i]);
|
|
}
|
|
|
|
return 0;
|
|
|
|
fail3: for (i = 0; i < 2; i++)
|
|
if (cobra->dev[i])
|
|
input_unregister_device(cobra->dev[i]);
|
|
fail2: gameport_close(gameport);
|
|
fail1: gameport_set_drvdata(gameport, NULL);
|
|
kfree(cobra);
|
|
return err;
|
|
}
|
|
|
|
static void cobra_disconnect(struct gameport *gameport)
|
|
{
|
|
struct cobra *cobra = gameport_get_drvdata(gameport);
|
|
int i;
|
|
|
|
for (i = 0; i < 2; i++)
|
|
if ((cobra->exists >> i) & 1)
|
|
input_unregister_device(cobra->dev[i]);
|
|
gameport_close(gameport);
|
|
gameport_set_drvdata(gameport, NULL);
|
|
kfree(cobra);
|
|
}
|
|
|
|
static struct gameport_driver cobra_drv = {
|
|
.driver = {
|
|
.name = "cobra",
|
|
},
|
|
.description = DRIVER_DESC,
|
|
.connect = cobra_connect,
|
|
.disconnect = cobra_disconnect,
|
|
};
|
|
|
|
static int __init cobra_init(void)
|
|
{
|
|
gameport_register_driver(&cobra_drv);
|
|
return 0;
|
|
}
|
|
|
|
static void __exit cobra_exit(void)
|
|
{
|
|
gameport_unregister_driver(&cobra_drv);
|
|
}
|
|
|
|
module_init(cobra_init);
|
|
module_exit(cobra_exit);
|