1
2
3
4
5
6
7
8#include <linux/kernel.h>
9#include <linux/errno.h>
10#include <linux/tty.h>
11#include <linux/slab.h>
12#include <linux/module.h>
13#include <linux/usb.h>
14#include <linux/usb/serial.h>
15
16static int usb_serial_device_match(struct device *dev,
17 struct device_driver *drv)
18{
19 const struct usb_serial_port *port = to_usb_serial_port(dev);
20 struct usb_serial_driver *driver = to_usb_serial_driver(drv);
21
22
23
24
25
26 if (driver == port->serial->type)
27 return 1;
28
29 return 0;
30}
31
32static int usb_serial_device_probe(struct device *dev)
33{
34 struct usb_serial_port *port = to_usb_serial_port(dev);
35 struct usb_serial_driver *driver;
36 struct device *tty_dev;
37 int retval = 0;
38 int minor;
39
40
41 retval = usb_autopm_get_interface(port->serial->interface);
42 if (retval)
43 return retval;
44
45 driver = port->serial->type;
46 if (driver->port_probe) {
47 retval = driver->port_probe(port);
48 if (retval)
49 goto err_autopm_put;
50 }
51
52 minor = port->minor;
53 tty_dev = tty_port_register_device(&port->port, usb_serial_tty_driver,
54 minor, dev);
55 if (IS_ERR(tty_dev)) {
56 retval = PTR_ERR(tty_dev);
57 goto err_port_remove;
58 }
59
60 usb_autopm_put_interface(port->serial->interface);
61
62 dev_info(&port->serial->dev->dev,
63 "%s converter now attached to ttyUSB%d\n",
64 driver->description, minor);
65
66 return 0;
67
68err_port_remove:
69 if (driver->port_remove)
70 driver->port_remove(port);
71err_autopm_put:
72 usb_autopm_put_interface(port->serial->interface);
73
74 return retval;
75}
76
77static int usb_serial_device_remove(struct device *dev)
78{
79 struct usb_serial_port *port = to_usb_serial_port(dev);
80 struct usb_serial_driver *driver;
81 int retval = 0;
82 int minor;
83 int autopm_err;
84
85
86
87
88
89
90
91 autopm_err = usb_autopm_get_interface(port->serial->interface);
92
93 minor = port->minor;
94 tty_unregister_device(usb_serial_tty_driver, minor);
95
96 driver = port->serial->type;
97 if (driver->port_remove)
98 retval = driver->port_remove(port);
99
100 dev_info(dev, "%s converter now disconnected from ttyUSB%d\n",
101 driver->description, minor);
102
103 if (!autopm_err)
104 usb_autopm_put_interface(port->serial->interface);
105
106 return retval;
107}
108
109static ssize_t new_id_store(struct device_driver *driver,
110 const char *buf, size_t count)
111{
112 struct usb_serial_driver *usb_drv = to_usb_serial_driver(driver);
113 ssize_t retval = usb_store_new_id(&usb_drv->dynids, usb_drv->id_table,
114 driver, buf, count);
115
116 if (retval >= 0 && usb_drv->usb_driver != NULL)
117 retval = usb_store_new_id(&usb_drv->usb_driver->dynids,
118 usb_drv->usb_driver->id_table,
119 &usb_drv->usb_driver->drvwrap.driver,
120 buf, count);
121 return retval;
122}
123
124static ssize_t new_id_show(struct device_driver *driver, char *buf)
125{
126 struct usb_serial_driver *usb_drv = to_usb_serial_driver(driver);
127
128 return usb_show_dynids(&usb_drv->dynids, buf);
129}
130static DRIVER_ATTR_RW(new_id);
131
132static struct attribute *usb_serial_drv_attrs[] = {
133 &driver_attr_new_id.attr,
134 NULL,
135};
136ATTRIBUTE_GROUPS(usb_serial_drv);
137
138static void free_dynids(struct usb_serial_driver *drv)
139{
140 struct usb_dynid *dynid, *n;
141
142 spin_lock(&drv->dynids.lock);
143 list_for_each_entry_safe(dynid, n, &drv->dynids.list, node) {
144 list_del(&dynid->node);
145 kfree(dynid);
146 }
147 spin_unlock(&drv->dynids.lock);
148}
149
150struct bus_type usb_serial_bus_type = {
151 .name = "usb-serial",
152 .match = usb_serial_device_match,
153 .probe = usb_serial_device_probe,
154 .remove = usb_serial_device_remove,
155 .drv_groups = usb_serial_drv_groups,
156};
157
158int usb_serial_bus_register(struct usb_serial_driver *driver)
159{
160 int retval;
161
162 driver->driver.bus = &usb_serial_bus_type;
163 spin_lock_init(&driver->dynids.lock);
164 INIT_LIST_HEAD(&driver->dynids.list);
165
166 retval = driver_register(&driver->driver);
167
168 return retval;
169}
170
171void usb_serial_bus_deregister(struct usb_serial_driver *driver)
172{
173 free_dynids(driver);
174 driver_unregister(&driver->driver);
175}
176
177