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 const struct usb_device_id id_table[] = {
25 { USB_DEVICE(0x0a99, 0x0001) },
26 { USB_DEVICE(0x0df7, 0x0900) },
27 { },
28};
29MODULE_DEVICE_TABLE(usb, id_table);
30
31static void navman_read_int_callback(struct urb *urb)
32{
33 struct usb_serial_port *port = urb->context;
34 unsigned char *data = urb->transfer_buffer;
35 struct tty_struct *tty;
36 int status = urb->status;
37 int result;
38
39 switch (status) {
40 case 0:
41
42 break;
43 case -ECONNRESET:
44 case -ENOENT:
45 case -ESHUTDOWN:
46
47 dev_dbg(&port->dev, "%s - urb shutting down with status: %d\n",
48 __func__, status);
49 return;
50 default:
51 dev_dbg(&port->dev, "%s - nonzero urb status received: %d\n",
52 __func__, status);
53 goto exit;
54 }
55
56 usb_serial_debug_data(&port->dev, __func__, urb->actual_length, data);
57
58 tty = tty_port_tty_get(&port->port);
59 if (tty && urb->actual_length) {
60 tty_insert_flip_string(tty, data, urb->actual_length);
61 tty_flip_buffer_push(tty);
62 }
63 tty_kref_put(tty);
64
65exit:
66 result = usb_submit_urb(urb, GFP_ATOMIC);
67 if (result)
68 dev_err(&urb->dev->dev,
69 "%s - Error %d submitting interrupt urb\n",
70 __func__, result);
71}
72
73static int navman_open(struct tty_struct *tty, struct usb_serial_port *port)
74{
75 int result = 0;
76
77 if (port->interrupt_in_urb) {
78 dev_dbg(&port->dev, "%s - adding interrupt input for treo\n",
79 __func__);
80 result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
81 if (result)
82 dev_err(&port->dev,
83 "%s - failed submitting interrupt urb, error %d\n",
84 __func__, result);
85 }
86 return result;
87}
88
89static void navman_close(struct usb_serial_port *port)
90{
91 usb_kill_urb(port->interrupt_in_urb);
92}
93
94static int navman_write(struct tty_struct *tty, struct usb_serial_port *port,
95 const unsigned char *buf, int count)
96{
97
98
99
100 return -EOPNOTSUPP;
101}
102
103static struct usb_serial_driver navman_device = {
104 .driver = {
105 .owner = THIS_MODULE,
106 .name = "navman",
107 },
108 .id_table = id_table,
109 .num_ports = 1,
110 .open = navman_open,
111 .close = navman_close,
112 .write = navman_write,
113 .read_int_callback = navman_read_int_callback,
114};
115
116static struct usb_serial_driver * const serial_drivers[] = {
117 &navman_device, NULL
118};
119
120module_usb_serial_driver(serial_drivers, id_table);
121
122MODULE_LICENSE("GPL");
123