[mirror_ubuntu-zesty-kernel.git] / drivers / input / joystick / maplecontrol.c

/*
 *	SEGA Dreamcast controller driver
 *	Based on drivers/usb/iforce.c
 *
 *	Copyright Yaegashi Takeshi, 2001
 *	Adrian McMenamin, 2008 - 2009
 */

#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/input.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/timer.h>
#include <linux/maple.h>

MODULE_AUTHOR("Adrian McMenamin <adrian@mcmen.demon.co.uk>");
MODULE_DESCRIPTION("SEGA Dreamcast controller driver");
MODULE_LICENSE("GPL");

struct dc_pad {
	struct input_dev *dev;
	struct maple_device *mdev;
};

static void dc_pad_callback(struct mapleq *mq)
{
	unsigned short buttons;
	struct maple_device *mapledev = mq->dev;
	struct dc_pad *pad = maple_get_drvdata(mapledev);
	struct input_dev *dev = pad->dev;
	unsigned char *res = mq->recvbuf->buf;

	buttons = ~le16_to_cpup((__le16 *)(res + 8));

	input_report_abs(dev, ABS_HAT0Y,
		(buttons & 0x0010 ? -1 : 0) + (buttons & 0x0020 ? 1 : 0));
	input_report_abs(dev, ABS_HAT0X,
		(buttons & 0x0040 ? -1 : 0) + (buttons & 0x0080 ? 1 : 0));
	input_report_abs(dev, ABS_HAT1Y,
		(buttons & 0x1000 ? -1 : 0) + (buttons & 0x2000 ? 1 : 0));
	input_report_abs(dev, ABS_HAT1X,
		(buttons & 0x4000 ? -1 : 0) + (buttons & 0x8000 ? 1 : 0));

	input_report_key(dev, BTN_C,      buttons & 0x0001);
	input_report_key(dev, BTN_B,      buttons & 0x0002);
	input_report_key(dev, BTN_A,      buttons & 0x0004);
	input_report_key(dev, BTN_START,  buttons & 0x0008);
	input_report_key(dev, BTN_Z,      buttons & 0x0100);
	input_report_key(dev, BTN_Y,      buttons & 0x0200);
	input_report_key(dev, BTN_X,      buttons & 0x0400);
	input_report_key(dev, BTN_SELECT, buttons & 0x0800);

	input_report_abs(dev, ABS_GAS,    res[10]);
	input_report_abs(dev, ABS_BRAKE,  res[11]);
	input_report_abs(dev, ABS_X,      res[12]);
	input_report_abs(dev, ABS_Y,      res[13]);
	input_report_abs(dev, ABS_RX,     res[14]);
	input_report_abs(dev, ABS_RY,     res[15]);
}

static int dc_pad_open(struct input_dev *dev)
{
	struct dc_pad *pad = dev_get_platdata(&dev->dev);

	maple_getcond_callback(pad->mdev, dc_pad_callback, HZ/20,
		MAPLE_FUNC_CONTROLLER);

	return 0;
}

static void dc_pad_close(struct input_dev *dev)
{
	struct dc_pad *pad = dev_get_platdata(&dev->dev);

	maple_getcond_callback(pad->mdev, dc_pad_callback, 0,
		MAPLE_FUNC_CONTROLLER);
}

