Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
iforce-serio.c
Go to the documentation of this file.
1 /*
2  * Copyright (c) 2000-2001 Vojtech Pavlik <[email protected]>
3  * Copyright (c) 2001, 2007 Johann Deneux <[email protected]>
4  *
5  * USB/RS232 I-Force joysticks and wheels.
6  */
7 
8 /*
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License as published by
11  * the Free Software Foundation; either version 2 of the License, or
12  * (at your option) any later version.
13  *
14  * This program is distributed in the hope that it will be useful,
15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17  * GNU General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this program; if not, write to the Free Software
21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
22  *
23  * Should you need to contact me, the author, you can do so either by
24  * e-mail - mail your message to <[email protected]>, or by paper mail:
25  * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
26  */
27 
28 #include "iforce.h"
29 
31 {
32  unsigned char cs;
33  int i;
34  unsigned long flags;
35 
38  return;
39  }
40 
41  spin_lock_irqsave(&iforce->xmit_lock, flags);
42 
43 again:
44  if (iforce->xmit.head == iforce->xmit.tail) {
46  spin_unlock_irqrestore(&iforce->xmit_lock, flags);
47  return;
48  }
49 
50  cs = 0x2b;
51 
52  serio_write(iforce->serio, 0x2b);
53 
54  serio_write(iforce->serio, iforce->xmit.buf[iforce->xmit.tail]);
55  cs ^= iforce->xmit.buf[iforce->xmit.tail];
56  XMIT_INC(iforce->xmit.tail, 1);
57 
58  for (i=iforce->xmit.buf[iforce->xmit.tail]; i >= 0; --i) {
59  serio_write(iforce->serio, iforce->xmit.buf[iforce->xmit.tail]);
60  cs ^= iforce->xmit.buf[iforce->xmit.tail];
61  XMIT_INC(iforce->xmit.tail, 1);
62  }
63 
64  serio_write(iforce->serio, cs);
65 
67  goto again;
68 
70 
71  spin_unlock_irqrestore(&iforce->xmit_lock, flags);
72 }
73 
74 static void iforce_serio_write_wakeup(struct serio *serio)
75 {
76  struct iforce *iforce = serio_get_drvdata(serio);
77 
78  iforce_serial_xmit(iforce);
79 }
80 
81 static irqreturn_t iforce_serio_irq(struct serio *serio,
82  unsigned char data, unsigned int flags)
83 {
84  struct iforce *iforce = serio_get_drvdata(serio);
85 
86  if (!iforce->pkt) {
87  if (data == 0x2b)
88  iforce->pkt = 1;
89  goto out;
90  }
91 
92  if (!iforce->id) {
93  if (data > 3 && data != 0xff)
94  iforce->pkt = 0;
95  else
96  iforce->id = data;
97  goto out;
98  }
99 
100  if (!iforce->len) {
101  if (data > IFORCE_MAX_LENGTH) {
102  iforce->pkt = 0;
103  iforce->id = 0;
104  } else {
105  iforce->len = data;
106  }
107  goto out;
108  }
109 
110  if (iforce->idx < iforce->len) {
111  iforce->csum += iforce->data[iforce->idx++] = data;
112  goto out;
113  }
114 
115  if (iforce->idx == iforce->len) {
116  iforce_process_packet(iforce, (iforce->id << 8) | iforce->idx, iforce->data);
117  iforce->pkt = 0;
118  iforce->id = 0;
119  iforce->len = 0;
120  iforce->idx = 0;
121  iforce->csum = 0;
122  }
123 out:
124  return IRQ_HANDLED;
125 }
126 
127 static int iforce_serio_connect(struct serio *serio, struct serio_driver *drv)
128 {
129  struct iforce *iforce;
130  int err;
131 
132  iforce = kzalloc(sizeof(struct iforce), GFP_KERNEL);
133  if (!iforce)
134  return -ENOMEM;
135 
136  iforce->bus = IFORCE_232;
137  iforce->serio = serio;
138 
139  serio_set_drvdata(serio, iforce);
140 
141  err = serio_open(serio, drv);
142  if (err)
143  goto fail1;
144 
145  err = iforce_init_device(iforce);
146  if (err)
147  goto fail2;
148 
149  return 0;
150 
151  fail2: serio_close(serio);
152  fail1: serio_set_drvdata(serio, NULL);
153  kfree(iforce);
154  return err;
155 }
156 
157 static void iforce_serio_disconnect(struct serio *serio)
158 {
159  struct iforce *iforce = serio_get_drvdata(serio);
160 
161  input_unregister_device(iforce->dev);
162  serio_close(serio);
163  serio_set_drvdata(serio, NULL);
164  kfree(iforce);
165 }
166 
167 static struct serio_device_id iforce_serio_ids[] = {
168  {
169  .type = SERIO_RS232,
170  .proto = SERIO_IFORCE,
171  .id = SERIO_ANY,
172  .extra = SERIO_ANY,
173  },
174  { 0 }
175 };
176 
177 MODULE_DEVICE_TABLE(serio, iforce_serio_ids);
178 
180  .driver = {
181  .name = "iforce",
182  },
183  .description = "RS232 I-Force joysticks and wheels driver",
184  .id_table = iforce_serio_ids,
185  .write_wakeup = iforce_serio_write_wakeup,
186  .interrupt = iforce_serio_irq,
187  .connect = iforce_serio_connect,
188  .disconnect = iforce_serio_disconnect,
189 };