Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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> |
| 39 | |
| 40 | #include <asm/system.h> |
| 41 | #include <asm/amigahw.h> |
| 42 | #include <asm/amigaints.h> |
| 43 | |
| 44 | MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); |
| 45 | MODULE_DESCRIPTION("Driver for Amiga joysticks"); |
| 46 | MODULE_LICENSE("GPL"); |
| 47 | |
| 48 | static int amijoy[2] = { 0, 1 }; |
| 49 | module_param_array_named(map, amijoy, uint, NULL, 0); |
| 50 | MODULE_PARM_DESC(map, "Map of attached joysticks in form of <a>,<b> (default is 0,1)"); |
| 51 | |
| 52 | __obsolete_setup("amijoy="); |
| 53 | |
Dmitry Torokhov | 8b1a198 | 2005-05-29 02:29:52 -0500 | [diff] [blame^] | 54 | static int amijoy_used; |
| 55 | static DECLARE_MUTEX(amijoy_sem); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 56 | static struct input_dev amijoy_dev[2]; |
| 57 | static char *amijoy_phys[2] = { "amijoy/input0", "amijoy/input1" }; |
| 58 | |
| 59 | static char *amijoy_name = "Amiga joystick"; |
| 60 | |
| 61 | static irqreturn_t amijoy_interrupt(int irq, void *dummy, struct pt_regs *fp) |
| 62 | { |
| 63 | int i, data = 0, button = 0; |
| 64 | |
| 65 | for (i = 0; i < 2; i++) |
| 66 | if (amijoy[i]) { |
| 67 | |
| 68 | switch (i) { |
| 69 | case 0: data = ~custom.joy0dat; button = (~ciaa.pra >> 6) & 1; break; |
| 70 | case 1: data = ~custom.joy1dat; button = (~ciaa.pra >> 7) & 1; break; |
| 71 | } |
| 72 | |
| 73 | input_regs(amijoy_dev + i, fp); |
| 74 | |
| 75 | input_report_key(amijoy_dev + i, BTN_TRIGGER, button); |
| 76 | |
| 77 | input_report_abs(amijoy_dev + i, ABS_X, ((data >> 1) & 1) - ((data >> 9) & 1)); |
| 78 | data = ~(data ^ (data << 1)); |
| 79 | input_report_abs(amijoy_dev + i, ABS_Y, ((data >> 1) & 1) - ((data >> 9) & 1)); |
| 80 | |
| 81 | input_sync(amijoy_dev + i); |
| 82 | } |
| 83 | return IRQ_HANDLED; |
| 84 | } |
| 85 | |
| 86 | static int amijoy_open(struct input_dev *dev) |
| 87 | { |
Dmitry Torokhov | 8b1a198 | 2005-05-29 02:29:52 -0500 | [diff] [blame^] | 88 | int err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 | |
Dmitry Torokhov | 8b1a198 | 2005-05-29 02:29:52 -0500 | [diff] [blame^] | 90 | err = down_interruptible(&amijoy_sem); |
| 91 | if (err) |
| 92 | return err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 93 | |
Dmitry Torokhov | 8b1a198 | 2005-05-29 02:29:52 -0500 | [diff] [blame^] | 94 | if (!amijoy_used && request_irq(IRQ_AMIGA_VERTB, amijoy_interrupt, 0, "amijoy", amijoy_interrupt)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 95 | printk(KERN_ERR "amijoy.c: Can't allocate irq %d\n", IRQ_AMIGA_VERTB); |
Dmitry Torokhov | 8b1a198 | 2005-05-29 02:29:52 -0500 | [diff] [blame^] | 96 | err = -EBUSY; |
| 97 | goto out; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 98 | } |
| 99 | |
Dmitry Torokhov | 8b1a198 | 2005-05-29 02:29:52 -0500 | [diff] [blame^] | 100 | amijoy_used++; |
| 101 | out: |
| 102 | up(&amijoy_sem); |
| 103 | return err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 | } |
| 105 | |
| 106 | static void amijoy_close(struct input_dev *dev) |
| 107 | { |
Dmitry Torokhov | 8b1a198 | 2005-05-29 02:29:52 -0500 | [diff] [blame^] | 108 | down(&amijoysem); |
| 109 | if (!--amijoy_used) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 110 | free_irq(IRQ_AMIGA_VERTB, amijoy_interrupt); |
Dmitry Torokhov | 8b1a198 | 2005-05-29 02:29:52 -0500 | [diff] [blame^] | 111 | up(&amijoy_sem); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 | } |
| 113 | |
| 114 | static int __init amijoy_init(void) |
| 115 | { |
| 116 | int i, j; |
| 117 | |
| 118 | for (i = 0; i < 2; i++) |
| 119 | if (amijoy[i]) { |
| 120 | if (!request_mem_region(CUSTOM_PHYSADDR+10+i*2, 2, |
| 121 | "amijoy [Denise]")) { |
| 122 | if (i == 1 && amijoy[0]) { |
| 123 | input_unregister_device(amijoy_dev); |
| 124 | release_mem_region(CUSTOM_PHYSADDR+10, 2); |
| 125 | } |
| 126 | return -EBUSY; |
| 127 | } |
| 128 | |
| 129 | amijoy_dev[i].open = amijoy_open; |
| 130 | amijoy_dev[i].close = amijoy_close; |
| 131 | amijoy_dev[i].evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); |
| 132 | amijoy_dev[i].absbit[0] = BIT(ABS_X) | BIT(ABS_Y); |
| 133 | amijoy_dev[i].keybit[LONG(BTN_LEFT)] = BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT); |
| 134 | for (j = 0; j < 2; j++) { |
| 135 | amijoy_dev[i].absmin[ABS_X + j] = -1; |
| 136 | amijoy_dev[i].absmax[ABS_X + j] = 1; |
| 137 | } |
| 138 | |
| 139 | amijoy_dev[i].name = amijoy_name; |
| 140 | amijoy_dev[i].phys = amijoy_phys[i]; |
| 141 | amijoy_dev[i].id.bustype = BUS_AMIGA; |
| 142 | amijoy_dev[i].id.vendor = 0x0001; |
| 143 | amijoy_dev[i].id.product = 0x0003; |
| 144 | amijoy_dev[i].id.version = 0x0100; |
| 145 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 146 | input_register_device(amijoy_dev + i); |
| 147 | printk(KERN_INFO "input: %s at joy%ddat\n", amijoy_name, i); |
| 148 | } |
| 149 | return 0; |
| 150 | } |
| 151 | |
| 152 | static void __exit amijoy_exit(void) |
| 153 | { |
| 154 | int i; |
| 155 | |
| 156 | for (i = 0; i < 2; i++) |
| 157 | if (amijoy[i]) { |
| 158 | input_unregister_device(amijoy_dev + i); |
| 159 | release_mem_region(CUSTOM_PHYSADDR+10+i*2, 2); |
| 160 | } |
| 161 | } |
| 162 | |
| 163 | module_init(amijoy_init); |
| 164 | module_exit(amijoy_exit); |