1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/gfp.h>
16#include <linux/kernel.h>
17#include <linux/init.h>
18#include <linux/tty.h>
19#include <linux/tty_flip.h>
20#include <linux/module.h>
21#include <linux/usb.h>
22#include <linux/usb/serial.h>
23
24static bool debug;
25
26static const struct usb_device_id id_table[] = {
27 { USB_DEVICE(0x0a99, 0x0001) },
28 { USB_DEVICE(0x0df7, 0x0900) },
29 { },
30};
31MODULE_DEVICE_TABLE(usb, id_table);
32
33static struct usb_driver navman_driver = {
34 .name = "navman",
35 .probe = usb_serial_probe,
36 .disconnect = usb_serial_disconnect,
37 .id_table = id_table,
38};
39
40static void navman_read_int_callback(struct urb *urb)
41{
42 struct usb_serial_port *port = urb->context;
43 unsigned char *data = urb->transfer_buffer;
44 struct tty_struct *tty;
45 int status = urb->status;
46 int result;
47
48 switch (status) {
49 case 0:
50
51 break;
52 case -ECONNRESET:
53 case -ENOENT:
54 case -ESHUTDOWN:
55
56 dbg("%s - urb shutting down with status: %d",
57 __func__, status);
58 return;
59 default:
60 dbg("%s - nonzero urb status received: %d",
61 __func__, status);
62 goto exit;
63 }
64
65 usb_serial_debug_data(debug, &port->dev, __func__,
66 urb->actual_length, data);
67
68 tty = tty_port_tty_get(&port->port);
69 if (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 .num_ports = 1,
125 .open = navman_open,
126 .close = navman_close,
127 .write = navman_write,
128 .read_int_callback = navman_read_int_callback,
129};
130
131static struct usb_serial_driver * const serial_drivers[] = {
132 &navman_device, NULL
133};
134
135module_usb_serial_driver(navman_driver, serial_drivers);
136
137MODULE_LICENSE("GPL");
138
139module_param(debug, bool, S_IRUGO | S_IWUSR);
140MODULE_PARM_DESC(debug, "Debug enabled or not");
141