2 * $Id: cobra.c,v 1.19 2002/01/22 20:26:52 vojtech Exp $
4 * Copyright (c) 1999-2001 Vojtech Pavlik
8 * Creative Labs Blaster GamePad Cobra 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/module.h>
33 #include <linux/slab.h>
34 #include <linux/init.h>
35 #include <linux/gameport.h>
36 #include <linux/input.h>
38 #define DRIVER_DESC "Creative Labs Blaster GamePad Cobra driver"
40 MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
41 MODULE_DESCRIPTION(DRIVER_DESC
);
42 MODULE_LICENSE("GPL");
44 #define COBRA_MAX_STROBE 45 /* 45 us max wait for first strobe */
45 #define COBRA_LENGTH 36
47 static int cobra_btn
[] = { BTN_START
, BTN_SELECT
, BTN_TL
, BTN_TR
, BTN_X
, BTN_Y
, BTN_Z
, BTN_A
, BTN_B
, BTN_C
, BTN_TL2
, BTN_TR2
, 0 };
50 struct gameport
*gameport
;
51 struct input_dev
*dev
[2];
58 static unsigned char cobra_read_packet(struct gameport
*gameport
, unsigned int *data
)
61 unsigned char u
, v
, w
;
66 int strobe
= gameport_time(gameport
, COBRA_MAX_STROBE
);
68 for (i
= 0; i
< 2; i
++) {
70 t
[i
] = COBRA_MAX_STROBE
;
73 local_irq_save(flags
);
75 u
= gameport_read(gameport
);
79 v
= gameport_read(gameport
);
80 for (i
= 0, w
= u
^ v
; i
< 2 && w
; i
++, w
>>= 2)
82 if ((w
& 0x30) < 0x30 && r
[i
] < COBRA_LENGTH
&& t
[i
] > 0) {
83 buf
[i
] |= (__u64
)((w
>> 5) & 1) << r
[i
]++;
88 } while (t
[0] > 0 || t
[1] > 0);
90 local_irq_restore(flags
);
94 for (i
= 0; i
< 2; i
++) {
96 if (r
[i
] != COBRA_LENGTH
) continue;
98 for (j
= 0; j
< COBRA_LENGTH
&& (buf
[i
] & 0x04104107f) ^ 0x041041040; j
++)
99 buf
[i
] = (buf
[i
] >> 1) | ((__u64
)(buf
[i
] & 1) << (COBRA_LENGTH
- 1));
101 if (j
< COBRA_LENGTH
) ret
|= (1 << i
);
103 data
[i
] = ((buf
[i
] >> 7) & 0x000001f) | ((buf
[i
] >> 8) & 0x00003e0)
104 | ((buf
[i
] >> 9) & 0x0007c00) | ((buf
[i
] >> 10) & 0x00f8000)
105 | ((buf
[i
] >> 11) & 0x1f00000);
112 static void cobra_poll(struct gameport
*gameport
)
114 struct cobra
*cobra
= gameport_get_drvdata(gameport
);
115 struct input_dev
*dev
;
116 unsigned int data
[2];
121 if ((r
= cobra_read_packet(gameport
, data
)) != cobra
->exists
) {
126 for (i
= 0; i
< 2; i
++)
127 if (cobra
->exists
& r
& (1 << i
)) {
131 input_report_abs(dev
, ABS_X
, ((data
[i
] >> 4) & 1) - ((data
[i
] >> 3) & 1));
132 input_report_abs(dev
, ABS_Y
, ((data
[i
] >> 2) & 1) - ((data
[i
] >> 1) & 1));
134 for (j
= 0; cobra_btn
[j
]; j
++)
135 input_report_key(dev
, cobra_btn
[j
], data
[i
] & (0x20 << j
));
142 static int cobra_open(struct input_dev
*dev
)
144 struct cobra
*cobra
= dev
->private;
146 gameport_start_polling(cobra
->gameport
);
150 static void cobra_close(struct input_dev
*dev
)
152 struct cobra
*cobra
= dev
->private;
154 gameport_stop_polling(cobra
->gameport
);
157 static int cobra_connect(struct gameport
*gameport
, struct gameport_driver
*drv
)
160 struct input_dev
*input_dev
;
161 unsigned int data
[2];
165 cobra
= kzalloc(sizeof(struct cobra
), GFP_KERNEL
);
169 cobra
->gameport
= gameport
;
171 gameport_set_drvdata(gameport
, cobra
);
173 err
= gameport_open(gameport
, drv
, GAMEPORT_MODE_RAW
);
177 cobra
->exists
= cobra_read_packet(gameport
, data
);
179 for (i
= 0; i
< 2; i
++)
180 if ((cobra
->exists
>> i
) & data
[i
] & 1) {
181 printk(KERN_WARNING
"cobra.c: Device %d on %s has the Ext bit set. ID is: %d"
182 " Contact vojtech@ucw.cz\n", i
, gameport
->phys
, (data
[i
] >> 2) & 7);
183 cobra
->exists
&= ~(1 << i
);
186 if (!cobra
->exists
) {
191 gameport_set_poll_handler(gameport
, cobra_poll
);
192 gameport_set_poll_interval(gameport
, 20);
194 for (i
= 0; i
< 2; i
++) {
195 if (~(cobra
->exists
>> i
) & 1)
198 cobra
->dev
[i
] = input_dev
= input_allocate_device();
204 sprintf(cobra
->phys
[i
], "%s/input%d", gameport
->phys
, i
);
206 input_dev
->name
= "Creative Labs Blaster GamePad Cobra";
207 input_dev
->phys
= cobra
->phys
[i
];
208 input_dev
->id
.bustype
= BUS_GAMEPORT
;
209 input_dev
->id
.vendor
= GAMEPORT_ID_VENDOR_CREATIVE
;
210 input_dev
->id
.product
= 0x0008;
211 input_dev
->id
.version
= 0x0100;
212 input_dev
->cdev
.dev
= &gameport
->dev
;
213 input_dev
->private = cobra
;
215 input_dev
->open
= cobra_open
;
216 input_dev
->close
= cobra_close
;
218 input_dev
->evbit
[0] = BIT(EV_KEY
) | BIT(EV_ABS
);
219 input_set_abs_params(input_dev
, ABS_X
, -1, 1, 0, 0);
220 input_set_abs_params(input_dev
, ABS_Y
, -1, 1, 0, 0);
221 for (j
= 0; cobra_btn
[j
]; j
++)
222 set_bit(cobra_btn
[j
], input_dev
->keybit
);
224 input_register_device(cobra
->dev
[i
]);
229 fail3
: for (i
= 0; i
< 2; i
++)
231 input_unregister_device(cobra
->dev
[i
]);
232 fail2
: gameport_close(gameport
);
233 fail1
: gameport_set_drvdata(gameport
, NULL
);
238 static void cobra_disconnect(struct gameport
*gameport
)
240 struct cobra
*cobra
= gameport_get_drvdata(gameport
);
243 for (i
= 0; i
< 2; i
++)
244 if ((cobra
->exists
>> i
) & 1)
245 input_unregister_device(cobra
->dev
[i
]);
246 gameport_close(gameport
);
247 gameport_set_drvdata(gameport
, NULL
);
251 static struct gameport_driver cobra_drv
= {
255 .description
= DRIVER_DESC
,
256 .connect
= cobra_connect
,
257 .disconnect
= cobra_disconnect
,
260 static int __init
cobra_init(void)
262 gameport_register_driver(&cobra_drv
);
266 static void __exit
cobra_exit(void)
268 gameport_unregister_driver(&cobra_drv
);
271 module_init(cobra_init
);
272 module_exit(cobra_exit
);