[PATCH] usb: kfree() cleanups in drivers/usb/core/devio.c
[deliverable/linux.git] / drivers / usb / serial / omninet.c
CommitLineData
1da177e4
LT
1/*
2 * USB ZyXEL omni.net LCD PLUS driver
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
8 *
9 * See Documentation/usb/usb-serial.txt for more information on using this driver
10 *
11 * Please report both successes and troubles to the author at omninet@kroah.com
12 *
13 * (05/30/2001) gkh
14 * switched from using spinlock to a semaphore, which fixes lots of problems.
15 *
16 * (04/08/2001) gb
17 * Identify version on module load.
18 *
19 * (11/01/2000) Adam J. Richter
20 * usb_device_id table support
21 *
22 * (10/05/2000) gkh
23 * Fixed bug with urb->dev not being set properly, now that the usb
24 * core needs it.
25 *
26 * (08/28/2000) gkh
27 * Added locks for SMP safeness.
28 * Fixed MOD_INC and MOD_DEC logic and the ability to open a port more
29 * than once.
30 * Fixed potential race in omninet_write_bulk_callback
31 *
32 * (07/19/2000) gkh
33 * Added module_init and module_exit functions to handle the fact that this
34 * driver is a loadable module now.
35 *
36 */
37
38#include <linux/config.h>
39#include <linux/kernel.h>
40#include <linux/errno.h>
41#include <linux/init.h>
42#include <linux/slab.h>
43#include <linux/tty.h>
44#include <linux/tty_driver.h>
45#include <linux/tty_flip.h>
46#include <linux/module.h>
47#include <linux/spinlock.h>
48#include <asm/uaccess.h>
49#include <linux/usb.h>
50#include "usb-serial.h"
51
52static int debug;
53
54/*
55 * Version Information
56 */
57#define DRIVER_VERSION "v1.1"
58#define DRIVER_AUTHOR "Alessandro Zummo"
59#define DRIVER_DESC "USB ZyXEL omni.net LCD PLUS Driver"
60
61#define ZYXEL_VENDOR_ID 0x0586
62#define ZYXEL_OMNINET_ID 0x1000
63#define BT_IGNITIONPRO_ID 0x2000 /* This one seems to be a re-branded ZyXEL device */
64
65/* function prototypes */
66static int omninet_open (struct usb_serial_port *port, struct file *filp);
67static void omninet_close (struct usb_serial_port *port, struct file *filp);
68static void omninet_read_bulk_callback (struct urb *urb, struct pt_regs *regs);
69static void omninet_write_bulk_callback (struct urb *urb, struct pt_regs *regs);
70static int omninet_write (struct usb_serial_port *port, const unsigned char *buf, int count);
71static int omninet_write_room (struct usb_serial_port *port);
72static void omninet_shutdown (struct usb_serial *serial);
73
74static struct usb_device_id id_table [] = {
75 { USB_DEVICE(ZYXEL_VENDOR_ID, ZYXEL_OMNINET_ID) },
76 { USB_DEVICE(ZYXEL_VENDOR_ID, BT_IGNITIONPRO_ID) },
77 { } /* Terminating entry */
78};
79
80MODULE_DEVICE_TABLE (usb, id_table);
81
82static struct usb_driver omninet_driver = {
83 .owner = THIS_MODULE,
84 .name = "omninet",
85 .probe = usb_serial_probe,
86 .disconnect = usb_serial_disconnect,
87 .id_table = id_table,
88};
89
90
91static struct usb_serial_device_type zyxel_omninet_device = {
92 .owner = THIS_MODULE,
93 .name = "ZyXEL - omni.net lcd plus usb",
94 .short_name = "omninet",
95 .id_table = id_table,
96 .num_interrupt_in = 1,
97 .num_bulk_in = 1,
98 .num_bulk_out = 2,
99 .num_ports = 1,
100 .open = omninet_open,
101 .close = omninet_close,
102 .write = omninet_write,
103 .write_room = omninet_write_room,
104 .read_bulk_callback = omninet_read_bulk_callback,
105 .write_bulk_callback = omninet_write_bulk_callback,
106 .shutdown = omninet_shutdown,
107};
108
109
110/* The protocol.
111 *
112 * The omni.net always exchange 64 bytes of data with the host. The first
113 * four bytes are the control header, you can see it in the above structure.
114 *
115 * oh_seq is a sequence number. Don't know if/how it's used.
116 * oh_len is the length of the data bytes in the packet.
117 * oh_xxx Bit-mapped, related to handshaking and status info.
118 * I normally set it to 0x03 in trasmitted frames.
119 * 7: Active when the TA is in a CONNECTed state.
120 * 6: unknown
121 * 5: handshaking, unknown
122 * 4: handshaking, unknown
123 * 3: unknown, usually 0
124 * 2: unknown, usually 0
125 * 1: handshaking, unknown, usually set to 1 in trasmitted frames
126 * 0: handshaking, unknown, usually set to 1 in trasmitted frames
127 * oh_pad Probably a pad byte.
128 *
129 * After the header you will find data bytes if oh_len was greater than zero.
130 *
131 */
132
133struct omninet_header
134{
135 __u8 oh_seq;
136 __u8 oh_len;
137 __u8 oh_xxx;
138 __u8 oh_pad;
139};
140
141struct omninet_data
142{
143 __u8 od_outseq; // Sequence number for bulk_out URBs
144};
145
146static int omninet_open (struct usb_serial_port *port, struct file *filp)
147{
148 struct usb_serial *serial = port->serial;
149 struct usb_serial_port *wport;
150 struct omninet_data *od;
151 int result = 0;
152
153 dbg("%s - port %d", __FUNCTION__, port->number);
154
155 od = kmalloc( sizeof(struct omninet_data), GFP_KERNEL );
156 if( !od ) {
157 err("%s- kmalloc(%Zd) failed.", __FUNCTION__, sizeof(struct omninet_data));
158 return -ENOMEM;
159 }
160
161 usb_set_serial_port_data(port, od);
162 wport = serial->port[1];
163 wport->tty = port->tty;
164
165 /* Start reading from the device */
166 usb_fill_bulk_urb(port->read_urb, serial->dev,
167 usb_rcvbulkpipe(serial->dev, port->bulk_in_endpointAddress),
168 port->read_urb->transfer_buffer, port->read_urb->transfer_buffer_length,
169 omninet_read_bulk_callback, port);
170 result = usb_submit_urb(port->read_urb, GFP_KERNEL);
171 if (result)
172 err("%s - failed submitting read urb, error %d", __FUNCTION__, result);
173
174 return result;
175}
176
177static void omninet_close (struct usb_serial_port *port, struct file * filp)
178{
179 struct usb_serial *serial = port->serial;
180 struct usb_serial_port *wport;
181 struct omninet_data *od;
182
183 dbg("%s - port %d", __FUNCTION__, port->number);
184
185 wport = serial->port[1];
186 usb_kill_urb(wport->write_urb);
187 usb_kill_urb(port->read_urb);
188
189 od = usb_get_serial_port_data(port);
190 if (od)
191 kfree(od);
192}
193
194
195#define OMNINET_DATAOFFSET 0x04
196#define OMNINET_HEADERLEN sizeof(struct omninet_header)
197#define OMNINET_BULKOUTSIZE (64 - OMNINET_HEADERLEN)
198
199static void omninet_read_bulk_callback (struct urb *urb, struct pt_regs *regs)
200{
201 struct usb_serial_port *port = (struct usb_serial_port *)urb->context;
202 unsigned char *data = urb->transfer_buffer;
203 struct omninet_header *header = (struct omninet_header *) &data[0];
204
205 int i;
206 int result;
207
208// dbg("omninet_read_bulk_callback");
209
210 if (urb->status) {
211 dbg("%s - nonzero read bulk status received: %d", __FUNCTION__, urb->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 /* Continue trying to always read */
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("omninet_write port %d", port->number);
255
256 if (count == 0) {
257 dbg("%s - write request of 0 bytes", __FUNCTION__);
258 return (0);
259 }
260 if (wport->write_urb->status == -EINPROGRESS) {
261 dbg("%s - already writing", __FUNCTION__);
262 return (0);
263 }
264
265 count = (count > OMNINET_BULKOUTSIZE) ? OMNINET_BULKOUTSIZE : count;
266
267 memcpy (wport->write_urb->transfer_buffer + OMNINET_DATAOFFSET, buf, count);
268
269 usb_serial_debug_data(debug, &port->dev, __FUNCTION__, count, wport->write_urb->transfer_buffer);
270
271 header->oh_seq = od->od_outseq++;
272 header->oh_len = count;
273 header->oh_xxx = 0x03;
274 header->oh_pad = 0x00;
275
276 /* send the data out the bulk port, always 64 bytes */
277 wport->write_urb->transfer_buffer_length = 64;
278
279 wport->write_urb->dev = serial->dev;
280 result = usb_submit_urb(wport->write_urb, GFP_ATOMIC);
281 if (result)
282 err("%s - failed submitting write urb, error %d", __FUNCTION__, result);
283 else
284 result = count;
285
286 return result;
287}
288
289
290static int omninet_write_room (struct usb_serial_port *port)
291{
292 struct usb_serial *serial = port->serial;
293 struct usb_serial_port *wport = serial->port[1];
294
295 int room = 0; // Default: no room
296
297 if (wport->write_urb->status != -EINPROGRESS)
298 room = wport->bulk_out_size - OMNINET_HEADERLEN;
299
300// dbg("omninet_write_room returns %d", room);
301
302 return (room);
303}
304
305static void omninet_write_bulk_callback (struct urb *urb, struct pt_regs *regs)
306{
307/* struct omninet_header *header = (struct omninet_header *) urb->transfer_buffer; */
308 struct usb_serial_port *port = (struct usb_serial_port *) urb->context;
309
310// dbg("omninet_write_bulk_callback, port %0x\n", port);
311
312 if (urb->status) {
313 dbg("%s - nonzero write bulk status received: %d", __FUNCTION__, urb->status);
314 return;
315 }
316
317 schedule_work(&port->work);
318
319// dbg("omninet_write_bulk_callback, tty %0x\n", tty);
320}
321
322
323static void omninet_shutdown (struct usb_serial *serial)
324{
325 dbg ("%s", __FUNCTION__);
326}
327
328
329static int __init omninet_init (void)
330{
331 int retval;
332 retval = usb_serial_register(&zyxel_omninet_device);
333 if (retval)
334 goto failed_usb_serial_register;
335 retval = usb_register(&omninet_driver);
336 if (retval)
337 goto failed_usb_register;
338 info(DRIVER_VERSION ":" DRIVER_DESC);
339 return 0;
340failed_usb_register:
341 usb_serial_deregister(&zyxel_omninet_device);
342failed_usb_serial_register:
343 return retval;
344}
345
346
347static void __exit omninet_exit (void)
348{
349 usb_deregister (&omninet_driver);
350 usb_serial_deregister (&zyxel_omninet_device);
351}
352
353
354module_init(omninet_init);
355module_exit(omninet_exit);
356
357MODULE_AUTHOR( DRIVER_AUTHOR );
358MODULE_DESCRIPTION( DRIVER_DESC );
359MODULE_LICENSE("GPL");
360
361module_param(debug, bool, S_IRUGO | S_IWUSR);
362MODULE_PARM_DESC(debug, "Debug enabled or not");
This page took 0.042273 seconds and 5 git commands to generate.