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 | ||
8b1a198b | 53 | static int amijoy_used; |
72ba9f0c | 54 | static DEFINE_MUTEX(amijoy_mutex); |
17dd3f0f | 55 | static struct input_dev *amijoy_dev[2]; |
1da177e4 LT |
56 | static char *amijoy_phys[2] = { "amijoy/input0", "amijoy/input1" }; |
57 | ||
7d12e780 | 58 | static irqreturn_t amijoy_interrupt(int irq, void *dummy) |
1da177e4 LT |
59 | { |
60 | int i, data = 0, button = 0; | |
61 | ||
62 | for (i = 0; i < 2; i++) | |
63 | if (amijoy[i]) { | |
64 | ||
65 | switch (i) { | |
b4290a23 AV |
66 | case 0: data = ~amiga_custom.joy0dat; button = (~ciaa.pra >> 6) & 1; break; |
67 | case 1: data = ~amiga_custom.joy1dat; button = (~ciaa.pra >> 7) & 1; break; | |
1da177e4 LT |
68 | } |
69 | ||
17dd3f0f | 70 | input_report_key(amijoy_dev[i], BTN_TRIGGER, button); |
1da177e4 | 71 | |
17dd3f0f | 72 | input_report_abs(amijoy_dev[i], ABS_X, ((data >> 1) & 1) - ((data >> 9) & 1)); |
1da177e4 | 73 | data = ~(data ^ (data << 1)); |
17dd3f0f | 74 | input_report_abs(amijoy_dev[i], ABS_Y, ((data >> 1) & 1) - ((data >> 9) & 1)); |
1da177e4 | 75 | |
17dd3f0f | 76 | input_sync(amijoy_dev[i]); |
1da177e4 LT |
77 | } |
78 | return IRQ_HANDLED; | |
79 | } | |
80 | ||
81 | static int amijoy_open(struct input_dev *dev) | |
82 | { | |
8b1a198b | 83 | int err; |
1da177e4 | 84 | |
72ba9f0c | 85 | err = mutex_lock_interruptible(&amijoy_mutex); |
8b1a198b DT |
86 | if (err) |
87 | return err; | |
1da177e4 | 88 | |
8b1a198b | 89 | if (!amijoy_used && request_irq(IRQ_AMIGA_VERTB, amijoy_interrupt, 0, "amijoy", amijoy_interrupt)) { |
1da177e4 | 90 | printk(KERN_ERR "amijoy.c: Can't allocate irq %d\n", IRQ_AMIGA_VERTB); |
8b1a198b DT |
91 | err = -EBUSY; |
92 | goto out; | |
1da177e4 LT |
93 | } |
94 | ||
8b1a198b DT |
95 | amijoy_used++; |
96 | out: | |
72ba9f0c | 97 | mutex_unlock(&amijoy_mutex); |
8b1a198b | 98 | return err; |
1da177e4 LT |
99 | } |
100 | ||
101 | static void amijoy_close(struct input_dev *dev) | |
102 | { | |
72ba9f0c | 103 | mutex_lock(&amijoy_mutex); |
8b1a198b | 104 | if (!--amijoy_used) |
1da177e4 | 105 | free_irq(IRQ_AMIGA_VERTB, amijoy_interrupt); |
72ba9f0c | 106 | mutex_unlock(&amijoy_mutex); |
1da177e4 LT |
107 | } |
108 | ||
109 | static int __init amijoy_init(void) | |
110 | { | |
111 | int i, j; | |
17dd3f0f | 112 | int err; |
1da177e4 | 113 | |
17dd3f0f DT |
114 | for (i = 0; i < 2; i++) { |
115 | if (!amijoy[i]) | |
116 | continue; | |
1da177e4 | 117 | |
17dd3f0f DT |
118 | amijoy_dev[i] = input_allocate_device(); |
119 | if (!amijoy_dev[i]) { | |
120 | err = -ENOMEM; | |
121 | goto fail; | |
122 | } | |
1da177e4 | 123 | |
17dd3f0f DT |
124 | if (!request_mem_region(CUSTOM_PHYSADDR + 10 + i * 2, 2, "amijoy [Denise]")) { |
125 | input_free_device(amijoy_dev[i]); | |
126 | err = -EBUSY; | |
127 | goto fail; | |
128 | } | |
1da177e4 | 129 | |
17dd3f0f DT |
130 | amijoy_dev[i]->name = "Amiga joystick"; |
131 | amijoy_dev[i]->phys = amijoy_phys[i]; | |
132 | amijoy_dev[i]->id.bustype = BUS_AMIGA; | |
133 | amijoy_dev[i]->id.vendor = 0x0001; | |
134 | amijoy_dev[i]->id.product = 0x0003; | |
135 | amijoy_dev[i]->id.version = 0x0100; | |
136 | ||
137 | amijoy_dev[i]->open = amijoy_open; | |
138 | amijoy_dev[i]->close = amijoy_close; | |
139 | ||
140 | amijoy_dev[i]->evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); | |
141 | amijoy_dev[i]->absbit[0] = BIT(ABS_X) | BIT(ABS_Y); | |
142 | amijoy_dev[i]->keybit[LONG(BTN_LEFT)] = BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT); | |
143 | for (j = 0; j < 2; j++) { | |
144 | amijoy_dev[i]->absmin[ABS_X + j] = -1; | |
145 | amijoy_dev[i]->absmax[ABS_X + j] = 1; | |
1da177e4 | 146 | } |
17dd3f0f | 147 | |
127278ce DT |
148 | err = input_register_device(amijoy_dev[i]); |
149 | if (err) { | |
150 | input_free_device(amijoy_dev[i]); | |
151 | goto fail; | |
152 | } | |
17dd3f0f | 153 | } |
1da177e4 | 154 | return 0; |
17dd3f0f DT |
155 | |
156 | fail: while (--i >= 0) | |
157 | if (amijoy[i]) { | |
158 | input_unregister_device(amijoy_dev[i]); | |
159 | release_mem_region(CUSTOM_PHYSADDR + 10 + i * 2, 2); | |
160 | } | |
161 | return err; | |
1da177e4 LT |
162 | } |
163 | ||
164 | static void __exit amijoy_exit(void) | |
165 | { | |
166 | int i; | |
167 | ||
168 | for (i = 0; i < 2; i++) | |
169 | if (amijoy[i]) { | |
17dd3f0f DT |
170 | input_unregister_device(amijoy_dev[i]); |
171 | release_mem_region(CUSTOM_PHYSADDR + 10 + i * 2, 2); | |
1da177e4 LT |
172 | } |
173 | } | |
174 | ||
175 | module_init(amijoy_init); | |
176 | module_exit(amijoy_exit); |