1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * Copyright (c) 2000-2001 Vojtech Pavlik <vojtech@ucw.cz>
4 * Copyright (c) 2001, 2007 Johann Deneux <johann.deneux@gmail.com>
6 * USB/RS232 I-Force joysticks and wheels.
14 void iforce_serial_xmit(struct iforce *iforce)
20 if (test_and_set_bit(IFORCE_XMIT_RUNNING, iforce->xmit_flags)) {
21 set_bit(IFORCE_XMIT_AGAIN, iforce->xmit_flags);
25 spin_lock_irqsave(&iforce->xmit_lock, flags);
28 if (iforce->xmit.head == iforce->xmit.tail) {
29 clear_bit(IFORCE_XMIT_RUNNING, iforce->xmit_flags);
30 spin_unlock_irqrestore(&iforce->xmit_lock, flags);
36 serio_write(iforce->serio, 0x2b);
38 serio_write(iforce->serio, iforce->xmit.buf[iforce->xmit.tail]);
39 cs ^= iforce->xmit.buf[iforce->xmit.tail];
40 XMIT_INC(iforce->xmit.tail, 1);
42 for (i=iforce->xmit.buf[iforce->xmit.tail]; i >= 0; --i) {
43 serio_write(iforce->serio, iforce->xmit.buf[iforce->xmit.tail]);
44 cs ^= iforce->xmit.buf[iforce->xmit.tail];
45 XMIT_INC(iforce->xmit.tail, 1);
48 serio_write(iforce->serio, cs);
50 if (test_and_clear_bit(IFORCE_XMIT_AGAIN, iforce->xmit_flags))
53 clear_bit(IFORCE_XMIT_RUNNING, iforce->xmit_flags);
55 spin_unlock_irqrestore(&iforce->xmit_lock, flags);
58 static void iforce_serio_write_wakeup(struct serio *serio)
60 struct iforce *iforce = serio_get_drvdata(serio);
62 iforce_serial_xmit(iforce);
65 static irqreturn_t iforce_serio_irq(struct serio *serio,
66 unsigned char data, unsigned int flags)
68 struct iforce *iforce = serio_get_drvdata(serio);
77 if (data > 3 && data != 0xff)
85 if (data > IFORCE_MAX_LENGTH) {
94 if (iforce->idx < iforce->len) {
95 iforce->csum += iforce->data[iforce->idx++] = data;
99 if (iforce->idx == iforce->len) {
100 iforce_process_packet(iforce, (iforce->id << 8) | iforce->idx, iforce->data);
111 static int iforce_serio_connect(struct serio *serio, struct serio_driver *drv)
113 struct iforce *iforce;
116 iforce = kzalloc(sizeof(struct iforce), GFP_KERNEL);
120 iforce->bus = IFORCE_232;
121 iforce->serio = serio;
123 serio_set_drvdata(serio, iforce);
125 err = serio_open(serio, drv);
129 err = iforce_init_device(iforce);
135 fail2: serio_close(serio);
136 fail1: serio_set_drvdata(serio, NULL);
141 static void iforce_serio_disconnect(struct serio *serio)
143 struct iforce *iforce = serio_get_drvdata(serio);
145 input_unregister_device(iforce->dev);
147 serio_set_drvdata(serio, NULL);
151 static const struct serio_device_id iforce_serio_ids[] = {
154 .proto = SERIO_IFORCE,
161 MODULE_DEVICE_TABLE(serio, iforce_serio_ids);
163 struct serio_driver iforce_serio_drv = {
167 .description = "RS232 I-Force joysticks and wheels driver",
168 .id_table = iforce_serio_ids,
169 .write_wakeup = iforce_serio_write_wakeup,
170 .interrupt = iforce_serio_irq,
171 .connect = iforce_serio_connect,
172 .disconnect = iforce_serio_disconnect,