1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18#include <linux/kernel.h>
19#include <linux/errno.h>
20#include <linux/init.h>
21#include <linux/slab.h>
22#include <linux/tty.h>
23#include <linux/tty_driver.h>
24#include <linux/tty_flip.h>
25#include <linux/module.h>
26#include <linux/spinlock.h>
27#include <linux/uaccess.h>
28#include <linux/usb.h>
29#include <linux/usb/serial.h>
30
31static int debug;
32
33
34
35
36#define DRIVER_VERSION "v1.3"
37#define DRIVER_AUTHOR "Greg Kroah-Hartman <greg@kroah.com>, Gary Brubaker <xavyer@ix.netcom.com>"
38#define DRIVER_DESC "USB Empeg Mark I/II Driver"
39
40#define EMPEG_VENDOR_ID 0x084f
41#define EMPEG_PRODUCT_ID 0x0001
42
43
44static int empeg_startup(struct usb_serial *serial);
45static void empeg_init_termios(struct tty_struct *tty);
46
47static const struct usb_device_id id_table[] = {
48 { USB_DEVICE(EMPEG_VENDOR_ID, EMPEG_PRODUCT_ID) },
49 { }
50};
51
52MODULE_DEVICE_TABLE(usb, id_table);
53
54static struct usb_driver empeg_driver = {
55 .name = "empeg",
56 .probe = usb_serial_probe,
57 .disconnect = usb_serial_disconnect,
58 .id_table = id_table,
59 .no_dynamic_id = 1,
60};
61
62static struct usb_serial_driver empeg_device = {
63 .driver = {
64 .owner = THIS_MODULE,
65 .name = "empeg",
66 },
67 .id_table = id_table,
68 .usb_driver = &empeg_driver,
69 .num_ports = 1,
70 .bulk_out_size = 256,
71 .throttle = usb_serial_generic_throttle,
72 .unthrottle = usb_serial_generic_unthrottle,
73 .attach = empeg_startup,
74 .init_termios = empeg_init_termios,
75};
76
77static int empeg_startup(struct usb_serial *serial)
78{
79 int r;
80
81 dbg("%s", __func__);
82
83 if (serial->dev->actconfig->desc.bConfigurationValue != 1) {
84 dev_err(&serial->dev->dev, "active config #%d != 1 ??\n",
85 serial->dev->actconfig->desc.bConfigurationValue);
86 return -ENODEV;
87 }
88 dbg("%s - reset config", __func__);
89 r = usb_reset_configuration(serial->dev);
90
91
92 return r;
93}
94
95static void empeg_init_termios(struct tty_struct *tty)
96{
97 struct ktermios *termios = tty->termios;
98
99
100
101
102
103
104
105
106
107
108 termios->c_iflag
109 &= ~(IGNBRK
110 | BRKINT
111 | PARMRK
112 | ISTRIP
113 | INLCR
114 | IGNCR
115 | ICRNL
116 | IXON);
117
118 termios->c_oflag
119 &= ~OPOST;
120
121 termios->c_lflag
122 &= ~(ECHO
123 | ECHONL
124 | ICANON
125 | ISIG
126 | IEXTEN);
127
128 termios->c_cflag
129 &= ~(CSIZE
130 | PARENB
131 | CBAUD);
132
133 termios->c_cflag
134 |= CS8;
135
136 tty_encode_baud_rate(tty, 115200, 115200);
137}
138
139static int __init empeg_init(void)
140{
141 int retval;
142
143 retval = usb_serial_register(&empeg_device);
144 if (retval)
145 return retval;
146 retval = usb_register(&empeg_driver);
147 if (retval) {
148 usb_serial_deregister(&empeg_device);
149 return retval;
150 }
151 printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
152 DRIVER_DESC "\n");
153
154 return 0;
155}
156
157static void __exit empeg_exit(void)
158{
159 usb_deregister(&empeg_driver);
160 usb_serial_deregister(&empeg_device);
161}
162
163
164module_init(empeg_init);
165module_exit(empeg_exit);
166
167MODULE_AUTHOR(DRIVER_AUTHOR);
168MODULE_DESCRIPTION(DRIVER_DESC);
169MODULE_LICENSE("GPL");
170
171module_param(debug, bool, S_IRUGO | S_IWUSR);
172MODULE_PARM_DESC(debug, "Debug enabled or not");
173