/* allow the controller to be used */
static int probe_maple_controller(struct device *dev)
{
	static const short btn_bit[32] = {
		BTN_C, BTN_B, BTN_A, BTN_START, -1, -1, -1, -1,
		BTN_Z, BTN_Y, BTN_X, BTN_SELECT, -1, -1, -1, -1,
		-1, -1, -1, -1, -1, -1, -1, -1,
		-1, -1, -1, -1, -1, -1, -1, -1,
	};

	static const short abs_bit[32] = {
		-1, -1, -1, -1, ABS_HAT0Y, ABS_HAT0Y, ABS_HAT0X, ABS_HAT0X,
		-1, -1, -1, -1, ABS_HAT1Y, ABS_HAT1Y, ABS_HAT1X, ABS_HAT1X,
		ABS_GAS, ABS_BRAKE, ABS_X, ABS_Y, ABS_RX, ABS_RY, -1, -1,
		-1, -1, -1, -1, -1, -1, -1, -1,
	};

	struct maple_device *mdev = to_maple_dev(dev);
	struct maple_driver *mdrv = to_maple_driver(dev->driver);
	int i, error;
	struct dc_pad *pad;
	struct input_dev *idev;
	unsigned long data = be32_to_cpu(mdev->devinfo.function_data[0]);

	pad = kzalloc(sizeof(struct dc_pad), GFP_KERNEL);
	idev = input_allocate_device();
	if (!pad || !idev) {
		error = -ENOMEM;
		goto fail;
	}

	pad->dev = idev;
	pad->mdev = mdev;

	idev->open = dc_pad_open;
	idev->close = dc_pad_close;

	for (i = 0; i < 32; i++) {
		if (data & (1 << i)) {
			if (btn_bit[i] >= 0)
				__set_bit(btn_bit[i], idev->keybit);
			else if (abs_bit[i] >= 0)
				__set_bit(abs_bit[i], idev->absbit);
		}
	}

	if (idev->keybit[BIT_WORD(BTN_JOYSTICK)])
		idev->evbit[0] |= BIT_MASK(EV_KEY);

	if (idev->absbit[0])
		idev->evbit[0] |= BIT_MASK(EV_ABS);

	for (i = ABS_X; i <= ABS_BRAKE; i++)
		input_set_abs_params(idev, i, 0, 255, 0, 0);

	for (i = ABS_HAT0X; i <= ABS_HAT3Y; i++)
		input_set_abs_params(idev, i, 1, -1, 0, 0);

	idev->dev.platform_data = pad;
	idev->dev.parent = &mdev->dev;
	idev->name = mdev->product_name;
	idev->id.bustype = BUS_HOST;
	input_set_drvdata(idev, pad);

	error = input_register_device(idev);
	if (error)
		goto fail;

	mdev->driver = mdrv;
	maple_set_drvdata(mdev, pad);

	return 0;

fail:
	input_free_device(idev);
	kfree(pad);
	maple_set_drvdata(mdev, NULL);
	return error;
}

static int remove_maple_controller(struct device *dev)
{
	struct maple_device *mdev = to_maple_dev(dev);
	struct dc_pad *pad = maple_get_drvdata(mdev);

	mdev->callback = NULL;
	input_unregister_device(pad->dev);
	maple_set_drvdata(mdev, NULL);
	kfree(pad);

	return 0;
}

static struct maple_driver dc_pad_driver = {
	.function =	MAPLE_FUNC_CONTROLLER,
	.drv = {
		.name	= "Dreamcast_controller",
		.probe	= probe_maple_controller,
		.remove	= remove_maple_controller,
	},
};

static int __init dc_pad_init(void)
{
	return maple_driver_register(&dc_pad_driver);
}

static void __exit dc_pad_exit(void)
{
	maple_driver_unregister(&dc_pad_driver);
}

