1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/kernel.h>
16#include <linux/init.h>
17#include <linux/tty.h>
18#include <linux/tty_flip.h>
19#include <linux/module.h>
20#include <linux/usb.h>
21#include <linux/usb/serial.h>
22
23static int debug;
24
25static struct usb_device_id id_table [] = {
26 { USB_DEVICE(0x0a99, 0x0001) },
27 { },
28};
29MODULE_DEVICE_TABLE(usb, id_table);
30
31static struct usb_driver navman_driver = {
32 .name = "navman",
33 .probe = usb_serial_probe,
34 .disconnect = usb_serial_disconnect,
35 .id_table = id_table,
36 .no_dynamic_id = 1,
37};
38
39static void navman_read_int_callback(struct urb *urb)
40{
41 struct usb_serial_port *port = urb->context;
42 unsigned char *data = urb->transfer_buffer;
43 struct tty_struct *tty;
44 int status = urb->status;
45 int result;
46
47 switch (status) {
48 case 0:
49
50 break;
51 case -ECONNRESET:
52 case -ENOENT:
53 case -ESHUTDOWN:
54
55 dbg("%s - urb shutting down with status: %d",
56 __func__, status);
57 return;
58 default:
59 dbg("%s - nonzero urb status received: %d",
60 __func__, status);
61 goto exit;
62 }
63
64 usb_serial_debug_data(debug, &port->dev, __func__,
65 urb->actual_length, data);
66
67 tty = tty_port_tty_get(&port->port);
68 if (tty && urb->actual_length) {
69 tty_buffer_request_room(tty, urb->actual_length);
70 tty_insert_flip_string(tty, data, urb->actual_length);
71 tty_flip_buffer_push(tty);
72 }
73 tty_kref_put(tty);
74
75exit:
76 result = usb_submit_urb(urb, GFP_ATOMIC);
77 if (result)
78 dev_err(&urb->dev->dev,
79 "%s - Error %d submitting interrupt urb\n",
80 __func__, result);
81}
82
83static int navman_open(struct tty_struct *tty, struct usb_serial_port *port)
84{
85 int result = 0;
86
87 dbg("%s - port %d", __func__, port->number);
88
89 if (port->interrupt_in_urb) {
90 dbg("%s - adding interrupt input for treo", __func__);
91 result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
92 if (result)
93 dev_err(&port->dev,
94 "%s - failed submitting interrupt urb, error %d\n",
95 __func__, result);
96 }
97 return result;
98}
99
100static void navman_close(struct usb_serial_port *port)
101{
102 dbg("%s - port %d", __func__, port->number);
103
104 usb_kill_urb(port->interrupt_in_urb);
105}
106
107static int navman_write(struct tty_struct *tty, struct usb_serial_port *port,
108 const unsigned char *buf, int count)
109{
110 dbg("%s - port %d", __func__, port->number);
111
112
113
114
115 return -EOPNOTSUPP;
116}
117
118static struct usb_serial_driver navman_device = {
119 .driver = {
120 .owner = THIS_MODULE,
121 .name = "navman",
122 },
123 .id_table = id_table,
124 .usb_driver = &navman_driver,
125 .num_ports = 1,
126 .open = navman_open,
127 .close = navman_close,
128 .write = navman_write,
129 .read_int_callback = navman_read_int_callback,
130};
131
132static int __init navman_init(void)
133{
134 int retval;
135
136 retval = usb_serial_register(&navman_device);
137 if (retval)
138 return retval;
139 retval = usb_register(&navman_driver);
140 if (retval)
141 usb_serial_deregister(&navman_device);
142 return retval;
143}
144
145static void __exit navman_exit(void)
146{
147 usb_deregister(&navman_driver);
148 usb_serial_deregister(&navman_device);
149}
150
151module_init(navman_init);
152module_exit(navman_exit);
153MODULE_LICENSE("GPL");
154
155module_param(debug, bool, S_IRUGO | S_IWUSR);
156MODULE_PARM_DESC(debug, "Debug enabled or not");
157