Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * $Id: amijoy.c,v 1.13 2002/01/22 20:26:32 vojtech Exp $ | |
3 | * | |
4 | * Copyright (c) 1998-2001 Vojtech Pavlik | |
5 | */ | |
6 | ||
7 | /* | |
8 | * Driver for Amiga joysticks for Linux/m68k | |
9 | */ | |
10 | ||
11 | /* | |
12 | * This program is free software; you can redistribute it and/or modify | |
13 | * it under the terms of the GNU General Public License as published by | |
14 | * the Free Software Foundation; either version 2 of the License, or | |
15 | * (at your option) any later version. | |
16 | * | |
17 | * This program is distributed in the hope that it will be useful, | |
18 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
20 | * GNU General Public License for more details. | |
21 | * | |
22 | * You should have received a copy of the GNU General Public License | |
23 | * along with this program; if not, write to the Free Software | |
24 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
25 | * | |
26 | * Should you need to contact me, the author, you can do so either by | |
27 | * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail: | |
28 | * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic | |
29 | */ | |
30 | ||
31 | #include <linux/types.h> | |
32 | #include <linux/errno.h> | |
33 | #include <linux/kernel.h> | |
34 | #include <linux/module.h> | |
35 | #include <linux/moduleparam.h> | |
36 | #include <linux/init.h> | |
37 | #include <linux/input.h> | |
38 | #include <linux/interrupt.h> | |
72ba9f0c | 39 | #include <linux/mutex.h> |
1da177e4 LT |
40 | |
41 | #include <asm/system.h> | |
42 | #include <asm/amigahw.h> | |
43 | #include <asm/amigaints.h> | |
44 | ||
45 | MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); | |
46 | MODULE_DESCRIPTION("Driver for Amiga joysticks"); | |
47 | MODULE_LICENSE("GPL"); | |
48 | ||
49 | static int amijoy[2] = { 0, 1 }; | |
50 | module_param_array_named(map, amijoy, uint, NULL, 0); | |
51 | MODULE_PARM_DESC(map, "Map of attached joysticks in form of <a>,<b> (default is 0,1)"); | |
52 | ||
53 | __obsolete_setup("amijoy="); | |
54 | ||
8b1a198b | 55 | static int amijoy_used; |
72ba9f0c | 56 | static DEFINE_MUTEX(amijoy_mutex); |
17dd3f0f | 57 | static struct input_dev *amijoy_dev[2]; |
1da177e4 LT |
58 | static char *amijoy_phys[2] = { "amijoy/input0", "amijoy/input1" }; |
59 | ||
7d12e780 | 60 | static irqreturn_t amijoy_interrupt(int irq, void *dummy) |
1da177e4 LT |
61 | { |
62 | int i, data = 0, button = 0; | |
63 | ||
64 | for (i = 0; i < 2; i++) | |
65 | if (amijoy[i]) { | |
66 | ||
67 | switch (i) { | |
b4290a23 AV |
68 | case 0: data = ~amiga_custom.joy0dat; button = (~ciaa.pra >> 6) & 1; break; |
69 | case 1: data = ~amiga_custom.joy1dat; button = (~ciaa.pra >> 7) & 1; break; | |
1da177e4 LT |
70 | } |
71 | ||
17dd3f0f | 72 | input_report_key(amijoy_dev[i], BTN_TRIGGER, button); |
1da177e4 | 73 | |
17dd3f0f | 74 | input_report_abs(amijoy_dev[i], ABS_X, ((data >> 1) & 1) - ((data >> 9) & 1)); |
1da177e4 | 75 | data = ~(data ^ (data << 1)); |
17dd3f0f | 76 | input_report_abs(amijoy_dev[i], ABS_Y, ((data >> 1) & 1) - ((data >> 9) & 1)); |
1da177e4 | 77 | |
17dd3f0f | 78 | input_sync(amijoy_dev[i]); |
1da177e4 LT |
79 | } |
80 | return IRQ_HANDLED; | |
81 | } | |
82 | ||
83 | static int amijoy_open(struct input_dev *dev) | |
84 | { | |
8b1a198b | 85 | int err; |
1da177e4 | 86 | |
72ba9f0c | 87 | err = mutex_lock_interruptible(&amijoy_mutex); |
8b1a198b DT |
88 | if (err) |
89 | return err; | |
1da177e4 | 90 | |
8b1a198b | 91 | if (!amijoy_used && request_irq(IRQ_AMIGA_VERTB, amijoy_interrupt, 0, "amijoy", amijoy_interrupt)) { |
1da177e4 | 92 | printk(KERN_ERR "amijoy.c: Can't allocate irq %d\n", IRQ_AMIGA_VERTB); |
8b1a198b DT |
93 | err = -EBUSY; |
94 | goto out; | |
1da177e4 LT |
95 | } |
96 | ||
8b1a198b DT |
97 | amijoy_used++; |
98 | out: | |
72ba9f0c | 99 | mutex_unlock(&amijoy_mutex); |
8b1a198b | 100 | return err; |
1da177e4 LT |
101 | } |
102 | ||
103 | static void amijoy_close(struct input_dev *dev) | |
104 | { | |
72ba9f0c | 105 | mutex_lock(&amijoy_mutex); |
8b1a198b | 106 | if (!--amijoy_used) |
1da177e4 | 107 | free_irq(IRQ_AMIGA_VERTB, amijoy_interrupt); |
72ba9f0c | 108 | mutex_unlock(&amijoy_mutex); |
1da177e4 LT |
109 | } |
110 | ||
111 | static int __init amijoy_init(void) | |
112 | { | |
113 | int i, j; | |
17dd3f0f | 114 | int err; |
1da177e4 | 115 | |
17dd3f0f DT |
116 | for (i = 0; i < 2; i++) { |
117 | if (!amijoy[i]) | |
118 | continue; | |
1da177e4 | 119 | |
17dd3f0f DT |
120 | amijoy_dev[i] = input_allocate_device(); |
121 | if (!amijoy_dev[i]) { | |
122 | err = -ENOMEM; | |
123 | goto fail; | |
124 | } | |
1da177e4 | 125 | |
17dd3f0f DT |
126 | if (!request_mem_region(CUSTOM_PHYSADDR + 10 + i * 2, 2, "amijoy [Denise]")) { |
127 | input_free_device(amijoy_dev[i]); | |
128 | err = -EBUSY; | |
129 | goto fail; | |
130 | } | |
1da177e4 | 131 | |
17dd3f0f DT |
132 | amijoy_dev[i]->name = "Amiga joystick"; |
133 | amijoy_dev[i]->phys = amijoy_phys[i]; | |
134 | amijoy_dev[i]->id.bustype = BUS_AMIGA; | |
135 | amijoy_dev[i]->id.vendor = 0x0001; | |
136 | amijoy_dev[i]->id.product = 0x0003; | |
137 | amijoy_dev[i]->id.version = 0x0100; | |
138 | ||
139 | amijoy_dev[i]->open = amijoy_open; | |
140 | amijoy_dev[i]->close = amijoy_close; | |
141 | ||
142 | amijoy_dev[i]->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | |
143 | amijoy_dev[i]->absbit[0] = BIT(ABS_X) | BIT(ABS_Y); | |
144 | amijoy_dev[i]->keybit[LONG(BTN_LEFT)] = BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT); | |
145 | for (j = 0; j < 2; j++) { | |
146 | amijoy_dev[i]->absmin[ABS_X + j] = -1; | |
147 | amijoy_dev[i]->absmax[ABS_X + j] = 1; | |
1da177e4 | 148 | } |
17dd3f0f DT |
149 | |
150 | input_register_device(amijoy_dev[i]); | |
151 | } | |
1da177e4 | 152 | return 0; |
17dd3f0f DT |
153 | |
154 | fail: while (--i >= 0) | |
155 | if (amijoy[i]) { | |
156 | input_unregister_device(amijoy_dev[i]); | |
157 | release_mem_region(CUSTOM_PHYSADDR + 10 + i * 2, 2); | |
158 | } | |
159 | return err; | |
1da177e4 LT |
160 | } |
161 | ||
162 | static void __exit amijoy_exit(void) | |
163 | { | |
164 | int i; | |
165 | ||
166 | for (i = 0; i < 2; i++) | |
167 | if (amijoy[i]) { | |
17dd3f0f DT |
168 | input_unregister_device(amijoy_dev[i]); |
169 | release_mem_region(CUSTOM_PHYSADDR + 10 + i * 2, 2); | |
1da177e4 LT |
170 | } |
171 | } | |
172 | ||
173 | module_init(amijoy_init); | |
174 | module_exit(amijoy_exit); |