module_init(dc_pad_init);
module_exit(dc_pad_exit);
Commit	Line	Data
01461d7e AM	1	/*
	2	* SEGA Dreamcast controller driver
	3	* Based on drivers/usb/iforce.c
	4	*
	5	* Copyright Yaegashi Takeshi, 2001
b233b28e	6	* Adrian McMenamin, 2008 - 2009
01461d7e AM	7	*/
	8
	9	#include <linux/kernel.h>
	10	#include <linux/slab.h>
	11	#include <linux/input.h>
	12	#include <linux/module.h>
	13	#include <linux/init.h>
	14	#include <linux/timer.h>
	15	#include <linux/maple.h>
	16
	17	MODULE_AUTHOR("Adrian McMenamin <adrian@mcmen.demon.co.uk>");
	18	MODULE_DESCRIPTION("SEGA Dreamcast controller driver");
	19	MODULE_LICENSE("GPL");
	20
	21	struct dc_pad {
	22	struct input_dev *dev;
	23	struct maple_device *mdev;
	24	};
	25
	26	static void dc_pad_callback(struct mapleq *mq)
	27	{
	28	unsigned short buttons;
	29	struct maple_device *mapledev = mq->dev;
	30	struct dc_pad *pad = maple_get_drvdata(mapledev);
	31	struct input_dev *dev = pad->dev;
b233b28e	32	unsigned char *res = mq->recvbuf->buf;
01461d7e AM	33
	34	buttons = ~le16_to_cpup((__le16 *)(res + 8));
	35
	36	input_report_abs(dev, ABS_HAT0Y,
	37	(buttons & 0x0010 ? -1 : 0) + (buttons & 0x0020 ? 1 : 0));
	38	input_report_abs(dev, ABS_HAT0X,
	39	(buttons & 0x0040 ? -1 : 0) + (buttons & 0x0080 ? 1 : 0));
	40	input_report_abs(dev, ABS_HAT1Y,
	41	(buttons & 0x1000 ? -1 : 0) + (buttons & 0x2000 ? 1 : 0));
	42	input_report_abs(dev, ABS_HAT1X,
	43	(buttons & 0x4000 ? -1 : 0) + (buttons & 0x8000 ? 1 : 0));
	44
	45	input_report_key(dev, BTN_C, buttons & 0x0001);
	46	input_report_key(dev, BTN_B, buttons & 0x0002);
	47	input_report_key(dev, BTN_A, buttons & 0x0004);
	48	input_report_key(dev, BTN_START, buttons & 0x0008);
	49	input_report_key(dev, BTN_Z, buttons & 0x0100);
	50	input_report_key(dev, BTN_Y, buttons & 0x0200);
	51	input_report_key(dev, BTN_X, buttons & 0x0400);
	52	input_report_key(dev, BTN_SELECT, buttons & 0x0800);
	53
	54	input_report_abs(dev, ABS_GAS, res[10]);
	55	input_report_abs(dev, ABS_BRAKE, res[11]);
	56	input_report_abs(dev, ABS_X, res[12]);
	57	input_report_abs(dev, ABS_Y, res[13]);
	58	input_report_abs(dev, ABS_RX, res[14]);
	59	input_report_abs(dev, ABS_RY, res[15]);
	60	}
	61
	62	static int dc_pad_open(struct input_dev *dev)
	63	{
846fc20f	64	struct dc_pad *pad = dev_get_platdata(&dev->dev);
01461d7e AM	65
	66	maple_getcond_callback(pad->mdev, dc_pad_callback, HZ/20,
	67	MAPLE_FUNC_CONTROLLER);
	68
	69	return 0;
	70	}
	71
	72	static void dc_pad_close(struct input_dev *dev)
	73	{
846fc20f	74	struct dc_pad *pad = dev_get_platdata(&dev->dev);
01461d7e AM	75
	76	maple_getcond_callback(pad->mdev, dc_pad_callback, 0,
	77	MAPLE_FUNC_CONTROLLER);
	78	}
	79
	80	/* allow the controller to be used */
