projects/linux·blob master · refs

194 lines · 4.8 KiB

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