1 /*
2  *	SEGA Dreamcast controller driver
3  *	Based on drivers/usb/iforce.c
4  *
5  *	Copyright Yaegashi Takeshi, 2001
6  *	Adrian McMenamin, 2008 - 2009
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;
32 	unsigned char *res = mq->recvbuf->buf;
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 {
64 	struct dc_pad *pad = dev_get_platdata(&dev->dev);
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 {
74 	struct dc_pad *pad = dev_get_platdata(&dev->dev);
75 
76 	maple_getcond_callback(pad->mdev, dc_pad_callback, 0,
77 		MAPLE_FUNC_CONTROLLER);
78 }
79 
80 /* allow the controller to be used */
81 static int probe_maple_controller(struct device *dev)
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 
143 	error = input_register_device(idev);
144 	if (error)
145 		goto fail;
146 
147 	mdev->driver = mdrv;
148 	maple_set_drvdata(mdev, pad);
149 
150 	return 0;
151 
152 fail:
153 	input_free_device(idev);
154 	kfree(pad);
155 	maple_set_drvdata(mdev, NULL);
156 	return error;
157 }
158 
159 static int remove_maple_controller(struct device *dev)
160 {
161 	struct maple_device *mdev = to_maple_dev(dev);
162 	struct dc_pad *pad = maple_get_drvdata(mdev);
163 
164 	mdev->callback = NULL;
165 	input_unregister_device(pad->dev);
166 	maple_set_drvdata(mdev, NULL);
167 	kfree(pad);
168 
169 	return 0;
170 }
171 
172 static struct maple_driver dc_pad_driver = {
173 	.function =	MAPLE_FUNC_CONTROLLER,
174 	.drv = {
175 		.name	= "Dreamcast_controller",
176 		.probe	= probe_maple_controller,
177 		.remove	= remove_maple_controller,
178 	},
179 };
180 
181 static int __init dc_pad_init(void)
182 {
183 	return maple_driver_register(&dc_pad_driver);
184 }
185 
186 static void __exit dc_pad_exit(void)
187 {
188 	maple_driver_unregister(&dc_pad_driver);
189 }
190 
191 module_init(dc_pad_init);
192 module_exit(dc_pad_exit);
193