patch-2.1.125 linux/drivers/char/joystick/joy-db9.c

• Lines: 454
• Date: Thu Oct 8 17:25:16 1998
• Orig file: v2.1.124/linux/drivers/char/joystick/joy-db9.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.1.124/linux/drivers/char/joystick/joy-db9.c linux/drivers/char/joystick/joy-db9.c
@@ -0,0 +1,453 @@
+/*
+ * joy-db9.c  Version 0.3V
+ *
+ * Copyright (c) 1998 Andree Borrmann
+ */
+
+/*
+ * This is a module for the Linux joystick driver, supporting
+ * console (Atari, Amstrad, Commodore, Amiga, Sega) joysticks
+ * and gamepads connected to the parallel port.
+ */
+
+/*
+ * 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
+ */
+
+#include <asm/io.h>
+#include <asm/system.h>
+#include <linux/errno.h>
+#include <linux/ioport.h>
+#include <linux/joystick.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/string.h>
+#include <linux/delay.h>
+
+MODULE_AUTHOR("Andree Borrmann <A.Borrmann@tu-bs.de>");
+MODULE_PARM(js_db9, "2i");
+MODULE_PARM(js_db9_2, "0-2i");
+MODULE_PARM(js_db9_3, "0-2i");
+
+#define JS_MULTI_STICK	0x01
+#define JS_MULTI2_STICK 0x02
+#define JS_GENESIS_PAD  0x03
+#define JS_GENESIS5_PAD 0x05
+#define JS_GENESIS6_PAD	0x06
+#define JS_SATURN_PAD	0x07
+
+#define JS_MAX_PAD	(JS_SATURN_PAD + 1)
+
+#define JS_DB9_UP	0x01
+#define JS_DB9_DOWN	0x02
+#define JS_DB9_LEFT	0x04
+#define JS_DB9_RIGHT	0x08
+#define JS_DB9_FIRE1	0x10
+#define JS_DB9_FIRE2	0x20
+#define JS_DB9_FIRE3	0x40
+#define JS_DB9_FIRE4	0x80
+
+#define JS_DB9_NORMAL	0x22
+#define JS_DB9_NOSELECT	0x20
+
+#define JS_DB9_SATURN0	0x20
+#define JS_DB9_SATURN1	0x22
+#define JS_DB9_SATURN2	0x24
+#define JS_DB9_SATURN3	0x26
+
+#define JS_GENESIS6_DELAY	14
+
+static struct js_port* js_db9_port = NULL;
+
+static int js_db9[] __initdata = { -1, 0 };
+static int js_db9_2[] __initdata = { -1, 0 };
+static int js_db9_3[] __initdata = { -1, 0 };
+
+struct js_db9_info {
+#ifdef USE_PARPORT
+	struct pardevice *port;	/* parport device */
+	int wanted;		/* parport wanted */
+#else
+	int port;		/* hw port */
+#endif
+	int use;		/* use count */
+	int mode;		/* pad mode */
+};
+
+/*
+ * js_db9_read() reads and analyzes db9 joystick data.
+ */
+
+static int js_db9_read(void *xinfo, int **axes, int **buttons)
+{
+	struct js_db9_info *info = xinfo;
+	int data;
+
+	switch(info->mode)
+	{
+	  case JS_MULTI_STICK:
+
+		data = JS_PAR_DATA_IN(info->port);
+
+		axes[0][1] = (data&JS_DB9_DOWN ?0:1) - (data&JS_DB9_UP  ?0:1);
+		axes[0][0] = (data&JS_DB9_RIGHT?0:1) - (data&JS_DB9_LEFT?0:1);
+
+		buttons[0][0] = (data&JS_DB9_FIRE1?0:1);
+
+		break;
+
+	  case JS_MULTI2_STICK:
+
+		data=JS_PAR_DATA_IN(info->port);
+
+		axes[0][1] = (data&JS_DB9_DOWN ?0:1) - (data&JS_DB9_UP  ?0:1);
+		axes[0][0] = (data&JS_DB9_RIGHT?0:1) - (data&JS_DB9_LEFT?0:1);
+
+		buttons[0][0] = (data&JS_DB9_FIRE1?0:1) | (data&JS_DB9_FIRE2?0:2);
+
+		break;
+
+	  case JS_GENESIS_PAD:
+
+		JS_PAR_CTRL_OUT(JS_DB9_NOSELECT, info->port);
+		data = JS_PAR_DATA_IN(info->port);
+
+		axes[0][1] = (data&JS_DB9_DOWN ?0:1) - (data&JS_DB9_UP  ?0:1);
+		axes[0][0] = (data&JS_DB9_RIGHT?0:1) - (data&JS_DB9_LEFT?0:1);
+
+		buttons[0][0] = (data&JS_DB9_FIRE1?0:2) | (data&JS_DB9_FIRE2?0:4);
+
+		JS_PAR_CTRL_OUT(JS_DB9_NORMAL,info->port);
+		data=JS_PAR_DATA_IN(info->port);
+
+		buttons[0][0] |= (data&JS_DB9_FIRE1?0:1) | (data&JS_DB9_FIRE2?0:8);
+
+		break;
+
+	  case JS_GENESIS5_PAD:
+
+		JS_PAR_CTRL_OUT(JS_DB9_NOSELECT,info->port);
+		data=JS_PAR_DATA_IN(info->port);
+
+		axes[0][1] = (data&JS_DB9_DOWN ?0:1) - (data&JS_DB9_UP  ?0:1);
+		axes[0][0] = (data&JS_DB9_RIGHT?0:1) - (data&JS_DB9_LEFT?0:1);
+
+		buttons[0][0] = (data&JS_DB9_FIRE1?0:0x02) | (data&JS_DB9_FIRE2?0:0x04);
+
+		JS_PAR_CTRL_OUT(JS_DB9_NORMAL, info->port);
+		data=JS_PAR_DATA_IN(info->port);
+
+		buttons[0][0] |= (data&JS_DB9_FIRE1?0:0x01) | (data&JS_DB9_FIRE2?0:0x08) |
+				 (data&JS_DB9_LEFT ?0:0x10) | (data&JS_DB9_RIGHT?0:0x20);
+		break;
+
+	  case JS_GENESIS6_PAD:
+
+		JS_PAR_CTRL_OUT(JS_DB9_NOSELECT,info->port); /* 1 */
+		udelay(JS_GENESIS6_DELAY);
+		data=JS_PAR_DATA_IN(info->port);
+
+		axes[0][1] = (data&JS_DB9_DOWN ?0:1) - (data&JS_DB9_UP  ?0:1);
+		axes[0][0] = (data&JS_DB9_RIGHT?0:1) - (data&JS_DB9_LEFT?0:1);
+
+		buttons[0][0] = (data&JS_DB9_FIRE1?0:0x02) | (data&JS_DB9_FIRE2?0:0x04);
+
+		JS_PAR_CTRL_OUT(JS_DB9_NORMAL, info->port);
+		udelay(JS_GENESIS6_DELAY);
+		data=JS_PAR_DATA_IN(info->port);
+
+		buttons[0][0] |= (data&JS_DB9_FIRE1?0:0x01) | (data&JS_DB9_FIRE2?0:0x08);
+
+		JS_PAR_CTRL_OUT(JS_DB9_NOSELECT, info->port); /* 2 */
+		udelay(JS_GENESIS6_DELAY);
+		JS_PAR_CTRL_OUT(JS_DB9_NORMAL, info->port);
+		udelay(JS_GENESIS6_DELAY);
+		JS_PAR_CTRL_OUT(JS_DB9_NOSELECT, info->port); /* 3 */
+		udelay(JS_GENESIS6_DELAY);
+		JS_PAR_CTRL_OUT(JS_DB9_NORMAL, info->port);
+		data=JS_PAR_DATA_IN(info->port);
+
+		buttons[0][0] |= (data&JS_DB9_LEFT?0:0x10) | (data&JS_DB9_DOWN?0:0x20) | (data&JS_DB9_UP?0:0x40);
+
+		udelay(JS_GENESIS6_DELAY);
+		JS_PAR_CTRL_OUT(JS_DB9_NOSELECT, info->port); /* 4 */
+		udelay(JS_GENESIS6_DELAY);
+		JS_PAR_CTRL_OUT(JS_DB9_NORMAL, info->port);
+
+		break;
+
+	  case JS_SATURN_PAD:
+
+		JS_PAR_CTRL_OUT(JS_DB9_SATURN0, info->port);
+		data = JS_PAR_DATA_IN(info->port);
+
+		buttons[0][0] = (data&JS_DB9_UP  ?0:0x20) | (data&JS_DB9_DOWN ?0:0x10) |
+				(data&JS_DB9_LEFT?0:0x08) | (data&JS_DB9_RIGHT?0:0x40);
+
+		JS_PAR_CTRL_OUT(JS_DB9_SATURN2, info->port);
+		data = JS_PAR_DATA_IN(info->port);
+
+		axes[0][1] = (data&JS_DB9_DOWN ?0:1) - (data&JS_DB9_UP  ?0:1);
+		axes[0][0] = (data&JS_DB9_RIGHT?0:1) - (data&JS_DB9_LEFT?0:1);
+
+		JS_PAR_CTRL_OUT(JS_DB9_NORMAL, info->port);
+		data = JS_PAR_DATA_IN(info->port);
+
+		buttons[0][0] |= (data&JS_DB9_UP  ?0:0x02) | (data&JS_DB9_DOWN ?0:0x04) |
+				 (data&JS_DB9_LEFT?0:0x01) | (data&JS_DB9_RIGHT?0:0x80);
+
+
+		break;
+
+	  default:
+		return -1;
+	}
+
+	return 0;
+}
+
+/*
+ * js_db9_enable_ps2() enables PS/2 capabilities on a parallel port and
+ * switches data lines to input mode. We should use parport_change_mode() for
+ * that if parport present - unfortunately that does nothing and only contains
+ * a FIXME comment.
+ */
+
+static inline void js_db9_enable_ps2(struct js_db9_info *info)
+{
+#ifdef USE_PARPORT
+	int io = info->port->port->base;
+#else
+	int io = info->port;
+#endif
+
+	outb(0x35,io+0x402);		/* enable PS/2 mode: */
+	outb(JS_DB9_NORMAL,io+2);	/* reverse direction, enable Select signal: */
+}
+
+/*
+ * js_db9_disable_ps2() disables PS/2 capabilities on a parallel port
+ * and restores it to standard mode.
+ */
+
+static inline void js_db9_disable_ps2(struct js_db9_info *info)
+{
+#ifdef USE_PARPORT
+	int io = info->port->port->base;
+#else
+	int io = info->port;
+#endif
+
+	outb(0,io+2);		/* normal direction */
+	outb(0x15,io+0x402);	/* enable normal mode */
+}
+
+/*
+ * open callback: claim parport.
+ */
+
+int js_db9_open(struct js_dev *dev)
+{
+	struct js_db9_info *info = dev->port->info;
+
+	MOD_INC_USE_COUNT;
+	if (!info->use) {
+
+#ifdef USE_PARPORT
+		if (parport_claim(info->port)) {
+			printk(KERN_WARNING "joy-db9: parport busy\n");		/* port currently not available ... */
+			info->wanted++;						/* we'll claim it on wakeup */
+			return 0;
+		}
+#endif
+		js_db9_enable_ps2(info);
+	}
+	info->use++;
+	return 0;
+}
+
+/*
+ * close callback: release parport
+ */
+
+int js_db9_close(struct js_dev *dev)
+{
+	struct js_db9_info *info = dev->port->info;
+
+	MOD_DEC_USE_COUNT;
+	info->use--;
+
+	if (!info->use) {
+		js_db9_disable_ps2(info);
+#ifdef USE_PARPORT
+		parport_release(info->port);
+#endif
+	}
+	return 0;
+}
+
+/*
+ * parport wakeup callback: claim the port!
+ */
+
+#ifdef USE_PARPORT
+static void js_db9_wakeup(void *v)
+{
+	struct js_db9_info *info = js_db9_port->info;	/* FIXME! We can have more than 1 port! */
+
+	if (!info->use && info->wanted)
+	{
+		parport_claim(info->port);
+		js_db9_enable_ps2(info);
+		info->use++;
+		info->wanted--;
+	}
+}
+#endif
+
+#ifdef MODULE
+void cleanup_module(void)
+{
+	struct js_db9_info *info;
+
+	while (js_db9_port) {
+		js_unregister_device(js_db9_port->devs[0]);
+		info = js_db9_port->info;
+#ifdef USE_PARPORT
+		parport_unregister_device(info->port);
+#else
+		release_region(info->port, 3);
+		release_region(info->port+0x402, 1);
+#endif
+		js_db9_port = js_unregister_port(js_db9_port);
+	}
+
+}
+#endif
+
+/*
+ * js_db9_init_corr() initializes correction values of
+ * db9 gamepads.
+ */
+
+static void __init js_db9_init_corr(struct js_corr **corr)
+{
+	int i;
+
+	for (i = 0; i < 2; i++) {
+		corr[0][i].type = JS_CORR_BROKEN;
+		corr[0][i].prec = 0;
+		corr[0][i].coef[0] = 0;
+		corr[0][i].coef[1] = 0;
+		corr[0][i].coef[2] = (1 << 29);
+		corr[0][i].coef[3] = (1 << 29);
+	}
+}
+
+/*
+ * js_db9_probe() probes for db9 gamepads.
+ */
+
+static struct js_port __init *js_db9_probe(int *config, struct js_port *port)
+{
+	struct js_db9_info info;
+	char buttons[JS_MAX_PAD] = {0,1,2,4,0,6,7,8};
+	char *name[JS_MAX_PAD] = {NULL, "Multisystem joystick", "Multisystem joystick (2 fire)", "Genesis pad",
+					NULL, "Genesis 5 pad", "Genesis 6 pad", "Saturn pad"};
+
+	if (config[0] < 0) return port;
+	if (config[1] < 0 || config[1] >= JS_MAX_PAD || !name[config[1]]) return port;
+
+#ifdef USE_PARPORT
+	{
+		struct parport *pp;
+
+		if (config[0] > 0x10)
+			for (pp=parport_enumerate(); pp && (pp->base!=config[0]); pp=pp->next);
+		else
+			for (pp=parport_enumerate(); pp && (config[0]>0); pp=pp->next) config[0]--;
+
+		if (!pp) {
+			printk(KERN_ERR "joy-db9: no such parport\n");
+			return port;
+		}
+
+		if (!(pp->modes & (PARPORT_MODE_PCPS2 | PARPORT_MODE_PCECPPS2))) {
+			printk(KERN_ERR "js-db9: specified parport is not bidirectional\n");
+			return port;
+		}
+
+		info.port = parport_register_device(pp, "joystick (db9)", NULL, js_db9_wakeup, NULL, 0, NULL);
+		info.wanted = 0;
+	}
+#else
+	info.port = config[0];
+	if (check_region(info.port, 3) || check_region(info.port+0x402,1)) return port;
+	request_region(info.port, 3, "joystick (db9)");
+	request_region(info.port+0x402, 1, "joystick (db9)");
+#endif
+
+	info.mode = config[1];
+	info.use = 0;
+
+	port = js_register_port(port, &info, 1, sizeof(struct js_db9_info), js_db9_read);
+
+#ifdef USE_PARPORT
+	printk(KERN_INFO "js%d: %s on %s\n",
+		js_register_device(port, 0, 2, buttons[info.mode], name[info.mode], js_db9_open, js_db9_close),
+		name[info.mode], info.port->port->name);
+#else
+	printk(KERN_INFO "js%d: %s at %#x\n",
+		js_register_device(port, 0, 2, buttons[info.mode], name[info.mode], js_db9_open, js_db9_close),
+		name[info.mode], info.port);
+#endif
+
+	js_db9_init_corr(port->corr);
+
+	return port;
+}
+
+#ifndef MODULE
+void __init js_db9_setup(char *str, int *ints)
+{
+	int i;
+
+	if (!strcmp(str,"js_db9"))
+		for (i = 0; i <= ints[0] && i < 2; i++) js_db9[i] = ints[i+1];
+	if (!strcmp(str,"js_db9_2"))
+		for (i = 0; i <= ints[0] && i < 2; i++) js_db9_2[i] = ints[i+1];
+	if (!strcmp(str,"js_db9_3"))
+		for (i = 0; i <= ints[0] && i < 2; i++) js_db9_3[i] = ints[i+1];
+
+}
+#endif
+
+#ifdef MODULE
+int init_module(void)
+#else
+int __init js_db9_init(void)
+#endif
+{
+	js_db9_port = js_db9_probe(js_db9, js_db9_port);
+	js_db9_port = js_db9_probe(js_db9_2, js_db9_port);
+	js_db9_port = js_db9_probe(js_db9_3, js_db9_port);
+
+	if (js_db9_port) return 0;
+
+#ifdef MODULE
+	printk(KERN_WARNING "joy-db9: no joysticks specified\n");
+#endif
+	return -ENODEV;
+}