[net-next-2.6.git] / drivers / input / joystick / spaceball.c

/*
 * $Id: spaceball.c,v 1.17 2002/01/22 20:29:03 vojtech Exp $
 *
 *  Copyright (c) 1999-2001 Vojtech Pavlik
 *
 *  Based on the work of:
 *	David Thompson
 *	Joseph Krahn
 */

/*
 * SpaceTec SpaceBall 2003/3003/4000 FLX 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/slab.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/input.h>
#include <linux/serio.h>

#define DRIVER_DESC	"SpaceTec SpaceBall 2003/3003/4000 FLX driver"

MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");

/*
 * Constants.
 */

#define SPACEBALL_MAX_LENGTH	128
#define SPACEBALL_MAX_ID	9

#define SPACEBALL_1003      1
#define SPACEBALL_2003B     3
#define SPACEBALL_2003C     4
#define SPACEBALL_3003C     7
#define SPACEBALL_4000FLX   8
#define SPACEBALL_4000FLX_L 9

static int spaceball_axes[] = { ABS_X, ABS_Z, ABS_Y, ABS_RX, ABS_RZ, ABS_RY };
static char *spaceball_names[] = {
	"?", "SpaceTec SpaceBall 1003", "SpaceTec SpaceBall 2003", "SpaceTec SpaceBall 2003B",
	"SpaceTec SpaceBall 2003C", "SpaceTec SpaceBall 3003", "SpaceTec SpaceBall SpaceController",
	"SpaceTec SpaceBall 3003C", "SpaceTec SpaceBall 4000FLX", "SpaceTec SpaceBall 4000FLX Lefty" };

/*
 * Per-Ball data.
 */

struct spaceball {
	struct input_dev *dev;
	int idx;
	int escape;
	unsigned char data[SPACEBALL_MAX_LENGTH];
	char phys[32];
};

/*
 * spaceball_process_packet() decodes packets the driver receives from the
 * SpaceBall.
 */

static void spaceball_process_packet(struct spaceball* spaceball)
{
	struct input_dev *dev = spaceball->dev;
	unsigned char *data = spaceball->data;
	int i;

	if (spaceball->idx < 2) return;

	switch (spaceball->data[0]) {

		case 'D':					/* Ball data */
			if (spaceball->idx != 15) return;
			for (i = 0; i < 6; i++)
				input_report_abs(dev, spaceball_axes[i],
					(__s16)((data[2 * i + 3] << 8) | data[2 * i + 2]));
			break;

		case 'K':					/* Button data */
			if (spaceball->idx != 3) return;
			input_report_key(dev, BTN_1, (data[2] & 0x01) || (data[2] & 0x20));
			input_report_key(dev, BTN_2, data[2] & 0x02);
			input_report_key(dev, BTN_3, data[2] & 0x04);
			input_report_key(dev, BTN_4, data[2] & 0x08);
			input_report_key(dev, BTN_5, data[1] & 0x01);
			input_report_key(dev, BTN_6, data[1] & 0x02);
			input_report_key(dev, BTN_7, data[1] & 0x04);
			input_report_key(dev, BTN_8, data[1] & 0x10);
			break;

		case '.':					/* Advanced button data */
			if (spaceball->idx != 3) return;
			input_report_key(dev, BTN_1, data[2] & 0x01);
			input_report_key(dev, BTN_2, data[2] & 0x02);
			input_report_key(dev, BTN_3, data[2] & 0x04);
			input_report_key(dev, BTN_4, data[2] & 0x08);
			input_report_key(dev, BTN_5, data[2] & 0x10);
			input_report_key(dev, BTN_6, data[2] & 0x20);
			input_report_key(dev, BTN_7, data[2] & 0x80);
			input_report_key(dev, BTN_8, data[1] & 0x01);
			input_report_key(dev, BTN_9, data[1] & 0x02);
			input_report_key(dev, BTN_A, data[1] & 0x04);
			input_report_key(dev, BTN_B, data[1] & 0x08);
			input_report_key(dev, BTN_C, data[1] & 0x10);
			input_report_key(dev, BTN_MODE, data[1] & 0x20);
			break;

		case 'E':					/* Device error */
			spaceball->data[spaceball->idx - 1] = 0;
			printk(KERN_ERR "spaceball: Device error. [%s]\n", spaceball->data + 1);
			break;

		case '?':					/* Bad command packet */
			spaceball->data[spaceball->idx - 1] = 0;
			printk(KERN_ERR "spaceball: Bad command. [%s]\n", spaceball->data + 1);
			break;
	}

	input_sync(dev);
}

