1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37#include <linux/kernel.h>
38#include <linux/errno.h>
39#include <linux/init.h>
40#include <linux/slab.h>
41#include <linux/tty.h>
42#include <linux/tty_driver.h>
43#include <linux/tty_flip.h>
44#include <linux/module.h>
45#include <linux/spinlock.h>
46#include <asm/uaccess.h>
47#include <linux/usb.h>
48#include <linux/usb/serial.h>
49
50static int debug;
51
52
53
54
55#define DRIVER_VERSION "v1.1"
56#define DRIVER_AUTHOR "Alessandro Zummo"
57#define DRIVER_DESC "USB ZyXEL omni.net LCD PLUS Driver"
58
59#define ZYXEL_VENDOR_ID 0x0586
60#define ZYXEL_OMNINET_ID 0x1000
61#define BT_IGNITIONPRO_ID 0x2000
62
63
64static int omninet_open (struct usb_serial_port *port, struct file *filp);
65static void omninet_close (struct usb_serial_port *port, struct file *filp);
66static void omninet_read_bulk_callback (struct urb *urb);
67static void omninet_write_bulk_callback (struct urb *urb);
68static int omninet_write (struct usb_serial_port *port, const unsigned char *buf, int count);
69static int omninet_write_room (struct usb_serial_port *port);
70static void omninet_shutdown (struct usb_serial *serial);
71static int omninet_attach (struct usb_serial *serial);
72
73static struct usb_device_id id_table [] = {
74 { USB_DEVICE(ZYXEL_VENDOR_ID, ZYXEL_OMNINET_ID) },
75 { USB_DEVICE(ZYXEL_VENDOR_ID, BT_IGNITIONPRO_ID) },
76 { }
77};
78
79MODULE_DEVICE_TABLE (usb, id_table);
80
81static struct usb_driver omninet_driver = {
82 .name = "omninet",
83 .probe = usb_serial_probe,
84 .disconnect = usb_serial_disconnect,
85 .id_table = id_table,
86 .no_dynamic_id = 1,
87};
88
89
90static struct usb_serial_driver zyxel_omninet_device = {
91 .driver = {
92 .owner = THIS_MODULE,
93 .name = "omninet",
94 },
95 .description = "ZyXEL - omni.net lcd plus usb",
96 .usb_driver = &omninet_driver,
97 .id_table = id_table,
98 .num_interrupt_in = 1,
99 .num_bulk_in = 1,
100 .num_bulk_out = 2,
101 .num_ports = 1,
102 .attach = omninet_attach,
103 .open = omninet_open,
104 .close = omninet_close,
105 .write = omninet_write,
106 .write_room = omninet_write_room,
107 .read_bulk_callback = omninet_read_bulk_callback,
108 .write_bulk_callback = omninet_write_bulk_callback,
109 .shutdown = omninet_shutdown,
110};
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136struct omninet_header
137{
138 __u8 oh_seq;
139 __u8 oh_len;
140 __u8 oh_xxx;
141 __u8 oh_pad;
142};
143
144struct omninet_data
145{
146 __u8 od_outseq;
147};
148
149static int omninet_attach (struct usb_serial *serial)
150{
151 struct omninet_data *od;
152 struct usb_serial_port *port = serial->port[0];
153
154 od = kmalloc( sizeof(struct omninet_data), GFP_KERNEL );
155 if( !od ) {
156 err("%s- kmalloc(%Zd) failed.", __FUNCTION__, sizeof(struct omninet_data));
157 return -ENOMEM;
158 }
159 usb_set_serial_port_data(port, od);
160 return 0;
161}
162
163static int omninet_open (struct usb_serial_port *port, struct file *filp)
164{
165 struct usb_serial *serial = port->serial;
166 struct usb_serial_port *wport;
167 int result = 0;
168
169 dbg("%s - port %d", __FUNCTION__, port->number);
170
171 wport = serial->port[1];
172 wport->tty = port->tty;
173
174
175 usb_fill_bulk_urb(port->read_urb, serial->dev,
176 usb_rcvbulkpipe(serial->dev, port->bulk_in_endpointAddress),
177 port->read_urb->transfer_buffer, port->read_urb->transfer_buffer_length,
178 omninet_read_bulk_callback, port);
179 result = usb_submit_urb(port->read_urb, GFP_KERNEL);
180 if (result) {
181 err("%s - failed submitting read urb, error %d", __FUNCTION__, result);
182 }
183
184 return result;
185}
186
187static void omninet_close (struct usb_serial_port *port, struct file * filp)
188{
189 dbg("%s - port %d", __FUNCTION__, port->number);
190 usb_kill_urb(port->read_urb);
191}
192
193
194#define OMNINET_DATAOFFSET 0x04
195#define OMNINET_HEADERLEN sizeof(struct omninet_header)
196#define OMNINET_BULKOUTSIZE (64 - OMNINET_HEADERLEN)
197
198static void omninet_read_bulk_callback (struct urb *urb)
199{
200 struct usb_serial_port *port = (struct usb_serial_port *)urb->context;
201 unsigned char *data = urb->transfer_buffer;
202 struct omninet_header *header = (struct omninet_header *) &data[0];
203 int status = urb->status;
204 int i;
205 int result;
206
207 dbg("%s - port %d", __FUNCTION__, port->number);
208
209 if (status) {
210 dbg("%s - nonzero read bulk status received: %d",
211 __FUNCTION__, status);
212 return;
213 }
214
215 if ((debug) && (header->oh_xxx != 0x30)) {
216 if (urb->actual_length) {
217 printk (KERN_DEBUG __FILE__ ": omninet_read %d: ", header->oh_len);
218 for (i = 0; i < (header->oh_len + OMNINET_HEADERLEN); i++) {
219 printk ("%.2x ", data[i]);
220 }
221 printk ("\n");
222 }
223 }
224
225 if (urb->actual_length && header->oh_len) {
226 for (i = 0; i < header->oh_len; i++) {
227 tty_insert_flip_char(port->tty, data[OMNINET_DATAOFFSET + i], 0);
228 }
229 tty_flip_buffer_push(port->tty);
230 }
231
232
233 usb_fill_bulk_urb(urb, port->serial->dev,
234 usb_rcvbulkpipe(port->serial->dev, port->bulk_in_endpointAddress),
235 urb->transfer_buffer, urb->transfer_buffer_length,
236 omninet_read_bulk_callback, port);
237 result = usb_submit_urb(urb, GFP_ATOMIC);
238 if (result)
239 err("%s - failed resubmitting read urb, error %d", __FUNCTION__, result);
240
241 return;
242}
243
244static int omninet_write (struct usb_serial_port *port, const unsigned char *buf, int count)
245{
246 struct usb_serial *serial = port->serial;
247 struct usb_serial_port *wport = serial->port[1];
248
249 struct omninet_data *od = usb_get_serial_port_data(port);
250 struct omninet_header *header = (struct omninet_header *) wport->write_urb->transfer_buffer;
251
252 int result;
253
254 dbg("%s - port %d", __FUNCTION__, port->number);
255
256 if (count == 0) {
257 dbg("%s - write request of 0 bytes", __FUNCTION__);
258 return (0);
259 }
260
261 spin_lock_bh(&wport->lock);
262 if (wport->write_urb_busy) {
263 spin_unlock_bh(&wport->lock);
264 dbg("%s - already writing", __FUNCTION__);
265 return 0;
266 }
267 wport->write_urb_busy = 1;
268 spin_unlock_bh(&wport->lock);
269
270 count = (count > OMNINET_BULKOUTSIZE) ? OMNINET_BULKOUTSIZE : count;
271
272 memcpy (wport->write_urb->transfer_buffer + OMNINET_DATAOFFSET, buf, count);
273
274 usb_serial_debug_data(debug, &port->dev, __FUNCTION__, count, wport->write_urb->transfer_buffer);
275
276 header->oh_seq = od->od_outseq++;
277 header->oh_len = count;
278 header->oh_xxx = 0x03;
279 header->oh_pad = 0x00;
280
281
282 wport->write_urb->transfer_buffer_length = 64;
283
284 wport->write_urb->dev = serial->dev;
285 result = usb_submit_urb(wport->write_urb, GFP_ATOMIC);
286 if (result) {
287 wport->write_urb_busy = 0;
288 err("%s - failed submitting write urb, error %d", __FUNCTION__, result);
289 } else
290 result = count;
291
292 return result;
293}
294
295
296static int omninet_write_room (struct usb_serial_port *port)
297{
298 struct usb_serial *serial = port->serial;
299 struct usb_serial_port *wport = serial->port[1];
300
301 int room = 0;
302
303 if (wport->write_urb_busy)
304 room = wport->bulk_out_size - OMNINET_HEADERLEN;
305
306 dbg("%s - returns %d", __FUNCTION__, room);
307
308 return (room);
309}
310
311static void omninet_write_bulk_callback (struct urb *urb)
312{
313
314 struct usb_serial_port *port = (struct usb_serial_port *) urb->context;
315 int status = urb->status;
316
317 dbg("%s - port %0x\n", __FUNCTION__, port->number);
318
319 port->write_urb_busy = 0;
320 if (status) {
321 dbg("%s - nonzero write bulk status received: %d",
322 __FUNCTION__, status);
323 return;
324 }
325
326 usb_serial_port_softint(port);
327}
328
329
330static void omninet_shutdown (struct usb_serial *serial)
331{
332 struct usb_serial_port *wport = serial->port[1];
333 struct usb_serial_port *port = serial->port[0];
334 dbg ("%s", __FUNCTION__);
335
336 usb_kill_urb(wport->write_urb);
337 kfree(usb_get_serial_port_data(port));
338}
339
340
341static int __init omninet_init (void)
342{
343 int retval;
344 retval = usb_serial_register(&zyxel_omninet_device);
345 if (retval)
346 goto failed_usb_serial_register;
347 retval = usb_register(&omninet_driver);
348 if (retval)
349 goto failed_usb_register;
350 info(DRIVER_VERSION ":" DRIVER_DESC);
351 return 0;
352failed_usb_register:
353 usb_serial_deregister(&zyxel_omninet_device);
354failed_usb_serial_register:
355 return retval;
356}
357
358
359static void __exit omninet_exit (void)
360{
361 usb_deregister (&omninet_driver);
362 usb_serial_deregister (&zyxel_omninet_device);
363}
364
365
366module_init(omninet_init);
367module_exit(omninet_exit);
368
369MODULE_AUTHOR( DRIVER_AUTHOR );
370MODULE_DESCRIPTION( DRIVER_DESC );
371MODULE_LICENSE("GPL");
372
373module_param(debug, bool, S_IRUGO | S_IWUSR);
374MODULE_PARM_DESC(debug, "Debug enabled or not");
375