2 * $Id: spaceorb.c,v 1.7 2000/05/29 11:19:51 vojtech Exp $
4 * Copyright (c) 1999-2000 Vojtech Pavlik
6 * Based on the work of:
13 * SpaceTec SpaceOrb 360 and Avenger 6dof controller driver for Linux
17 * This program is free software; you can redistribute it and/or modify
18 * it under the terms of the GNU General Public License as published by
19 * the Free Software Foundation; either version 2 of the License, or
20 * (at your option) any later version.
22 * This program is distributed in the hope that it will be useful,
23 * but WITHOUT ANY WARRANTY; without even the implied warranty of
24 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
25 * GNU General Public License for more details.
27 * You should have received a copy of the GNU General Public License
28 * along with this program; if not, write to the Free Software
29 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
31 * Should you need to contact me, the author, you can do so either by
32 * e-mail - mail your message to <vojtech@suse.cz>, or by paper mail:
33 * Vojtech Pavlik, Ucitelska 1576, Prague 8, 182 00 Czech Republic
36 #include <linux/kernel.h>
37 #include <linux/malloc.h>
38 #include <linux/module.h>
39 #include <linux/init.h>
40 #include <linux/input.h>
41 #include <linux/serio.h>
47 #define SPACEORB_MAX_LENGTH 64
49 static int spaceorb_buttons
[] = { BTN_TL
, BTN_TR
, BTN_Y
, BTN_X
, BTN_B
, BTN_A
, BTN_MODE
};
50 static int spaceorb_axes
[] = { ABS_X
, ABS_Y
, ABS_Z
, ABS_RX
, ABS_RY
, ABS_RZ
};
51 static char *spaceorb_name
= "SpaceTec SpaceOrb 360";
61 unsigned char data
[SPACEORB_MAX_LENGTH
];
64 static unsigned char spaceorb_xor
[] = "SpaceWare";
66 static unsigned char *spaceorb_errors
[] = { "EEPROM storing 0 failed", "Receive queue overflow", "Transmit queue timeout",
67 "Bad packet", "Power brown-out", "EEPROM checksum error", "Hardware fault" };
70 * spaceorb_process_packet() decodes packets the driver receives from the
74 static void spaceorb_process_packet(struct spaceorb
*spaceorb
)
76 struct input_dev
*dev
= &spaceorb
->dev
;
77 unsigned char *data
= spaceorb
->data
;
82 if (spaceorb
->idx
< 2) return;
83 for (i
= 0; i
< spaceorb
->idx
; i
++) c
^= data
[i
];
88 case 'R': /* Reset packet */
89 spaceorb
->data
[spaceorb
->idx
- 1] = 0;
90 for (i
= 1; i
< spaceorb
->idx
&& spaceorb
->data
[i
] == ' '; i
++);
91 printk(KERN_INFO
"input%d: %s [%s] on serio%d\n",
92 spaceorb
->dev
.number
, spaceorb_name
, spaceorb
->data
+ i
, spaceorb
->serio
->number
);
95 case 'D': /* Ball + button data */
96 if (spaceorb
->idx
!= 12) return;
97 for (i
= 0; i
< 9; i
++) spaceorb
->data
[i
+2] ^= spaceorb_xor
[i
];
98 axes
[0] = ( data
[2] << 3) | (data
[ 3] >> 4);
99 axes
[1] = ((data
[3] & 0x0f) << 6) | (data
[ 4] >> 1);
100 axes
[2] = ((data
[4] & 0x01) << 9) | (data
[ 5] << 2) | (data
[4] >> 5);
101 axes
[3] = ((data
[6] & 0x1f) << 5) | (data
[ 7] >> 2);
102 axes
[4] = ((data
[7] & 0x03) << 8) | (data
[ 8] << 1) | (data
[7] >> 6);
103 axes
[5] = ((data
[9] & 0x3f) << 4) | (data
[10] >> 3);
104 for (i
= 0; i
< 6; i
++)
105 input_report_abs(dev
, spaceorb_axes
[i
], axes
[i
] - ((axes
[i
] & 0x200) ? 1024 : 0));
106 for (i
= 0; i
< 8; i
++)
107 input_report_key(dev
, spaceorb_buttons
[i
], (data
[1] >> i
) & 1);
110 case 'K': /* Button data */
111 if (spaceorb
->idx
!= 5) return;
112 for (i
= 0; i
< 7; i
++)
113 input_report_key(dev
, spaceorb_buttons
[i
], (data
[2] >> i
) & 1);
117 case 'E': /* Error packet */
118 if (spaceorb
->idx
!= 4) return;
119 printk(KERN_ERR
"joy-spaceorb: Device error. [ ");
120 for (i
= 0; i
< 7; i
++) if (data
[1] & (1 << i
)) printk("%s ", spaceorb_errors
[i
]);
126 static void spaceorb_interrupt(struct serio
*serio
, unsigned char data
, unsigned int flags
)
128 struct spaceorb
* spaceorb
= serio
->private;
131 if (spaceorb
->idx
) spaceorb_process_packet(spaceorb
);
134 if (spaceorb
->idx
< SPACEORB_MAX_LENGTH
)
135 spaceorb
->data
[spaceorb
->idx
++] = data
& 0x7f;
139 * spaceorb_disconnect() is the opposite of spaceorb_connect()
142 static void spaceorb_disconnect(struct serio
*serio
)
144 struct spaceorb
* spaceorb
= serio
->private;
145 input_unregister_device(&spaceorb
->dev
);
151 * spaceorb_connect() is the routine that is called when someone adds a
152 * new serio device. It looks for the SpaceOrb/Avenger, and if found, registers
153 * it as an input device.
156 static void spaceorb_connect(struct serio
*serio
, struct serio_dev
*dev
)
158 struct spaceorb
*spaceorb
;
161 if (serio
->type
!= (SERIO_RS232
| SERIO_SPACEORB
))
164 if (!(spaceorb
= kmalloc(sizeof(struct spaceorb
), GFP_KERNEL
)))
166 memset(spaceorb
, 0, sizeof(struct spaceorb
));
168 spaceorb
->dev
.evbit
[0] = BIT(EV_KEY
) | BIT(EV_ABS
);
170 for (i
= 0; i
< 7; i
++)
171 set_bit(spaceorb_buttons
[i
], &spaceorb
->dev
.keybit
);
173 for (i
= 0; i
< 6; i
++) {
174 t
= spaceorb_axes
[i
];
175 set_bit(t
, spaceorb
->dev
.absbit
);
176 spaceorb
->dev
.absmin
[t
] = -508;
177 spaceorb
->dev
.absmax
[t
] = 508;
180 spaceorb
->serio
= serio
;
181 spaceorb
->dev
.private = spaceorb
;
183 spaceorb
->dev
.name
= spaceorb_name
;
184 spaceorb
->dev
.idbus
= BUS_RS232
;
185 spaceorb
->dev
.idvendor
= SERIO_SPACEORB
;
186 spaceorb
->dev
.idproduct
= 0x0001;
187 spaceorb
->dev
.idversion
= 0x0100;
189 serio
->private = spaceorb
;
191 if (serio_open(serio
, dev
)) {
196 input_register_device(&spaceorb
->dev
);
200 * The serio device structure.
203 static struct serio_dev spaceorb_dev
= {
204 interrupt
: spaceorb_interrupt
,
205 connect
: spaceorb_connect
,
206 disconnect
: spaceorb_disconnect
,
210 * The functions for inserting/removing us as a module.
213 int __init
spaceorb_init(void)
215 serio_register_device(&spaceorb_dev
);
219 void __exit
spaceorb_exit(void)
221 serio_unregister_device(&spaceorb_dev
);
224 module_init(spaceorb_init
);
225 module_exit(spaceorb_exit
);