/*
 * Spaceball 4000 FLX packets all start with a one letter packet-type decriptor,
 * and end in 0x0d. It uses '^' as an escape for CR, XOFF and XON characters which
 * can occur in the axis values.
 */

static irqreturn_t spaceball_interrupt(struct serio *serio,
		unsigned char data, unsigned int flags)
{
	struct spaceball *spaceball = serio_get_drvdata(serio);

	switch (data) {
		case 0xd:
			spaceball_process_packet(spaceball);
			spaceball->idx = 0;
			spaceball->escape = 0;
			break;
		case '^':
			if (!spaceball->escape) {
				spaceball->escape = 1;
				break;
			}
			spaceball->escape = 0;
		case 'M':
		case 'Q':
		case 'S':
			if (spaceball->escape) {
				spaceball->escape = 0;
				data &= 0x1f;
			}
		default:
			if (spaceball->escape)
				spaceball->escape = 0;
			if (spaceball->idx < SPACEBALL_MAX_LENGTH)
				spaceball->data[spaceball->idx++] = data;
			break;
	}
	return IRQ_HANDLED;
}

/*
 * spaceball_disconnect() is the opposite of spaceball_connect()
 */

static void spaceball_disconnect(struct serio *serio)
{
	struct spaceball* spaceball = serio_get_drvdata(serio);

	serio_close(serio);
	serio_set_drvdata(serio, NULL);
	input_unregister_device(spaceball->dev);
	kfree(spaceball);
}

/*
 * spaceball_connect() is the routine that is called when someone adds a
 * new serio device that supports Spaceball protocol and registers it as
 * an input device.
 */

static int spaceball_connect(struct serio *serio, struct serio_driver *drv)
{
	struct spaceball *spaceball;
	struct input_dev *input_dev;
	int err = -ENOMEM;
	int i, id;

	if ((id = serio->id.id) > SPACEBALL_MAX_ID)
		return -ENODEV;

	spaceball = kmalloc(sizeof(struct spaceball), GFP_KERNEL);
	input_dev = input_allocate_device();
	if (!spaceball || !input_dev)
		goto fail;

	spaceball->dev = input_dev;
	snprintf(spaceball->phys, sizeof(spaceball->phys), "%s/input0", serio->phys);

	input_dev->name = spaceball_names[id];
	input_dev->phys = spaceball->phys;
	input_dev->id.bustype = BUS_RS232;
	input_dev->id.vendor = SERIO_SPACEBALL;
	input_dev->id.product = id;
	input_dev->id.version = 0x0100;
	input_dev->cdev.dev = &serio->dev;
	input_dev->private = spaceball;

	input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS);

	switch (id) {
		case SPACEBALL_4000FLX:
		case SPACEBALL_4000FLX_L:
			input_dev->keybit[LONG(BTN_0)] |= BIT(BTN_9);
			input_dev->keybit[LONG(BTN_A)] |= BIT(BTN_A) | BIT(BTN_B) | BIT(BTN_C) | BIT(BTN_MODE);
		default:
			input_dev->keybit[LONG(BTN_0)] |= BIT(BTN_2) | BIT(BTN_3) | BIT(BTN_4)
				| BIT(BTN_5) | BIT(BTN_6) | BIT(BTN_7) | BIT(BTN_8);
		case SPACEBALL_3003C:
			input_dev->keybit[LONG(BTN_0)] |= BIT(BTN_1) | BIT(BTN_8);
	}

	for (i = 0; i < 3; i++) {
		input_set_abs_params(input_dev, ABS_X + i, -8000, 8000, 8, 40);
		input_set_abs_params(input_dev, ABS_RX + i, -1600, 1600, 2, 8);
	}

	serio_set_drvdata(serio, spaceball);

	err = serio_open(serio, drv);
	if (err)
		goto fail;

	input_register_device(spaceball->dev);
	return 0;

 fail:	serio_set_drvdata(serio, NULL);
	input_free_device(input_dev);
	kfree(spaceball);
	return err;
}

/*
 * The serio driver structure.
 */

static struct serio_device_id spaceball_serio_ids[] = {
	{
		.type	= SERIO_RS232,
		.proto	= SERIO_SPACEBALL,
		.id	= SERIO_ANY,
		.extra	= SERIO_ANY,
	},
	{ 0 }
};

MODULE_DEVICE_TABLE(serio, spaceball_serio_ids);

