1 // SPDX-License-Identifier: GPL-2.0-or-later
3  *  Copyright (c) 2000-2001 Vojtech Pavlik <vojtech@ucw.cz>
6  *  USB/RS232 I-Force joysticks and wheels.
29 	unsigned char cs;  in iforce_serio_xmit()  local
32 	if (test_and_set_bit(IFORCE_XMIT_RUNNING, iforce->xmit_flags)) {  in iforce_serio_xmit()
33 		set_bit(IFORCE_XMIT_AGAIN, iforce->xmit_flags);  in iforce_serio_xmit()
37 	guard(spinlock_irqsave)(&iforce->xmit_lock);  in iforce_serio_xmit()
40 		if (iforce->xmit.head == iforce->xmit.tail)  in iforce_serio_xmit()
43 		cs = 0x2b;  in iforce_serio_xmit()
45 		serio_write(iforce_serio->serio, 0x2b);  in iforce_serio_xmit()
47 		serio_write(iforce_serio->serio,  in iforce_serio_xmit()
48 			    iforce->xmit.buf[iforce->xmit.tail]);  in iforce_serio_xmit()
49 		cs ^= iforce->xmit.buf[iforce->xmit.tail];  in iforce_serio_xmit()
50 		XMIT_INC(iforce->xmit.tail, 1);  in iforce_serio_xmit()
52 		for (i = iforce->xmit.buf[iforce->xmit.tail]; i >= 0; --i) {  in iforce_serio_xmit()
53 			serio_write(iforce_serio->serio,  in iforce_serio_xmit()
54 				    iforce->xmit.buf[iforce->xmit.tail]);  in iforce_serio_xmit()
55 			cs ^= iforce->xmit.buf[iforce->xmit.tail];  in iforce_serio_xmit()
56 			XMIT_INC(iforce->xmit.tail, 1);  in iforce_serio_xmit()
59 		serio_write(iforce_serio->serio, cs);  in iforce_serio_xmit()
61 	} while (test_and_clear_bit(IFORCE_XMIT_AGAIN, iforce->xmit_flags));  in iforce_serio_xmit()
73 	iforce_serio->expect_packet = HI(FF_CMD_QUERY);  in iforce_serio_get_id()
74 	iforce_serio->cmd_response_len = 0;  in iforce_serio_get_id()
78 	wait_event_interruptible_timeout(iforce->wait,  in iforce_serio_get_id()
79 					 !iforce_serio->expect_packet, HZ);  in iforce_serio_get_id()
81 	if (iforce_serio->expect_packet) {  in iforce_serio_get_id()
82 		iforce_serio->expect_packet = 0;  in iforce_serio_get_id()
83 		return -ETIMEDOUT;  in iforce_serio_get_id()
86 	if (iforce_serio->cmd_response[0] != id)  in iforce_serio_get_id()
87 		return -EIO;  in iforce_serio_get_id()
89 	memcpy(response_data, iforce_serio->cmd_response,  in iforce_serio_get_id()
90 	       iforce_serio->cmd_response_len);  in iforce_serio_get_id()
91 	*response_len = iforce_serio->cmd_response_len;  in iforce_serio_get_id()
125 	struct iforce *iforce = &iforce_serio->iforce;  in iforce_serio_irq()
127 	if (!iforce_serio->pkt) {  in iforce_serio_irq()
129 			iforce_serio->pkt = 1;  in iforce_serio_irq()
130 		goto out;  in iforce_serio_irq()
133 	if (!iforce_serio->id) {  in iforce_serio_irq()
135 			iforce_serio->pkt = 0;  in iforce_serio_irq()
137 			iforce_serio->id = data;  in iforce_serio_irq()
138 		goto out;  in iforce_serio_irq()
141 	if (!iforce_serio->len) {  in iforce_serio_irq()
143 			iforce_serio->pkt = 0;  in iforce_serio_irq()
144 			iforce_serio->id = 0;  in iforce_serio_irq()
146 			iforce_serio->len = data;  in iforce_serio_irq()
148 		goto out;  in iforce_serio_irq()
151 	if (iforce_serio->idx < iforce_serio->len) {  in iforce_serio_irq()
152 		iforce_serio->data_in[iforce_serio->idx++] = data;  in iforce_serio_irq()
153 		iforce_serio->csum += data;  in iforce_serio_irq()
154 		goto out;  in iforce_serio_irq()
157 	if (iforce_serio->idx == iforce_serio->len) {  in iforce_serio_irq()
159 		if (iforce_serio->expect_packet == iforce_serio->id) {  in iforce_serio_irq()
160 			iforce_serio->expect_packet = 0;  in iforce_serio_irq()
161 			memcpy(iforce_serio->cmd_response,  in iforce_serio_irq()
162 			       iforce_serio->data_in, IFORCE_MAX_LENGTH);  in iforce_serio_irq()
163 			iforce_serio->cmd_response_len = iforce_serio->len;  in iforce_serio_irq()
166 			wake_up_all(&iforce->wait);  in iforce_serio_irq()
167 		} else if (likely(iforce->type)) {  in iforce_serio_irq()
168 			iforce_process_packet(iforce, iforce_serio->id,  in iforce_serio_irq()
169 					      iforce_serio->data_in,  in iforce_serio_irq()
170 					      iforce_serio->len);  in iforce_serio_irq()
173 		iforce_serio->pkt = 0;  in iforce_serio_irq()
174 		iforce_serio->id  = 0;  in iforce_serio_irq()
175 		iforce_serio->len = 0;  in iforce_serio_irq()
176 		iforce_serio->idx = 0;  in iforce_serio_irq()
177 		iforce_serio->csum = 0;  in iforce_serio_irq()
179 out:  in iforce_serio_irq()
190 		return -ENOMEM;  in iforce_serio_connect()
192 	iforce_serio->iforce.xport_ops = &iforce_serio_xport_ops;  in iforce_serio_connect()
194 	iforce_serio->serio = serio;  in iforce_serio_connect()
201 	err = iforce_init_device(&serio->dev, BUS_RS232, &iforce_serio->iforce);  in iforce_serio_connect()
217 	input_unregister_device(iforce_serio->iforce.dev);  in iforce_serio_disconnect()
239 	.description	= "RS232 I-Force joysticks and wheels driver",
250 MODULE_DESCRIPTION("RS232 I-Force joysticks and wheels driver");