]>
Commit | Line | Data |
---|---|---|
1a59d1b8 | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
1da177e4 | 2 | /* |
1da177e4 LT |
3 | * Copyright (c) 1998-2001 Vojtech Pavlik |
4 | * | |
5 | * Based on the work of: | |
6 | * Steffen Schwenke | |
7 | */ | |
8 | ||
9 | /* | |
10 | * TurboGraFX parallel port interface driver for Linux. | |
11 | */ | |
12 | ||
13 | /* | |
1da177e4 LT |
14 | */ |
15 | ||
16 | #include <linux/kernel.h> | |
17 | #include <linux/parport.h> | |
18 | #include <linux/input.h> | |
19 | #include <linux/module.h> | |
1da177e4 | 20 | #include <linux/init.h> |
72ba9f0c | 21 | #include <linux/mutex.h> |
5a0e3ad6 | 22 | #include <linux/slab.h> |
1da177e4 LT |
23 | |
24 | MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); | |
25 | MODULE_DESCRIPTION("TurboGraFX parallel port interface driver"); | |
26 | MODULE_LICENSE("GPL"); | |
27 | ||
17dd3f0f DT |
28 | #define TGFX_MAX_PORTS 3 |
29 | #define TGFX_MAX_DEVICES 7 | |
1da177e4 | 30 | |
17dd3f0f DT |
31 | struct tgfx_config { |
32 | int args[TGFX_MAX_DEVICES + 1]; | |
78167236 | 33 | unsigned int nargs; |
17dd3f0f DT |
34 | }; |
35 | ||
4de27a63 | 36 | static struct tgfx_config tgfx_cfg[TGFX_MAX_PORTS]; |
1da177e4 | 37 | |
78167236 | 38 | module_param_array_named(map, tgfx_cfg[0].args, int, &tgfx_cfg[0].nargs, 0); |
17dd3f0f | 39 | MODULE_PARM_DESC(map, "Describes first set of devices (<parport#>,<js1>,<js2>,..<js7>"); |
78167236 | 40 | module_param_array_named(map2, tgfx_cfg[1].args, int, &tgfx_cfg[1].nargs, 0); |
17dd3f0f | 41 | MODULE_PARM_DESC(map2, "Describes second set of devices"); |
78167236 | 42 | module_param_array_named(map3, tgfx_cfg[2].args, int, &tgfx_cfg[2].nargs, 0); |
1da177e4 LT |
43 | MODULE_PARM_DESC(map3, "Describes third set of devices"); |
44 | ||
1da177e4 LT |
45 | #define TGFX_REFRESH_TIME HZ/100 /* 10 ms */ |
46 | ||
47 | #define TGFX_TRIGGER 0x08 | |
48 | #define TGFX_UP 0x10 | |
49 | #define TGFX_DOWN 0x20 | |
50 | #define TGFX_LEFT 0x40 | |
51 | #define TGFX_RIGHT 0x80 | |
52 | ||
53 | #define TGFX_THUMB 0x02 | |
54 | #define TGFX_THUMB2 0x04 | |
55 | #define TGFX_TOP 0x01 | |
56 | #define TGFX_TOP2 0x08 | |
57 | ||
58 | static int tgfx_buttons[] = { BTN_TRIGGER, BTN_THUMB, BTN_THUMB2, BTN_TOP, BTN_TOP2 }; | |
1da177e4 LT |
59 | |
60 | static struct tgfx { | |
61 | struct pardevice *pd; | |
62 | struct timer_list timer; | |
17dd3f0f DT |
63 | struct input_dev *dev[TGFX_MAX_DEVICES]; |
64 | char name[TGFX_MAX_DEVICES][64]; | |
65 | char phys[TGFX_MAX_DEVICES][32]; | |
1da177e4 LT |
66 | int sticks; |
67 | int used; | |
4de27a63 | 68 | int parportno; |
72ba9f0c | 69 | struct mutex sem; |
17dd3f0f | 70 | } *tgfx_base[TGFX_MAX_PORTS]; |
1da177e4 LT |
71 | |
72 | /* | |
73 | * tgfx_timer() reads and analyzes TurboGraFX joystick data. | |
74 | */ | |
75 | ||
e99e88a9 | 76 | static void tgfx_timer(struct timer_list *t) |
1da177e4 | 77 | { |
e99e88a9 | 78 | struct tgfx *tgfx = from_timer(tgfx, t, timer); |
1da177e4 LT |
79 | struct input_dev *dev; |
80 | int data1, data2, i; | |
81 | ||
82 | for (i = 0; i < 7; i++) | |
83 | if (tgfx->sticks & (1 << i)) { | |
84 | ||
17dd3f0f | 85 | dev = tgfx->dev[i]; |
1da177e4 LT |
86 | |
87 | parport_write_data(tgfx->pd->port, ~(1 << i)); | |
88 | data1 = parport_read_status(tgfx->pd->port) ^ 0x7f; | |
89 | data2 = parport_read_control(tgfx->pd->port) ^ 0x04; /* CAVEAT parport */ | |
90 | ||
91 | input_report_abs(dev, ABS_X, !!(data1 & TGFX_RIGHT) - !!(data1 & TGFX_LEFT)); | |
92 | input_report_abs(dev, ABS_Y, !!(data1 & TGFX_DOWN ) - !!(data1 & TGFX_UP )); | |
93 | ||
94 | input_report_key(dev, BTN_TRIGGER, (data1 & TGFX_TRIGGER)); | |
95 | input_report_key(dev, BTN_THUMB, (data2 & TGFX_THUMB )); | |
96 | input_report_key(dev, BTN_THUMB2, (data2 & TGFX_THUMB2 )); | |
97 | input_report_key(dev, BTN_TOP, (data2 & TGFX_TOP )); | |
98 | input_report_key(dev, BTN_TOP2, (data2 & TGFX_TOP2 )); | |
99 | ||
100 | input_sync(dev); | |
101 | } | |
102 | ||
103 | mod_timer(&tgfx->timer, jiffies + TGFX_REFRESH_TIME); | |
104 | } | |
105 | ||
106 | static int tgfx_open(struct input_dev *dev) | |
107 | { | |
8715c1cf | 108 | struct tgfx *tgfx = input_get_drvdata(dev); |
8b1a198b DT |
109 | int err; |
110 | ||
72ba9f0c | 111 | err = mutex_lock_interruptible(&tgfx->sem); |
8b1a198b DT |
112 | if (err) |
113 | return err; | |
114 | ||
ab0c3443 | 115 | if (!tgfx->used++) { |
1da177e4 LT |
116 | parport_claim(tgfx->pd); |
117 | parport_write_control(tgfx->pd->port, 0x04); | |
ab0c3443 | 118 | mod_timer(&tgfx->timer, jiffies + TGFX_REFRESH_TIME); |
1da177e4 | 119 | } |
8b1a198b | 120 | |
72ba9f0c | 121 | mutex_unlock(&tgfx->sem); |
ab0c3443 | 122 | return 0; |
1da177e4 LT |
123 | } |
124 | ||
125 | static void tgfx_close(struct input_dev *dev) | |
126 | { | |
8715c1cf | 127 | struct tgfx *tgfx = input_get_drvdata(dev); |
8b1a198b | 128 | |
72ba9f0c | 129 | mutex_lock(&tgfx->sem); |
ab0c3443 | 130 | if (!--tgfx->used) { |
8b1a198b | 131 | del_timer_sync(&tgfx->timer); |
1da177e4 | 132 | parport_write_control(tgfx->pd->port, 0x00); |
ab0c3443 | 133 | parport_release(tgfx->pd); |
1da177e4 | 134 | } |
72ba9f0c | 135 | mutex_unlock(&tgfx->sem); |
1da177e4 LT |
136 | } |
137 | ||
17dd3f0f DT |
138 | |
139 | ||
1da177e4 LT |
140 | /* |
141 | * tgfx_probe() probes for tg gamepads. | |
142 | */ | |
143 | ||
4de27a63 | 144 | static void tgfx_attach(struct parport *pp) |
1da177e4 LT |
145 | { |
146 | struct tgfx *tgfx; | |
17dd3f0f | 147 | struct input_dev *input_dev; |
17dd3f0f | 148 | struct pardevice *pd; |
c65cf815 | 149 | int i, j, port_idx; |
4de27a63 SM |
150 | int *n_buttons, n_devs; |
151 | struct pardev_cb tgfx_parport_cb; | |
152 | ||
c65cf815 SM |
153 | for (port_idx = 0; port_idx < TGFX_MAX_PORTS; port_idx++) { |
154 | if (tgfx_cfg[port_idx].nargs == 0 || | |
155 | tgfx_cfg[port_idx].args[0] < 0) | |
4de27a63 | 156 | continue; |
c65cf815 | 157 | if (tgfx_cfg[port_idx].args[0] == pp->number) |
4de27a63 SM |
158 | break; |
159 | } | |
1da177e4 | 160 | |
c65cf815 | 161 | if (port_idx == TGFX_MAX_PORTS) { |
4de27a63 SM |
162 | pr_debug("Not using parport%d.\n", pp->number); |
163 | return; | |
1da177e4 | 164 | } |
c65cf815 SM |
165 | n_buttons = tgfx_cfg[port_idx].args + 1; |
166 | n_devs = tgfx_cfg[port_idx].nargs - 1; | |
1da177e4 | 167 | |
3855e9e4 | 168 | memset(&tgfx_parport_cb, 0, sizeof(tgfx_parport_cb)); |
4de27a63 SM |
169 | tgfx_parport_cb.flags = PARPORT_FLAG_EXCL; |
170 | ||
c65cf815 SM |
171 | pd = parport_register_dev_model(pp, "turbografx", &tgfx_parport_cb, |
172 | port_idx); | |
17dd3f0f | 173 | if (!pd) { |
4de27a63 SM |
174 | pr_err("parport busy already - lp.o loaded?\n"); |
175 | return; | |
1da177e4 | 176 | } |
8b1a198b | 177 | |
17dd3f0f DT |
178 | tgfx = kzalloc(sizeof(struct tgfx), GFP_KERNEL); |
179 | if (!tgfx) { | |
180 | printk(KERN_ERR "turbografx.c: Not enough memory\n"); | |
17dd3f0f | 181 | goto err_unreg_pardev; |
1da177e4 LT |
182 | } |
183 | ||
72ba9f0c | 184 | mutex_init(&tgfx->sem); |
17dd3f0f | 185 | tgfx->pd = pd; |
4de27a63 | 186 | tgfx->parportno = pp->number; |
e99e88a9 | 187 | timer_setup(&tgfx->timer, tgfx_timer, 0); |
1da177e4 | 188 | |
17dd3f0f DT |
189 | for (i = 0; i < n_devs; i++) { |
190 | if (n_buttons[i] < 1) | |
191 | continue; | |
1da177e4 | 192 | |
c20bc550 | 193 | if (n_buttons[i] > ARRAY_SIZE(tgfx_buttons)) { |
17dd3f0f | 194 | printk(KERN_ERR "turbografx.c: Invalid number of buttons %d\n", n_buttons[i]); |
ab52cd66 | 195 | goto err_unreg_devs; |
17dd3f0f | 196 | } |
1da177e4 | 197 | |
17dd3f0f DT |
198 | tgfx->dev[i] = input_dev = input_allocate_device(); |
199 | if (!input_dev) { | |
200 | printk(KERN_ERR "turbografx.c: Not enough memory for input device\n"); | |
ab52cd66 | 201 | goto err_unreg_devs; |
17dd3f0f | 202 | } |
1da177e4 | 203 | |
17dd3f0f DT |
204 | tgfx->sticks |= (1 << i); |
205 | snprintf(tgfx->name[i], sizeof(tgfx->name[i]), | |
206 | "TurboGraFX %d-button Multisystem joystick", n_buttons[i]); | |
207 | snprintf(tgfx->phys[i], sizeof(tgfx->phys[i]), | |
208 | "%s/input%d", tgfx->pd->port->name, i); | |
1da177e4 | 209 | |
17dd3f0f DT |
210 | input_dev->name = tgfx->name[i]; |
211 | input_dev->phys = tgfx->phys[i]; | |
212 | input_dev->id.bustype = BUS_PARPORT; | |
213 | input_dev->id.vendor = 0x0003; | |
214 | input_dev->id.product = n_buttons[i]; | |
215 | input_dev->id.version = 0x0100; | |
1da177e4 | 216 | |
8715c1cf DT |
217 | input_set_drvdata(input_dev, tgfx); |
218 | ||
17dd3f0f DT |
219 | input_dev->open = tgfx_open; |
220 | input_dev->close = tgfx_close; | |
1da177e4 | 221 | |
7b19ada2 | 222 | input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS); |
17dd3f0f DT |
223 | input_set_abs_params(input_dev, ABS_X, -1, 1, 0, 0); |
224 | input_set_abs_params(input_dev, ABS_Y, -1, 1, 0, 0); | |
1da177e4 | 225 | |
17dd3f0f DT |
226 | for (j = 0; j < n_buttons[i]; j++) |
227 | set_bit(tgfx_buttons[j], input_dev->keybit); | |
1da177e4 | 228 | |
4de27a63 | 229 | if (input_register_device(tgfx->dev[i])) |
ab52cd66 | 230 | goto err_free_dev; |
17dd3f0f | 231 | } |
1da177e4 LT |
232 | |
233 | if (!tgfx->sticks) { | |
17dd3f0f | 234 | printk(KERN_ERR "turbografx.c: No valid devices specified\n"); |
17dd3f0f | 235 | goto err_free_tgfx; |
1da177e4 LT |
236 | } |
237 | ||
c65cf815 | 238 | tgfx_base[port_idx] = tgfx; |
4de27a63 | 239 | return; |
17dd3f0f | 240 | |
ab52cd66 DT |
241 | err_free_dev: |
242 | input_free_device(tgfx->dev[i]); | |
243 | err_unreg_devs: | |
17dd3f0f | 244 | while (--i >= 0) |
ab52cd66 DT |
245 | if (tgfx->dev[i]) |
246 | input_unregister_device(tgfx->dev[i]); | |
17dd3f0f DT |
247 | err_free_tgfx: |
248 | kfree(tgfx); | |
249 | err_unreg_pardev: | |
250 | parport_unregister_device(pd); | |
17dd3f0f DT |
251 | } |
252 | ||
4de27a63 | 253 | static void tgfx_detach(struct parport *port) |
17dd3f0f DT |
254 | { |
255 | int i; | |
4de27a63 SM |
256 | struct tgfx *tgfx; |
257 | ||
258 | for (i = 0; i < TGFX_MAX_PORTS; i++) { | |
259 | if (tgfx_base[i] && tgfx_base[i]->parportno == port->number) | |
260 | break; | |
261 | } | |
262 | ||
263 | if (i == TGFX_MAX_PORTS) | |
264 | return; | |
265 | ||
266 | tgfx = tgfx_base[i]; | |
267 | tgfx_base[i] = NULL; | |
17dd3f0f DT |
268 | |
269 | for (i = 0; i < TGFX_MAX_DEVICES; i++) | |
270 | if (tgfx->dev[i]) | |
271 | input_unregister_device(tgfx->dev[i]); | |
272 | parport_unregister_device(tgfx->pd); | |
273 | kfree(tgfx); | |
1da177e4 LT |
274 | } |
275 | ||
4de27a63 SM |
276 | static struct parport_driver tgfx_parport_driver = { |
277 | .name = "turbografx", | |
278 | .match_port = tgfx_attach, | |
279 | .detach = tgfx_detach, | |
280 | .devmodel = true, | |
281 | }; | |
282 | ||
1da177e4 LT |
283 | static int __init tgfx_init(void) |
284 | { | |
17dd3f0f DT |
285 | int i; |
286 | int have_dev = 0; | |
17dd3f0f DT |
287 | |
288 | for (i = 0; i < TGFX_MAX_PORTS; i++) { | |
78167236 | 289 | if (tgfx_cfg[i].nargs == 0 || tgfx_cfg[i].args[0] < 0) |
17dd3f0f DT |
290 | continue; |
291 | ||
78167236 | 292 | if (tgfx_cfg[i].nargs < 2) { |
17dd3f0f | 293 | printk(KERN_ERR "turbografx.c: at least one joystick must be specified\n"); |
4de27a63 | 294 | return -EINVAL; |
17dd3f0f DT |
295 | } |
296 | ||
297 | have_dev = 1; | |
298 | } | |
1da177e4 | 299 | |
4de27a63 SM |
300 | if (!have_dev) |
301 | return -ENODEV; | |
1da177e4 | 302 | |
4de27a63 | 303 | return parport_register_driver(&tgfx_parport_driver); |
1da177e4 LT |
304 | } |
305 | ||
306 | static void __exit tgfx_exit(void) | |
307 | { | |
4de27a63 | 308 | parport_unregister_driver(&tgfx_parport_driver); |
1da177e4 LT |
309 | } |
310 | ||
311 | module_init(tgfx_init); | |
312 | module_exit(tgfx_exit); |