static struct serio_driver spaceball_drv = {
	.driver		= {
		.name	= "spaceball",
	},
	.description	= DRIVER_DESC,
	.id_table	= spaceball_serio_ids,
	.interrupt	= spaceball_interrupt,
	.connect	= spaceball_connect,
	.disconnect	= spaceball_disconnect,
};

/*
 * The functions for inserting/removing us as a module.
 */

static int __init spaceball_init(void)
{
	serio_register_driver(&spaceball_drv);
	return 0;
}

static void __exit spaceball_exit(void)
{
	serio_unregister_driver(&spaceball_drv);
}

module_init(spaceball_init);
module_exit(spaceball_exit);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* $Id: spaceball.c,v 1.17 2002/01/22 20:29:03 vojtech Exp $
	3	*
	4	* Copyright (c) 1999-2001 Vojtech Pavlik
	5	*
	6	* Based on the work of:
ab0c3443 DT	7	* David Thompson
ab0c3443 DT	8	* Joseph Krahn
1da177e4 LT	9	*/
	10
	11	/*
	12	* SpaceTec SpaceBall 2003/3003/4000 FLX driver for Linux
	13	*/
	14
	15	/*
	16	* This program is free software; you can redistribute it and/or modify
	17	* it under the terms of the GNU General Public License as published by
	18	* the Free Software Foundation; either version 2 of the License, or
	19	* (at your option) any later version.
	20	*
	21	* This program is distributed in the hope that it will be useful,
	22	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	23	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	24	* GNU General Public License for more details.
	25	*
	26	* You should have received a copy of the GNU General Public License
	27	* along with this program; if not, write to the Free Software
	28	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	29	*
	30	* Should you need to contact me, the author, you can do so either by
	31	* e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
	32	* Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
	33	*/
	34
	35	#include <linux/kernel.h>
	36	#include <linux/slab.h>
	37	#include <linux/module.h>
	38	#include <linux/init.h>
	39	#include <linux/input.h>
	40	#include <linux/serio.h>
	41
	42	#define DRIVER_DESC "SpaceTec SpaceBall 2003/3003/4000 FLX driver"
	43
	44	MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
	45	MODULE_DESCRIPTION(DRIVER_DESC);
	46	MODULE_LICENSE("GPL");
	47
	48	/*
	49	* Constants.
	50	*/
	51
	52	#define SPACEBALL_MAX_LENGTH 128
2c1dd69d	53	#define SPACEBALL_MAX_ID 9
1da177e4 LT	54
	55	#define SPACEBALL_1003 1
	56	#define SPACEBALL_2003B 3
	57	#define SPACEBALL_2003C 4
	58	#define SPACEBALL_3003C 7
	59	#define SPACEBALL_4000FLX 8
	60	#define SPACEBALL_4000FLX_L 9
	61
	62	static int spaceball_axes[] = { ABS_X, ABS_Z, ABS_Y, ABS_RX, ABS_RZ, ABS_RY };
	63	static char *spaceball_names[] = {
	64	"?", "SpaceTec SpaceBall 1003", "SpaceTec SpaceBall 2003", "SpaceTec SpaceBall 2003B",
	65	"SpaceTec SpaceBall 2003C", "SpaceTec SpaceBall 3003", "SpaceTec SpaceBall SpaceController",
	66	"SpaceTec SpaceBall 3003C", "SpaceTec SpaceBall 4000FLX", "SpaceTec SpaceBall 4000FLX Lefty" };
	67
	68	/*
	69	* Per-Ball data.
	70	*/
	71
	72	struct spaceball {
17dd3f0f	73	struct input_dev *dev;
1da177e4 LT	74	int idx;
	75	int escape;
	76	unsigned char data[SPACEBALL_MAX_LENGTH];
	77	char phys[32];
	78	};
	79
	80	/*
	81	* spaceball_process_packet() decodes packets the driver receives from the
	82	* SpaceBall.
	83	*/
	84
