treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / usb / gadget / function / f_serial.c
blob1406255d08658af0a746758e735b25bee4ca5672
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * f_serial.c - generic USB serial function driver
5 * Copyright (C) 2003 Al Borchers (alborchers@steinerpoint.com)
6 * Copyright (C) 2008 by David Brownell
7 * Copyright (C) 2008 by Nokia Corporation
8 */
10 #include <linux/slab.h>
11 #include <linux/kernel.h>
12 #include <linux/module.h>
13 #include <linux/device.h>
15 #include "u_serial.h"
19 * This function packages a simple "generic serial" port with no real
20 * control mechanisms, just raw data transfer over two bulk endpoints.
22 * Because it's not standardized, this isn't as interoperable as the
23 * CDC ACM driver. However, for many purposes it's just as functional
24 * if you can arrange appropriate host side drivers.
27 struct f_gser {
28 struct gserial port;
29 u8 data_id;
30 u8 port_num;
33 static inline struct f_gser *func_to_gser(struct usb_function *f)
35 return container_of(f, struct f_gser, port.func);
38 /*-------------------------------------------------------------------------*/
40 /* interface descriptor: */
42 static struct usb_interface_descriptor gser_interface_desc = {
43 .bLength = USB_DT_INTERFACE_SIZE,
44 .bDescriptorType = USB_DT_INTERFACE,
45 /* .bInterfaceNumber = DYNAMIC */
46 .bNumEndpoints = 2,
47 .bInterfaceClass = USB_CLASS_VENDOR_SPEC,
48 .bInterfaceSubClass = 0,
49 .bInterfaceProtocol = 0,
50 /* .iInterface = DYNAMIC */
53 /* full speed support: */
55 static struct usb_endpoint_descriptor gser_fs_in_desc = {
56 .bLength = USB_DT_ENDPOINT_SIZE,
57 .bDescriptorType = USB_DT_ENDPOINT,
58 .bEndpointAddress = USB_DIR_IN,
59 .bmAttributes = USB_ENDPOINT_XFER_BULK,
62 static struct usb_endpoint_descriptor gser_fs_out_desc = {
63 .bLength = USB_DT_ENDPOINT_SIZE,
64 .bDescriptorType = USB_DT_ENDPOINT,
65 .bEndpointAddress = USB_DIR_OUT,
66 .bmAttributes = USB_ENDPOINT_XFER_BULK,
69 static struct usb_descriptor_header *gser_fs_function[] = {
70 (struct usb_descriptor_header *) &gser_interface_desc,
71 (struct usb_descriptor_header *) &gser_fs_in_desc,
72 (struct usb_descriptor_header *) &gser_fs_out_desc,
73 NULL,
76 /* high speed support: */
78 static struct usb_endpoint_descriptor gser_hs_in_desc = {
79 .bLength = USB_DT_ENDPOINT_SIZE,
80 .bDescriptorType = USB_DT_ENDPOINT,
81 .bmAttributes = USB_ENDPOINT_XFER_BULK,
82 .wMaxPacketSize = cpu_to_le16(512),
85 static struct usb_endpoint_descriptor gser_hs_out_desc = {
86 .bLength = USB_DT_ENDPOINT_SIZE,
87 .bDescriptorType = USB_DT_ENDPOINT,
88 .bmAttributes = USB_ENDPOINT_XFER_BULK,
89 .wMaxPacketSize = cpu_to_le16(512),
92 static struct usb_descriptor_header *gser_hs_function[] = {
93 (struct usb_descriptor_header *) &gser_interface_desc,
94 (struct usb_descriptor_header *) &gser_hs_in_desc,
95 (struct usb_descriptor_header *) &gser_hs_out_desc,
96 NULL,
99 static struct usb_endpoint_descriptor gser_ss_in_desc = {
100 .bLength = USB_DT_ENDPOINT_SIZE,
101 .bDescriptorType = USB_DT_ENDPOINT,
102 .bmAttributes = USB_ENDPOINT_XFER_BULK,
103 .wMaxPacketSize = cpu_to_le16(1024),
106 static struct usb_endpoint_descriptor gser_ss_out_desc = {
107 .bLength = USB_DT_ENDPOINT_SIZE,
108 .bDescriptorType = USB_DT_ENDPOINT,
109 .bmAttributes = USB_ENDPOINT_XFER_BULK,
110 .wMaxPacketSize = cpu_to_le16(1024),
113 static struct usb_ss_ep_comp_descriptor gser_ss_bulk_comp_desc = {
114 .bLength = sizeof gser_ss_bulk_comp_desc,
115 .bDescriptorType = USB_DT_SS_ENDPOINT_COMP,
118 static struct usb_descriptor_header *gser_ss_function[] = {
119 (struct usb_descriptor_header *) &gser_interface_desc,
120 (struct usb_descriptor_header *) &gser_ss_in_desc,
121 (struct usb_descriptor_header *) &gser_ss_bulk_comp_desc,
122 (struct usb_descriptor_header *) &gser_ss_out_desc,
123 (struct usb_descriptor_header *) &gser_ss_bulk_comp_desc,
124 NULL,
127 /* string descriptors: */
129 static struct usb_string gser_string_defs[] = {
130 [0].s = "Generic Serial",
131 { } /* end of list */
134 static struct usb_gadget_strings gser_string_table = {
135 .language = 0x0409, /* en-us */
136 .strings = gser_string_defs,
139 static struct usb_gadget_strings *gser_strings[] = {
140 &gser_string_table,
141 NULL,
144 /*-------------------------------------------------------------------------*/
146 static int gser_set_alt(struct usb_function *f, unsigned intf, unsigned alt)
148 struct f_gser *gser = func_to_gser(f);
149 struct usb_composite_dev *cdev = f->config->cdev;
151 /* we know alt == 0, so this is an activation or a reset */
153 if (gser->port.in->enabled) {
154 dev_dbg(&cdev->gadget->dev,
155 "reset generic ttyGS%d\n", gser->port_num);
156 gserial_disconnect(&gser->port);
158 if (!gser->port.in->desc || !gser->port.out->desc) {
159 dev_dbg(&cdev->gadget->dev,
160 "activate generic ttyGS%d\n", gser->port_num);
161 if (config_ep_by_speed(cdev->gadget, f, gser->port.in) ||
162 config_ep_by_speed(cdev->gadget, f, gser->port.out)) {
163 gser->port.in->desc = NULL;
164 gser->port.out->desc = NULL;
165 return -EINVAL;
168 gserial_connect(&gser->port, gser->port_num);
169 return 0;
172 static void gser_disable(struct usb_function *f)
174 struct f_gser *gser = func_to_gser(f);
175 struct usb_composite_dev *cdev = f->config->cdev;
177 dev_dbg(&cdev->gadget->dev,
178 "generic ttyGS%d deactivated\n", gser->port_num);
179 gserial_disconnect(&gser->port);
182 /*-------------------------------------------------------------------------*/
184 /* serial function driver setup/binding */
186 static int gser_bind(struct usb_configuration *c, struct usb_function *f)
188 struct usb_composite_dev *cdev = c->cdev;
189 struct f_gser *gser = func_to_gser(f);
190 int status;
191 struct usb_ep *ep;
193 /* REVISIT might want instance-specific strings to help
194 * distinguish instances ...
197 /* maybe allocate device-global string ID */
198 if (gser_string_defs[0].id == 0) {
199 status = usb_string_id(c->cdev);
200 if (status < 0)
201 return status;
202 gser_string_defs[0].id = status;
205 /* allocate instance-specific interface IDs */
206 status = usb_interface_id(c, f);
207 if (status < 0)
208 goto fail;
209 gser->data_id = status;
210 gser_interface_desc.bInterfaceNumber = status;
212 status = -ENODEV;
214 /* allocate instance-specific endpoints */
215 ep = usb_ep_autoconfig(cdev->gadget, &gser_fs_in_desc);
216 if (!ep)
217 goto fail;
218 gser->port.in = ep;
220 ep = usb_ep_autoconfig(cdev->gadget, &gser_fs_out_desc);
221 if (!ep)
222 goto fail;
223 gser->port.out = ep;
225 /* support all relevant hardware speeds... we expect that when
226 * hardware is dual speed, all bulk-capable endpoints work at
227 * both speeds
229 gser_hs_in_desc.bEndpointAddress = gser_fs_in_desc.bEndpointAddress;
230 gser_hs_out_desc.bEndpointAddress = gser_fs_out_desc.bEndpointAddress;
232 gser_ss_in_desc.bEndpointAddress = gser_fs_in_desc.bEndpointAddress;
233 gser_ss_out_desc.bEndpointAddress = gser_fs_out_desc.bEndpointAddress;
235 status = usb_assign_descriptors(f, gser_fs_function, gser_hs_function,
236 gser_ss_function, NULL);
237 if (status)
238 goto fail;
239 dev_dbg(&cdev->gadget->dev, "generic ttyGS%d: %s speed IN/%s OUT/%s\n",
240 gser->port_num,
241 gadget_is_superspeed(c->cdev->gadget) ? "super" :
242 gadget_is_dualspeed(c->cdev->gadget) ? "dual" : "full",
243 gser->port.in->name, gser->port.out->name);
244 return 0;
246 fail:
247 ERROR(cdev, "%s: can't bind, err %d\n", f->name, status);
249 return status;
252 static inline struct f_serial_opts *to_f_serial_opts(struct config_item *item)
254 return container_of(to_config_group(item), struct f_serial_opts,
255 func_inst.group);
258 static void serial_attr_release(struct config_item *item)
260 struct f_serial_opts *opts = to_f_serial_opts(item);
262 usb_put_function_instance(&opts->func_inst);
265 static struct configfs_item_operations serial_item_ops = {
266 .release = serial_attr_release,
269 #ifdef CONFIG_U_SERIAL_CONSOLE
271 static ssize_t f_serial_console_store(struct config_item *item,
272 const char *page, size_t count)
274 return gserial_set_console(to_f_serial_opts(item)->port_num,
275 page, count);
278 static ssize_t f_serial_console_show(struct config_item *item, char *page)
280 return gserial_get_console(to_f_serial_opts(item)->port_num, page);
283 CONFIGFS_ATTR(f_serial_, console);
285 #endif /* CONFIG_U_SERIAL_CONSOLE */
287 static ssize_t f_serial_port_num_show(struct config_item *item, char *page)
289 return sprintf(page, "%u\n", to_f_serial_opts(item)->port_num);
292 CONFIGFS_ATTR_RO(f_serial_, port_num);
294 static struct configfs_attribute *acm_attrs[] = {
295 #ifdef CONFIG_U_SERIAL_CONSOLE
296 &f_serial_attr_console,
297 #endif
298 &f_serial_attr_port_num,
299 NULL,
302 static const struct config_item_type serial_func_type = {
303 .ct_item_ops = &serial_item_ops,
304 .ct_attrs = acm_attrs,
305 .ct_owner = THIS_MODULE,
308 static void gser_free_inst(struct usb_function_instance *f)
310 struct f_serial_opts *opts;
312 opts = container_of(f, struct f_serial_opts, func_inst);
313 gserial_free_line(opts->port_num);
314 kfree(opts);
317 static struct usb_function_instance *gser_alloc_inst(void)
319 struct f_serial_opts *opts;
320 int ret;
322 opts = kzalloc(sizeof(*opts), GFP_KERNEL);
323 if (!opts)
324 return ERR_PTR(-ENOMEM);
326 opts->func_inst.free_func_inst = gser_free_inst;
327 ret = gserial_alloc_line(&opts->port_num);
328 if (ret) {
329 kfree(opts);
330 return ERR_PTR(ret);
332 config_group_init_type_name(&opts->func_inst.group, "",
333 &serial_func_type);
335 return &opts->func_inst;
338 static void gser_free(struct usb_function *f)
340 struct f_gser *serial;
342 serial = func_to_gser(f);
343 kfree(serial);
346 static void gser_unbind(struct usb_configuration *c, struct usb_function *f)
348 usb_free_all_descriptors(f);
351 static struct usb_function *gser_alloc(struct usb_function_instance *fi)
353 struct f_gser *gser;
354 struct f_serial_opts *opts;
356 /* allocate and initialize one new instance */
357 gser = kzalloc(sizeof(*gser), GFP_KERNEL);
358 if (!gser)
359 return ERR_PTR(-ENOMEM);
361 opts = container_of(fi, struct f_serial_opts, func_inst);
363 gser->port_num = opts->port_num;
365 gser->port.func.name = "gser";
366 gser->port.func.strings = gser_strings;
367 gser->port.func.bind = gser_bind;
368 gser->port.func.unbind = gser_unbind;
369 gser->port.func.set_alt = gser_set_alt;
370 gser->port.func.disable = gser_disable;
371 gser->port.func.free_func = gser_free;
373 return &gser->port.func;
376 DECLARE_USB_FUNCTION_INIT(gser, gser_alloc_inst, gser_alloc);
377 MODULE_LICENSE("GPL");
378 MODULE_AUTHOR("Al Borchers");
379 MODULE_AUTHOR("David Brownell");