5298cc4c	81	static int probe_maple_controller(struct device *dev)
01461d7e AM	82	{
	83	static const short btn_bit[32] = {
	84	BTN_C, BTN_B, BTN_A, BTN_START, -1, -1, -1, -1,
	85	BTN_Z, BTN_Y, BTN_X, BTN_SELECT, -1, -1, -1, -1,
	86	-1, -1, -1, -1, -1, -1, -1, -1,
	87	-1, -1, -1, -1, -1, -1, -1, -1,
	88	};
	89
	90	static const short abs_bit[32] = {
	91	-1, -1, -1, -1, ABS_HAT0Y, ABS_HAT0Y, ABS_HAT0X, ABS_HAT0X,
	92	-1, -1, -1, -1, ABS_HAT1Y, ABS_HAT1Y, ABS_HAT1X, ABS_HAT1X,
	93	ABS_GAS, ABS_BRAKE, ABS_X, ABS_Y, ABS_RX, ABS_RY, -1, -1,
	94	-1, -1, -1, -1, -1, -1, -1, -1,
	95	};
	96
	97	struct maple_device *mdev = to_maple_dev(dev);
	98	struct maple_driver *mdrv = to_maple_driver(dev->driver);
	99	int i, error;
	100	struct dc_pad *pad;
	101	struct input_dev *idev;
	102	unsigned long data = be32_to_cpu(mdev->devinfo.function_data[0]);
	103
	104	pad = kzalloc(sizeof(struct dc_pad), GFP_KERNEL);
	105	idev = input_allocate_device();
	106	if (!pad \|\| !idev) {
	107	error = -ENOMEM;
	108	goto fail;
	109	}
	110
	111	pad->dev = idev;
	112	pad->mdev = mdev;
	113
	114	idev->open = dc_pad_open;
	115	idev->close = dc_pad_close;
	116
	117	for (i = 0; i < 32; i++) {
	118	if (data & (1 << i)) {
	119	if (btn_bit[i] >= 0)
	120	__set_bit(btn_bit[i], idev->keybit);
	121	else if (abs_bit[i] >= 0)
	122	__set_bit(abs_bit[i], idev->absbit);
	123	}
	124	}
	125
	126	if (idev->keybit[BIT_WORD(BTN_JOYSTICK)])
	127	idev->evbit[0] \|= BIT_MASK(EV_KEY);
	128
	129	if (idev->absbit[0])
	130	idev->evbit[0] \|= BIT_MASK(EV_ABS);
	131
	132	for (i = ABS_X; i <= ABS_BRAKE; i++)
	133	input_set_abs_params(idev, i, 0, 255, 0, 0);
	134
	135	for (i = ABS_HAT0X; i <= ABS_HAT3Y; i++)
	136	input_set_abs_params(idev, i, 1, -1, 0, 0);
	137
	138	idev->dev.platform_data = pad;
	139	idev->dev.parent = &mdev->dev;
	140	idev->name = mdev->product_name;
	141	idev->id.bustype = BUS_HOST;
	142	input_set_drvdata(idev, pad);
	143
	144	error = input_register_device(idev);
	145	if (error)
146	goto fail;
147
148	mdev->driver = mdrv;
149	maple_set_drvdata(mdev, pad);
150
151	return 0;
152
153	fail:
154	input_free_device(idev);
155	kfree(pad);
156	maple_set_drvdata(mdev, NULL);
157	return error;
158	}
159
e2619cf7	160	static int remove_maple_controller(struct device *dev)
01461d7e AM	161	{
	162	struct maple_device *mdev = to_maple_dev(dev);
	163	struct dc_pad *pad = maple_get_drvdata(mdev);
	164
	165	mdev->callback = NULL;
	166	input_unregister_device(pad->dev);
	167	maple_set_drvdata(mdev, NULL);
	168	kfree(pad);
	169
	170	return 0;
	171	}
	172
	173	static struct maple_driver dc_pad_driver = {
	174	.function = MAPLE_FUNC_CONTROLLER,
	175	.drv = {
	176	.name = "Dreamcast_controller",
	177	.probe = probe_maple_controller,
1cb0aa88	178	.remove = remove_maple_controller,
01461d7e AM	179	},
	180	};
	181
	182	static int __init dc_pad_init(void)
	183	{
	184	return maple_driver_register(&dc_pad_driver);
	185	}
	186
	187	static void __exit dc_pad_exit(void)
	188	{
	189	maple_driver_unregister(&dc_pad_driver);
	190	}
	191
	192	module_init(dc_pad_init);
	193	module_exit(dc_pad_exit);