7d12e780	85	static void spaceball_process_packet(struct spaceball* spaceball)
1da177e4	86	{
17dd3f0f	87	struct input_dev *dev = spaceball->dev;
1da177e4 LT	88	unsigned char *data = spaceball->data;
	89	int i;
	90
	91	if (spaceball->idx < 2) return;
	92
1da177e4 LT	93	switch (spaceball->data[0]) {
	94
	95	case 'D': /* Ball data */
	96	if (spaceball->idx != 15) return;
	97	for (i = 0; i < 6; i++)
	98	input_report_abs(dev, spaceball_axes[i],
	99	(__s16)((data[2 * i + 3] << 8) \| data[2 * i + 2]));
	100	break;
	101
	102	case 'K': /* Button data */
	103	if (spaceball->idx != 3) return;
	104	input_report_key(dev, BTN_1, (data[2] & 0x01) \|\| (data[2] & 0x20));
	105	input_report_key(dev, BTN_2, data[2] & 0x02);
	106	input_report_key(dev, BTN_3, data[2] & 0x04);
	107	input_report_key(dev, BTN_4, data[2] & 0x08);
	108	input_report_key(dev, BTN_5, data[1] & 0x01);
	109	input_report_key(dev, BTN_6, data[1] & 0x02);
	110	input_report_key(dev, BTN_7, data[1] & 0x04);
	111	input_report_key(dev, BTN_8, data[1] & 0x10);
	112	break;
	113
	114	case '.': /* Advanced button data */
	115	if (spaceball->idx != 3) return;
	116	input_report_key(dev, BTN_1, data[2] & 0x01);
	117	input_report_key(dev, BTN_2, data[2] & 0x02);
	118	input_report_key(dev, BTN_3, data[2] & 0x04);
	119	input_report_key(dev, BTN_4, data[2] & 0x08);
	120	input_report_key(dev, BTN_5, data[2] & 0x10);
	121	input_report_key(dev, BTN_6, data[2] & 0x20);
	122	input_report_key(dev, BTN_7, data[2] & 0x80);
	123	input_report_key(dev, BTN_8, data[1] & 0x01);
	124	input_report_key(dev, BTN_9, data[1] & 0x02);
	125	input_report_key(dev, BTN_A, data[1] & 0x04);
	126	input_report_key(dev, BTN_B, data[1] & 0x08);
	127	input_report_key(dev, BTN_C, data[1] & 0x10);
	128	input_report_key(dev, BTN_MODE, data[1] & 0x20);
	129	break;
	130
	131	case 'E': /* Device error */
	132	spaceball->data[spaceball->idx - 1] = 0;
	133	printk(KERN_ERR "spaceball: Device error. [%s]\n", spaceball->data + 1);
	134	break;
	135
	136	case '?': /* Bad command packet */
	137	spaceball->data[spaceball->idx - 1] = 0;
	138	printk(KERN_ERR "spaceball: Bad command. [%s]\n", spaceball->data + 1);
	139	break;
	140	}
	141
	142	input_sync(dev);
	143	}
	144
	145	/*
	146	* Spaceball 4000 FLX packets all start with a one letter packet-type decriptor,
	147	* and end in 0x0d. It uses '^' as an escape for CR, XOFF and XON characters which
	148	* can occur in the axis values.
	149	*/
	150
	151	static irqreturn_t spaceball_interrupt(struct serio *serio,
7d12e780	152	unsigned char data, unsigned int flags)
1da177e4 LT	153	{
	154	struct spaceball *spaceball = serio_get_drvdata(serio);
	155
	156	switch (data) {
	157	case 0xd:
7d12e780	158	spaceball_process_packet(spaceball);
1da177e4 LT	159	spaceball->idx = 0;
	160	spaceball->escape = 0;
	161	break;
	162	case '^':
	163	if (!spaceball->escape) {
	164	spaceball->escape = 1;
	165	break;
	166	}
	167	spaceball->escape = 0;
	168	case 'M':
	169	case 'Q':
	170	case 'S':
	171	if (spaceball->escape) {
	172	spaceball->escape = 0;
	173	data &= 0x1f;
	174	}
	175	default:
	176	if (spaceball->escape)
	177	spaceball->escape = 0;
	178	if (spaceball->idx < SPACEBALL_MAX_LENGTH)
	179	spaceball->data[spaceball->idx++] = data;
	180	break;
	181	}
	182	return IRQ_HANDLED;
	183	}
	184
	185	/*
	186	* spaceball_disconnect() is the opposite of spaceball_connect()
	187	*/
	188
	189	static void spaceball_disconnect(struct serio *serio)
	190	{
	191	struct spaceball* spaceball = serio_get_drvdata(serio);
	192
1da177e4 LT	193	serio_close(serio);
1da177e4 LT	194	serio_set_drvdata(serio, NULL);
17dd3f0f	195	input_unregister_device(spaceball->dev);
1da177e4 LT	196	kfree(spaceball);
	197	}
	198
	199	/*
	200	* spaceball_connect() is the routine that is called when someone adds a
	201	* new serio device that supports Spaceball protocol and registers it as
	202	* an input device.
	203	*/
	204
	205	static int spaceball_connect(struct serio serio, struct serio_driver drv)
	206	{
	207	struct spaceball *spaceball;
17dd3f0f DT	208	struct input_dev *input_dev;
	209	int err = -ENOMEM;
	210	int i, id;
1da177e4 LT	211
	212	if ((id = serio->id.id) > SPACEBALL_MAX_ID)
	213	return -ENODEV;
	214
17dd3f0f DT	215	spaceball = kmalloc(sizeof(struct spaceball), GFP_KERNEL);
	216	input_dev = input_allocate_device();
	217	if (!spaceball \|\| !input_dev)
	218	goto fail;
1da177e4	219
17dd3f0f	220	spaceball->dev = input_dev;
10ca4c0a	221	snprintf(spaceball->phys, sizeof(spaceball->phys), "%s/input0", serio->phys);
17dd3f0f DT	222
	223	input_dev->name = spaceball_names[id];
	224	input_dev->phys = spaceball->phys;
	225	input_dev->id.bustype = BUS_RS232;
	226	input_dev->id.vendor = SERIO_SPACEBALL;
	227	input_dev->id.product = id;
	228	input_dev->id.version = 0x0100;
	229	input_dev->cdev.dev = &serio->dev;
	230	input_dev->private = spaceball;
1da177e4	231
17dd3f0f	232	input_dev->evbit[0] = BIT(EV_KEY) \| BIT(EV_ABS);
1da177e4 LT	233
	234	switch (id) {
	235	case SPACEBALL_4000FLX:
	236	case SPACEBALL_4000FLX_L:
17dd3f0f DT	237	input_dev->keybit[LONG(BTN_0)] \|= BIT(BTN_9);
17dd3f0f DT	238	input_dev->keybit[LONG(BTN_A)] \|= BIT(BTN_A) \| BIT(BTN_B) \| BIT(BTN_C) \| BIT(BTN_MODE);
1da177e4	239	default:
17dd3f0f	240	input_dev->keybit[LONG(BTN_0)] \|= BIT(BTN_2) \| BIT(BTN_3) \| BIT(BTN_4)
1da177e4 LT	241	\| BIT(BTN_5) \| BIT(BTN_6) \| BIT(BTN_7) \| BIT(BTN_8);
1da177e4 LT	242	case SPACEBALL_3003C:
17dd3f0f	243	input_dev->keybit[LONG(BTN_0)] \|= BIT(BTN_1) \| BIT(BTN_8);
1da177e4 LT	244	}
1da177e4 LT	245
17dd3f0f DT	246	for (i = 0; i < 3; i++) {
	247	input_set_abs_params(input_dev, ABS_X + i, -8000, 8000, 8, 40);
	248	input_set_abs_params(input_dev, ABS_RX + i, -1600, 1600, 2, 8);
1da177e4 LT	249	}
1da177e4 LT	250
1da177e4 LT	251	serio_set_drvdata(serio, spaceball);
	252
	253	err = serio_open(serio, drv);
17dd3f0f DT	254	if (err)
17dd3f0f DT	255	goto fail;
1da177e4	256
17dd3f0f	257	input_register_device(spaceball->dev);
1da177e4	258	return 0;
17dd3f0f DT	259
	260	fail: serio_set_drvdata(serio, NULL);
	261	input_free_device(input_dev);
	262	kfree(spaceball);
	263	return err;
1da177e4 LT	264	}
	265
	266	/*
	267	* The serio driver structure.
	268	*/
	269
	270	static struct serio_device_id spaceball_serio_ids[] = {
	271	{
	272	.type = SERIO_RS232,
	273	.proto = SERIO_SPACEBALL,
	274	.id = SERIO_ANY,
	275	.extra = SERIO_ANY,
	276	},
	277	{ 0 }
	278	};
	279
	280	MODULE_DEVICE_TABLE(serio, spaceball_serio_ids);
	281
	282	static struct serio_driver spaceball_drv = {
	283	.driver = {
	284	.name = "spaceball",
	285	},
	286	.description = DRIVER_DESC,
	287	.id_table = spaceball_serio_ids,
	288	.interrupt = spaceball_interrupt,
	289	.connect = spaceball_connect,
	290	.disconnect = spaceball_disconnect,
	291	};
	292
	293	/*
	294	* The functions for inserting/removing us as a module.
	295	*/
	296
	297	static int __init spaceball_init(void)
	298	{
	299	serio_register_driver(&spaceball_drv);
	300	return 0;
	301	}
	302
	303	static void __exit spaceball_exit(void)
	304	{
	305	serio_unregister_driver(&spaceball_drv);
	306	}
	307
	308	module_init(spaceball_init);
	309	module_exit(spaceball_exit);