2 * $Id: guillemot.c,v 1.10 2002/01/22 20:28:12 vojtech Exp $
4 * Copyright (c) 2001 Vojtech Pavlik
8 * Guillemot Digital Interface Protocol driver for Linux
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.
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.
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
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
31 #include <linux/kernel.h>
32 #include <linux/slab.h>
33 #include <linux/module.h>
34 #include <linux/delay.h>
35 #include <linux/init.h>
36 #include <linux/gameport.h>
37 #include <linux/input.h>
38 #include <linux/jiffies.h>
40 #define DRIVER_DESC "Guillemot Digital joystick driver"
42 MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
43 MODULE_DESCRIPTION(DRIVER_DESC
);
44 MODULE_LICENSE("GPL");
46 #define GUILLEMOT_MAX_START 600 /* 600 us */
47 #define GUILLEMOT_MAX_STROBE 60 /* 60 us */
48 #define GUILLEMOT_MAX_LENGTH 17 /* 17 bytes */
50 static short guillemot_abs_pad
[] =
51 { ABS_X
, ABS_Y
, ABS_THROTTLE
, ABS_RUDDER
, -1 };
53 static short guillemot_btn_pad
[] =
54 { BTN_A
, BTN_B
, BTN_C
, BTN_X
, BTN_Y
, BTN_Z
, BTN_TL
, BTN_TR
, BTN_MODE
, BTN_SELECT
, -1 };
59 } guillemot_hat_to_axis
[16] = {{ 0,-1}, { 1,-1}, { 1, 0}, { 1, 1}, { 0, 1}, {-1, 1}, {-1, 0}, {-1,-1}};
61 struct guillemot_type
{
70 struct gameport
*gameport
;
71 struct input_dev
*dev
;
74 struct guillemot_type
*type
;
79 static struct guillemot_type guillemot_type
[] = {
80 { 0x00, guillemot_abs_pad
, guillemot_btn_pad
, 1, "Guillemot Pad" },
84 * guillemot_read_packet() reads Guillemot joystick data.
87 static int guillemot_read_packet(struct gameport
*gameport
, u8
*data
)
94 for (i
= 0; i
< GUILLEMOT_MAX_LENGTH
; i
++)
98 t
= gameport_time(gameport
, GUILLEMOT_MAX_START
);
99 s
= gameport_time(gameport
, GUILLEMOT_MAX_STROBE
);
101 local_irq_save(flags
);
102 gameport_trigger(gameport
);
103 v
= gameport_read(gameport
);
105 while (t
> 0 && i
< GUILLEMOT_MAX_LENGTH
* 8) {
107 u
= v
; v
= gameport_read(gameport
);
109 data
[i
>> 3] |= ((v
>> 5) & 1) << (i
& 7);
115 local_irq_restore(flags
);
121 * guillemot_poll() reads and analyzes Guillemot joystick data.
124 static void guillemot_poll(struct gameport
*gameport
)
126 struct guillemot
*guillemot
= gameport_get_drvdata(gameport
);
127 struct input_dev
*dev
= guillemot
->dev
;
128 u8 data
[GUILLEMOT_MAX_LENGTH
];
133 if (guillemot_read_packet(guillemot
->gameport
, data
) != GUILLEMOT_MAX_LENGTH
* 8 ||
134 data
[0] != 0x55 || data
[16] != 0xaa) {
138 for (i
= 0; i
< 6 && guillemot
->type
->abs
[i
] >= 0; i
++)
139 input_report_abs(dev
, guillemot
->type
->abs
[i
], data
[i
+ 5]);
141 if (guillemot
->type
->hat
) {
142 input_report_abs(dev
, ABS_HAT0X
, guillemot_hat_to_axis
[data
[4] >> 4].x
);
143 input_report_abs(dev
, ABS_HAT0Y
, guillemot_hat_to_axis
[data
[4] >> 4].y
);
146 for (i
= 0; i
< 16 && guillemot
->type
->btn
[i
] >= 0; i
++)
147 input_report_key(dev
, guillemot
->type
->btn
[i
], (data
[2 + (i
>> 3)] >> (i
& 7)) & 1);
154 * guillemot_open() is a callback from the input open routine.
157 static int guillemot_open(struct input_dev
*dev
)
159 struct guillemot
*guillemot
= dev
->private;
161 gameport_start_polling(guillemot
->gameport
);
166 * guillemot_close() is a callback from the input close routine.
169 static void guillemot_close(struct input_dev
*dev
)
171 struct guillemot
*guillemot
= dev
->private;
173 gameport_stop_polling(guillemot
->gameport
);
177 * guillemot_connect() probes for Guillemot joysticks.
180 static int guillemot_connect(struct gameport
*gameport
, struct gameport_driver
*drv
)
182 struct guillemot
*guillemot
;
183 struct input_dev
*input_dev
;
184 u8 data
[GUILLEMOT_MAX_LENGTH
];
188 guillemot
= kzalloc(sizeof(struct guillemot
), GFP_KERNEL
);
189 input_dev
= input_allocate_device();
190 if (!guillemot
|| !input_dev
) {
195 guillemot
->gameport
= gameport
;
196 guillemot
->dev
= input_dev
;
198 gameport_set_drvdata(gameport
, guillemot
);
200 err
= gameport_open(gameport
, drv
, GAMEPORT_MODE_RAW
);
204 i
= guillemot_read_packet(gameport
, data
);
206 if (i
!= GUILLEMOT_MAX_LENGTH
* 8 || data
[0] != 0x55 || data
[16] != 0xaa) {
211 for (i
= 0; guillemot_type
[i
].name
; i
++)
212 if (guillemot_type
[i
].id
== data
[11])
215 if (!guillemot_type
[i
].name
) {
216 printk(KERN_WARNING
"guillemot.c: Unknown joystick on %s. [ %02x%02x:%04x, ver %d.%02d ]\n",
217 gameport
->phys
, data
[12], data
[13], data
[11], data
[14], data
[15]);
222 gameport_set_poll_handler(gameport
, guillemot_poll
);
223 gameport_set_poll_interval(gameport
, 20);
225 snprintf(guillemot
->phys
, sizeof(guillemot
->phys
), "%s/input0", gameport
->phys
);
226 guillemot
->type
= guillemot_type
+ i
;
228 input_dev
->name
= guillemot_type
[i
].name
;
229 input_dev
->phys
= guillemot
->phys
;
230 input_dev
->id
.bustype
= BUS_GAMEPORT
;
231 input_dev
->id
.vendor
= GAMEPORT_ID_VENDOR_GUILLEMOT
;
232 input_dev
->id
.product
= guillemot_type
[i
].id
;
233 input_dev
->id
.version
= (int)data
[14] << 8 | data
[15];
234 input_dev
->cdev
.dev
= &gameport
->dev
;
235 input_dev
->private = guillemot
;
237 input_dev
->open
= guillemot_open
;
238 input_dev
->close
= guillemot_close
;
240 input_dev
->evbit
[0] = BIT(EV_KEY
) | BIT(EV_ABS
);
242 for (i
= 0; (t
= guillemot
->type
->abs
[i
]) >= 0; i
++)
243 input_set_abs_params(input_dev
, t
, 0, 255, 0, 0);
245 if (guillemot
->type
->hat
) {
246 input_set_abs_params(input_dev
, ABS_HAT0X
, -1, 1, 0, 0);
247 input_set_abs_params(input_dev
, ABS_HAT0Y
, -1, 1, 0, 0);
250 for (i
= 0; (t
= guillemot
->type
->btn
[i
]) >= 0; i
++)
251 set_bit(t
, input_dev
->keybit
);
253 input_register_device(guillemot
->dev
);
257 fail2
: gameport_close(gameport
);
258 fail1
: gameport_set_drvdata(gameport
, NULL
);
259 input_free_device(input_dev
);
264 static void guillemot_disconnect(struct gameport
*gameport
)
266 struct guillemot
*guillemot
= gameport_get_drvdata(gameport
);
268 printk(KERN_INFO
"guillemot.c: Failed %d reads out of %d on %s\n", guillemot
->reads
, guillemot
->bads
, guillemot
->phys
);
269 input_unregister_device(guillemot
->dev
);
270 gameport_close(gameport
);
274 static struct gameport_driver guillemot_drv
= {
278 .description
= DRIVER_DESC
,
279 .connect
= guillemot_connect
,
280 .disconnect
= guillemot_disconnect
,
283 static int __init
guillemot_init(void)
285 gameport_register_driver(&guillemot_drv
);
289 static void __exit
guillemot_exit(void)
291 gameport_unregister_driver(&guillemot_drv
);
294 module_init(guillemot_init
);
295 module_exit(guillemot_exit
);