194 lines
4.5 KiB
C
194 lines
4.5 KiB
C
/*
|
|
* $Id: iforce-serio.c,v 1.4 2002/01/28 22:45:00 jdeneux Exp $
|
|
*
|
|
* Copyright (c) 2000-2001 Vojtech Pavlik <vojtech@ucw.cz>
|
|
* Copyright (c) 2001 Johann Deneux <deneux@ifrance.com>
|
|
*
|
|
* USB/RS232 I-Force joysticks and wheels.
|
|
*/
|
|
|
|
/*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*
|
|
* Should you need to contact me, the author, you can do so either by
|
|
* e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
|
|
* Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
|
|
*/
|
|
|
|
#include "iforce.h"
|
|
|
|
void iforce_serial_xmit(struct iforce *iforce)
|
|
{
|
|
unsigned char cs;
|
|
int i;
|
|
unsigned long flags;
|
|
|
|
if (test_and_set_bit(IFORCE_XMIT_RUNNING, iforce->xmit_flags)) {
|
|
set_bit(IFORCE_XMIT_AGAIN, iforce->xmit_flags);
|
|
return;
|
|
}
|
|
|
|
spin_lock_irqsave(&iforce->xmit_lock, flags);
|
|
|
|
again:
|
|
if (iforce->xmit.head == iforce->xmit.tail) {
|
|
clear_bit(IFORCE_XMIT_RUNNING, iforce->xmit_flags);
|
|
spin_unlock_irqrestore(&iforce->xmit_lock, flags);
|
|
return;
|
|
}
|
|
|
|
cs = 0x2b;
|
|
|
|
serio_write(iforce->serio, 0x2b);
|
|
|
|
serio_write(iforce->serio, iforce->xmit.buf[iforce->xmit.tail]);
|
|
cs ^= iforce->xmit.buf[iforce->xmit.tail];
|
|
XMIT_INC(iforce->xmit.tail, 1);
|
|
|
|
for (i=iforce->xmit.buf[iforce->xmit.tail]; i >= 0; --i) {
|
|
serio_write(iforce->serio, iforce->xmit.buf[iforce->xmit.tail]);
|
|
cs ^= iforce->xmit.buf[iforce->xmit.tail];
|
|
XMIT_INC(iforce->xmit.tail, 1);
|
|
}
|
|
|
|
serio_write(iforce->serio, cs);
|
|
|
|
if (test_and_clear_bit(IFORCE_XMIT_AGAIN, iforce->xmit_flags))
|
|
goto again;
|
|
|
|
clear_bit(IFORCE_XMIT_RUNNING, iforce->xmit_flags);
|
|
|
|
spin_unlock_irqrestore(&iforce->xmit_lock, flags);
|
|
}
|
|
|
|
static void iforce_serio_write_wakeup(struct serio *serio)
|
|
{
|
|
struct iforce *iforce = serio_get_drvdata(serio);
|
|
|
|
iforce_serial_xmit(iforce);
|
|
}
|
|
|
|
static irqreturn_t iforce_serio_irq(struct serio *serio,
|
|
unsigned char data, unsigned int flags)
|
|
{
|
|
struct iforce *iforce = serio_get_drvdata(serio);
|
|
|
|
if (!iforce->pkt) {
|
|
if (data == 0x2b)
|
|
iforce->pkt = 1;
|
|
goto out;
|
|
}
|
|
|
|
if (!iforce->id) {
|
|
if (data > 3 && data != 0xff)
|
|
iforce->pkt = 0;
|
|
else
|
|
iforce->id = data;
|
|
goto out;
|
|
}
|
|
|
|
if (!iforce->len) {
|
|
if (data > IFORCE_MAX_LENGTH) {
|
|
iforce->pkt = 0;
|
|
iforce->id = 0;
|
|
} else {
|
|
iforce->len = data;
|
|
}
|
|
goto out;
|
|
}
|
|
|
|
if (iforce->idx < iforce->len) {
|
|
iforce->csum += iforce->data[iforce->idx++] = data;
|
|
goto out;
|
|
}
|
|
|
|
if (iforce->idx == iforce->len) {
|
|
iforce_process_packet(iforce, (iforce->id << 8) | iforce->idx, iforce->data);
|
|
iforce->pkt = 0;
|
|
iforce->id = 0;
|
|
iforce->len = 0;
|
|
iforce->idx = 0;
|
|
iforce->csum = 0;
|
|
}
|
|
out:
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static int iforce_serio_connect(struct serio *serio, struct serio_driver *drv)
|
|
{
|
|
struct iforce *iforce;
|
|
int err;
|
|
|
|
iforce = kzalloc(sizeof(struct iforce), GFP_KERNEL);
|
|
if (!iforce)
|
|
return -ENOMEM;
|
|
|
|
iforce->bus = IFORCE_232;
|
|
iforce->serio = serio;
|
|
|
|
serio_set_drvdata(serio, iforce);
|
|
|
|
err = serio_open(serio, drv);
|
|
if (err) {
|
|
serio_set_drvdata(serio, NULL);
|
|
kfree(iforce);
|
|
return err;
|
|
}
|
|
|
|
err = iforce_init_device(iforce);
|
|
if (err) {
|
|
serio_close(serio);
|
|
serio_set_drvdata(serio, NULL);
|
|
kfree(iforce);
|
|
return -ENODEV;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void iforce_serio_disconnect(struct serio *serio)
|
|
{
|
|
struct iforce *iforce = serio_get_drvdata(serio);
|
|
|
|
input_unregister_device(iforce->dev);
|
|
serio_close(serio);
|
|
serio_set_drvdata(serio, NULL);
|
|
kfree(iforce);
|
|
}
|
|
|
|
static struct serio_device_id iforce_serio_ids[] = {
|
|
{
|
|
.type = SERIO_RS232,
|
|
.proto = SERIO_IFORCE,
|
|
.id = SERIO_ANY,
|
|
.extra = SERIO_ANY,
|
|
},
|
|
{ 0 }
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(serio, iforce_serio_ids);
|
|
|
|
struct serio_driver iforce_serio_drv = {
|
|
.driver = {
|
|
.name = "iforce",
|
|
},
|
|
.description = "RS232 I-Force joysticks and wheels driver",
|
|
.id_table = iforce_serio_ids,
|
|
.write_wakeup = iforce_serio_write_wakeup,
|
|
.interrupt = iforce_serio_irq,
|
|
.connect = iforce_serio_connect,
|
|
.disconnect = iforce_serio_disconnect,
|
|
};
|