Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * $Id: turbografx.c,v 1.14 2002/01/22 20:30:39 vojtech Exp $ | |
3 | * | |
4 | * Copyright (c) 1998-2001 Vojtech Pavlik | |
5 | * | |
6 | * Based on the work of: | |
7 | * Steffen Schwenke | |
8 | */ | |
9 | ||
10 | /* | |
11 | * TurboGraFX parallel port interface driver for Linux. | |
12 | */ | |
13 | ||
14 | /* | |
15 | * This program is free software; you can redistribute it and/or modify | |
16 | * it under the terms of the GNU General Public License as published by | |
17 | * the Free Software Foundation; either version 2 of the License, or | |
18 | * (at your option) any later version. | |
19 | * | |
20 | * This program is distributed in the hope that it will be useful, | |
21 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
22 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
23 | * GNU General Public License for more details. | |
24 | * | |
25 | * You should have received a copy of the GNU General Public License | |
26 | * along with this program; if not, write to the Free Software | |
27 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
28 | * | |
29 | * Should you need to contact me, the author, you can do so either by | |
30 | * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail: | |
31 | * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic | |
32 | */ | |
33 | ||
34 | #include <linux/kernel.h> | |
35 | #include <linux/parport.h> | |
36 | #include <linux/input.h> | |
37 | #include <linux/module.h> | |
38 | #include <linux/moduleparam.h> | |
39 | #include <linux/init.h> | |
72ba9f0c | 40 | #include <linux/mutex.h> |
1da177e4 LT |
41 | |
42 | MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); | |
43 | MODULE_DESCRIPTION("TurboGraFX parallel port interface driver"); | |
44 | MODULE_LICENSE("GPL"); | |
45 | ||
17dd3f0f DT |
46 | #define TGFX_MAX_PORTS 3 |
47 | #define TGFX_MAX_DEVICES 7 | |
1da177e4 | 48 | |
17dd3f0f DT |
49 | struct tgfx_config { |
50 | int args[TGFX_MAX_DEVICES + 1]; | |
51 | int nargs; | |
52 | }; | |
53 | ||
54 | static struct tgfx_config tgfx[TGFX_MAX_PORTS] __initdata; | |
1da177e4 | 55 | |
17dd3f0f DT |
56 | module_param_array_named(map, tgfx[0].args, int, &tgfx[0].nargs, 0); |
57 | MODULE_PARM_DESC(map, "Describes first set of devices (<parport#>,<js1>,<js2>,..<js7>"); | |
58 | module_param_array_named(map2, tgfx[1].args, int, &tgfx[1].nargs, 0); | |
59 | MODULE_PARM_DESC(map2, "Describes second set of devices"); | |
60 | module_param_array_named(map3, tgfx[2].args, int, &tgfx[2].nargs, 0); | |
1da177e4 LT |
61 | MODULE_PARM_DESC(map3, "Describes third set of devices"); |
62 | ||
1da177e4 LT |
63 | #define TGFX_REFRESH_TIME HZ/100 /* 10 ms */ |
64 | ||
65 | #define TGFX_TRIGGER 0x08 | |
66 | #define TGFX_UP 0x10 | |
67 | #define TGFX_DOWN 0x20 | |
68 | #define TGFX_LEFT 0x40 | |
69 | #define TGFX_RIGHT 0x80 | |
70 | ||
71 | #define TGFX_THUMB 0x02 | |
72 | #define TGFX_THUMB2 0x04 | |
73 | #define TGFX_TOP 0x01 | |
74 | #define TGFX_TOP2 0x08 | |
75 | ||
76 | static int tgfx_buttons[] = { BTN_TRIGGER, BTN_THUMB, BTN_THUMB2, BTN_TOP, BTN_TOP2 }; | |
1da177e4 LT |
77 | |
78 | static struct tgfx { | |
79 | struct pardevice *pd; | |
80 | struct timer_list timer; | |
17dd3f0f DT |
81 | struct input_dev *dev[TGFX_MAX_DEVICES]; |
82 | char name[TGFX_MAX_DEVICES][64]; | |
83 | char phys[TGFX_MAX_DEVICES][32]; | |
1da177e4 LT |
84 | int sticks; |
85 | int used; | |
72ba9f0c | 86 | struct mutex sem; |
17dd3f0f | 87 | } *tgfx_base[TGFX_MAX_PORTS]; |
1da177e4 LT |
88 | |
89 | /* | |
90 | * tgfx_timer() reads and analyzes TurboGraFX joystick data. | |
91 | */ | |
92 | ||
93 | static void tgfx_timer(unsigned long private) | |
94 | { | |
95 | struct tgfx *tgfx = (void *) private; | |
96 | struct input_dev *dev; | |
97 | int data1, data2, i; | |
98 | ||
99 | for (i = 0; i < 7; i++) | |
100 | if (tgfx->sticks & (1 << i)) { | |
101 | ||
17dd3f0f | 102 | dev = tgfx->dev[i]; |
1da177e4 LT |
103 | |
104 | parport_write_data(tgfx->pd->port, ~(1 << i)); | |
105 | data1 = parport_read_status(tgfx->pd->port) ^ 0x7f; | |
106 | data2 = parport_read_control(tgfx->pd->port) ^ 0x04; /* CAVEAT parport */ | |
107 | ||
108 | input_report_abs(dev, ABS_X, !!(data1 & TGFX_RIGHT) - !!(data1 & TGFX_LEFT)); | |
109 | input_report_abs(dev, ABS_Y, !!(data1 & TGFX_DOWN ) - !!(data1 & TGFX_UP )); | |
110 | ||
111 | input_report_key(dev, BTN_TRIGGER, (data1 & TGFX_TRIGGER)); | |
112 | input_report_key(dev, BTN_THUMB, (data2 & TGFX_THUMB )); | |
113 | input_report_key(dev, BTN_THUMB2, (data2 & TGFX_THUMB2 )); | |
114 | input_report_key(dev, BTN_TOP, (data2 & TGFX_TOP )); | |
115 | input_report_key(dev, BTN_TOP2, (data2 & TGFX_TOP2 )); | |
116 | ||
117 | input_sync(dev); | |
118 | } | |
119 | ||
120 | mod_timer(&tgfx->timer, jiffies + TGFX_REFRESH_TIME); | |
121 | } | |
122 | ||
123 | static int tgfx_open(struct input_dev *dev) | |
124 | { | |
8715c1cf | 125 | struct tgfx *tgfx = input_get_drvdata(dev); |
8b1a198b DT |
126 | int err; |
127 | ||
72ba9f0c | 128 | err = mutex_lock_interruptible(&tgfx->sem); |
8b1a198b DT |
129 | if (err) |
130 | return err; | |
131 | ||
ab0c3443 | 132 | if (!tgfx->used++) { |
1da177e4 LT |
133 | parport_claim(tgfx->pd); |
134 | parport_write_control(tgfx->pd->port, 0x04); | |
ab0c3443 | 135 | mod_timer(&tgfx->timer, jiffies + TGFX_REFRESH_TIME); |
1da177e4 | 136 | } |
8b1a198b | 137 | |
72ba9f0c | 138 | mutex_unlock(&tgfx->sem); |
ab0c3443 | 139 | return 0; |
1da177e4 LT |
140 | } |
141 | ||
142 | static void tgfx_close(struct input_dev *dev) | |
143 | { | |
8715c1cf | 144 | struct tgfx *tgfx = input_get_drvdata(dev); |
8b1a198b | 145 | |
72ba9f0c | 146 | mutex_lock(&tgfx->sem); |
ab0c3443 | 147 | if (!--tgfx->used) { |
8b1a198b | 148 | del_timer_sync(&tgfx->timer); |
1da177e4 | 149 | parport_write_control(tgfx->pd->port, 0x00); |
ab0c3443 | 150 | parport_release(tgfx->pd); |
1da177e4 | 151 | } |
72ba9f0c | 152 | mutex_unlock(&tgfx->sem); |
1da177e4 LT |
153 | } |
154 | ||
17dd3f0f DT |
155 | |
156 | ||
1da177e4 LT |
157 | /* |
158 | * tgfx_probe() probes for tg gamepads. | |
159 | */ | |
160 | ||
17dd3f0f | 161 | static struct tgfx __init *tgfx_probe(int parport, int *n_buttons, int n_devs) |
1da177e4 LT |
162 | { |
163 | struct tgfx *tgfx; | |
17dd3f0f | 164 | struct input_dev *input_dev; |
1da177e4 | 165 | struct parport *pp; |
17dd3f0f | 166 | struct pardevice *pd; |
1da177e4 | 167 | int i, j; |
17dd3f0f | 168 | int err; |
1da177e4 | 169 | |
17dd3f0f | 170 | pp = parport_find_number(parport); |
1da177e4 LT |
171 | if (!pp) { |
172 | printk(KERN_ERR "turbografx.c: no such parport\n"); | |
17dd3f0f DT |
173 | err = -EINVAL; |
174 | goto err_out; | |
1da177e4 LT |
175 | } |
176 | ||
17dd3f0f DT |
177 | pd = parport_register_device(pp, "turbografx", NULL, NULL, NULL, PARPORT_DEV_EXCL, NULL); |
178 | if (!pd) { | |
179 | printk(KERN_ERR "turbografx.c: parport busy already - lp.o loaded?\n"); | |
180 | err = -EBUSY; | |
181 | goto err_put_pp; | |
1da177e4 | 182 | } |
8b1a198b | 183 | |
17dd3f0f DT |
184 | tgfx = kzalloc(sizeof(struct tgfx), GFP_KERNEL); |
185 | if (!tgfx) { | |
186 | printk(KERN_ERR "turbografx.c: Not enough memory\n"); | |
187 | err = -ENOMEM; | |
188 | goto err_unreg_pardev; | |
1da177e4 LT |
189 | } |
190 | ||
72ba9f0c | 191 | mutex_init(&tgfx->sem); |
17dd3f0f | 192 | tgfx->pd = pd; |
1da177e4 LT |
193 | init_timer(&tgfx->timer); |
194 | tgfx->timer.data = (long) tgfx; | |
195 | tgfx->timer.function = tgfx_timer; | |
196 | ||
17dd3f0f DT |
197 | for (i = 0; i < n_devs; i++) { |
198 | if (n_buttons[i] < 1) | |
199 | continue; | |
1da177e4 | 200 | |
17dd3f0f DT |
201 | if (n_buttons[i] > 6) { |
202 | printk(KERN_ERR "turbografx.c: Invalid number of buttons %d\n", n_buttons[i]); | |
203 | err = -EINVAL; | |
ab52cd66 | 204 | goto err_unreg_devs; |
17dd3f0f | 205 | } |
1da177e4 | 206 | |
17dd3f0f DT |
207 | tgfx->dev[i] = input_dev = input_allocate_device(); |
208 | if (!input_dev) { | |
209 | printk(KERN_ERR "turbografx.c: Not enough memory for input device\n"); | |
210 | err = -ENOMEM; | |
ab52cd66 | 211 | goto err_unreg_devs; |
17dd3f0f | 212 | } |
1da177e4 | 213 | |
17dd3f0f DT |
214 | tgfx->sticks |= (1 << i); |
215 | snprintf(tgfx->name[i], sizeof(tgfx->name[i]), | |
216 | "TurboGraFX %d-button Multisystem joystick", n_buttons[i]); | |
217 | snprintf(tgfx->phys[i], sizeof(tgfx->phys[i]), | |
218 | "%s/input%d", tgfx->pd->port->name, i); | |
1da177e4 | 219 | |
17dd3f0f DT |
220 | input_dev->name = tgfx->name[i]; |
221 | input_dev->phys = tgfx->phys[i]; | |
222 | input_dev->id.bustype = BUS_PARPORT; | |
223 | input_dev->id.vendor = 0x0003; | |
224 | input_dev->id.product = n_buttons[i]; | |
225 | input_dev->id.version = 0x0100; | |
1da177e4 | 226 | |
8715c1cf DT |
227 | input_set_drvdata(input_dev, tgfx); |
228 | ||
17dd3f0f DT |
229 | input_dev->open = tgfx_open; |
230 | input_dev->close = tgfx_close; | |
1da177e4 | 231 | |
17dd3f0f DT |
232 | input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
233 | input_set_abs_params(input_dev, ABS_X, -1, 1, 0, 0); | |
234 | input_set_abs_params(input_dev, ABS_Y, -1, 1, 0, 0); | |
1da177e4 | 235 | |
17dd3f0f DT |
236 | for (j = 0; j < n_buttons[i]; j++) |
237 | set_bit(tgfx_buttons[j], input_dev->keybit); | |
1da177e4 | 238 | |
ab52cd66 DT |
239 | err = input_register_device(tgfx->dev[i]); |
240 | if (err) | |
241 | goto err_free_dev; | |
17dd3f0f | 242 | } |
1da177e4 LT |
243 | |
244 | if (!tgfx->sticks) { | |
17dd3f0f DT |
245 | printk(KERN_ERR "turbografx.c: No valid devices specified\n"); |
246 | err = -EINVAL; | |
247 | goto err_free_tgfx; | |
1da177e4 LT |
248 | } |
249 | ||
250 | return tgfx; | |
17dd3f0f | 251 | |
ab52cd66 DT |
252 | err_free_dev: |
253 | input_free_device(tgfx->dev[i]); | |
254 | err_unreg_devs: | |
17dd3f0f | 255 | while (--i >= 0) |
ab52cd66 DT |
256 | if (tgfx->dev[i]) |
257 | input_unregister_device(tgfx->dev[i]); | |
17dd3f0f DT |
258 | err_free_tgfx: |
259 | kfree(tgfx); | |
260 | err_unreg_pardev: | |
261 | parport_unregister_device(pd); | |
262 | err_put_pp: | |
263 | parport_put_port(pp); | |
264 | err_out: | |
265 | return ERR_PTR(err); | |
266 | } | |
267 | ||
ab52cd66 | 268 | static void tgfx_remove(struct tgfx *tgfx) |
17dd3f0f DT |
269 | { |
270 | int i; | |
271 | ||
272 | for (i = 0; i < TGFX_MAX_DEVICES; i++) | |
273 | if (tgfx->dev[i]) | |
274 | input_unregister_device(tgfx->dev[i]); | |
275 | parport_unregister_device(tgfx->pd); | |
276 | kfree(tgfx); | |
1da177e4 LT |
277 | } |
278 | ||
279 | static int __init tgfx_init(void) | |
280 | { | |
17dd3f0f DT |
281 | int i; |
282 | int have_dev = 0; | |
283 | int err = 0; | |
284 | ||
285 | for (i = 0; i < TGFX_MAX_PORTS; i++) { | |
286 | if (tgfx[i].nargs == 0 || tgfx[i].args[0] < 0) | |
287 | continue; | |
288 | ||
289 | if (tgfx[i].nargs < 2) { | |
290 | printk(KERN_ERR "turbografx.c: at least one joystick must be specified\n"); | |
291 | err = -EINVAL; | |
292 | break; | |
293 | } | |
294 | ||
295 | tgfx_base[i] = tgfx_probe(tgfx[i].args[0], tgfx[i].args + 1, tgfx[i].nargs - 1); | |
296 | if (IS_ERR(tgfx_base[i])) { | |
297 | err = PTR_ERR(tgfx_base[i]); | |
298 | break; | |
299 | } | |
300 | ||
301 | have_dev = 1; | |
302 | } | |
1da177e4 | 303 | |
17dd3f0f DT |
304 | if (err) { |
305 | while (--i >= 0) | |
ab52cd66 DT |
306 | if (tgfx_base[i]) |
307 | tgfx_remove(tgfx_base[i]); | |
17dd3f0f DT |
308 | return err; |
309 | } | |
1da177e4 | 310 | |
17dd3f0f | 311 | return have_dev ? 0 : -ENODEV; |
1da177e4 LT |
312 | } |
313 | ||
314 | static void __exit tgfx_exit(void) | |
315 | { | |
17dd3f0f | 316 | int i; |
1da177e4 | 317 | |
17dd3f0f DT |
318 | for (i = 0; i < TGFX_MAX_PORTS; i++) |
319 | if (tgfx_base[i]) | |
320 | tgfx_remove(tgfx_base[i]); | |
1da177e4 LT |
321 | } |
322 | ||
323 | module_init(tgfx_init); | |
324 | module_exit(tgfx_exit); |