|
@@ -16,6 +16,7 @@
|
|
|
#include <linux/kernel.h>
|
|
|
#include <linux/module.h>
|
|
|
|
|
|
+#include "u_serial.h"
|
|
|
#if defined USB_ETH_RNDIS
|
|
|
# undef USB_ETH_RNDIS
|
|
|
#endif
|
|
@@ -41,8 +42,6 @@ MODULE_LICENSE("GPL");
|
|
|
* a "gcc --combine ... part1.c part2.c part3.c ... " build would.
|
|
|
*/
|
|
|
#include "f_mass_storage.c"
|
|
|
-#define USB_FACM_INCLUDED
|
|
|
-#include "f_acm.c"
|
|
|
|
|
|
#include "f_ecm.c"
|
|
|
#include "f_subset.c"
|
|
@@ -137,10 +136,12 @@ static struct fsg_common fsg_common;
|
|
|
static u8 hostaddr[ETH_ALEN];
|
|
|
|
|
|
static unsigned char tty_line;
|
|
|
+static struct usb_function_instance *fi_acm;
|
|
|
|
|
|
/********** RNDIS **********/
|
|
|
|
|
|
#ifdef USB_ETH_RNDIS
|
|
|
+static struct usb_function *f_acm_rndis;
|
|
|
|
|
|
static __init int rndis_do_config(struct usb_configuration *c)
|
|
|
{
|
|
@@ -155,15 +156,25 @@ static __init int rndis_do_config(struct usb_configuration *c)
|
|
|
if (ret < 0)
|
|
|
return ret;
|
|
|
|
|
|
- ret = acm_bind_config(c, tty_line);
|
|
|
- if (ret < 0)
|
|
|
- return ret;
|
|
|
+ f_acm_rndis = usb_get_function(fi_acm);
|
|
|
+ if (IS_ERR(f_acm_rndis))
|
|
|
+ goto err_func_acm;
|
|
|
+
|
|
|
+ ret = usb_add_function(c, f_acm_rndis);
|
|
|
+ if (ret)
|
|
|
+ goto err_conf;
|
|
|
|
|
|
ret = fsg_bind_config(c->cdev, c, &fsg_common);
|
|
|
if (ret < 0)
|
|
|
- return ret;
|
|
|
+ goto err_fsg;
|
|
|
|
|
|
return 0;
|
|
|
+err_fsg:
|
|
|
+ usb_remove_function(c, f_acm_rndis);
|
|
|
+err_conf:
|
|
|
+ usb_put_function(f_acm_rndis);
|
|
|
+err_func_acm:
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
static int rndis_config_register(struct usb_composite_dev *cdev)
|
|
@@ -192,6 +203,7 @@ static int rndis_config_register(struct usb_composite_dev *cdev)
|
|
|
/********** CDC ECM **********/
|
|
|
|
|
|
#ifdef CONFIG_USB_G_MULTI_CDC
|
|
|
+static struct usb_function *f_acm_multi;
|
|
|
|
|
|
static __init int cdc_do_config(struct usb_configuration *c)
|
|
|
{
|
|
@@ -206,15 +218,26 @@ static __init int cdc_do_config(struct usb_configuration *c)
|
|
|
if (ret < 0)
|
|
|
return ret;
|
|
|
|
|
|
- ret = acm_bind_config(c, tty_line);
|
|
|
- if (ret < 0)
|
|
|
- return ret;
|
|
|
+ /* implicit port_num is zero */
|
|
|
+ f_acm_multi = usb_get_function(fi_acm);
|
|
|
+ if (IS_ERR(f_acm_multi))
|
|
|
+ goto err_func_acm;
|
|
|
+
|
|
|
+ ret = usb_add_function(c, f_acm_multi);
|
|
|
+ if (ret)
|
|
|
+ goto err_conf;
|
|
|
|
|
|
ret = fsg_bind_config(c->cdev, c, &fsg_common);
|
|
|
if (ret < 0)
|
|
|
- return ret;
|
|
|
+ goto err_fsg;
|
|
|
|
|
|
return 0;
|
|
|
+err_fsg:
|
|
|
+ usb_remove_function(c, f_acm_multi);
|
|
|
+err_conf:
|
|
|
+ usb_put_function(f_acm_multi);
|
|
|
+err_func_acm:
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
static int cdc_config_register(struct usb_composite_dev *cdev)
|
|
@@ -246,6 +269,7 @@ static int cdc_config_register(struct usb_composite_dev *cdev)
|
|
|
static int __ref multi_bind(struct usb_composite_dev *cdev)
|
|
|
{
|
|
|
struct usb_gadget *gadget = cdev->gadget;
|
|
|
+ struct f_serial_opts *opts;
|
|
|
int status;
|
|
|
|
|
|
if (!can_support_ecm(cdev->gadget)) {
|
|
@@ -264,6 +288,15 @@ static int __ref multi_bind(struct usb_composite_dev *cdev)
|
|
|
if (status < 0)
|
|
|
goto fail0;
|
|
|
|
|
|
+ fi_acm = usb_get_function_instance("acm");
|
|
|
+ if (IS_ERR(fi_acm)) {
|
|
|
+ status = PTR_ERR(fi_acm);
|
|
|
+ goto fail0dot5;
|
|
|
+ }
|
|
|
+
|
|
|
+ opts = container_of(fi_acm, struct f_serial_opts, func_inst);
|
|
|
+ opts->port_num = tty_line;
|
|
|
+
|
|
|
/* set up mass storage function */
|
|
|
{
|
|
|
void *retp;
|
|
@@ -300,6 +333,8 @@ static int __ref multi_bind(struct usb_composite_dev *cdev)
|
|
|
fail2:
|
|
|
fsg_common_put(&fsg_common);
|
|
|
fail1:
|
|
|
+ usb_put_function_instance(fi_acm);
|
|
|
+fail0dot5:
|
|
|
gserial_free_line(tty_line);
|
|
|
fail0:
|
|
|
gether_cleanup();
|
|
@@ -308,6 +343,13 @@ fail0:
|
|
|
|
|
|
static int __exit multi_unbind(struct usb_composite_dev *cdev)
|
|
|
{
|
|
|
+#ifdef CONFIG_USB_G_MULTI_CDC
|
|
|
+ usb_put_function(f_acm_multi);
|
|
|
+#endif
|
|
|
+#ifdef USB_ETH_RNDIS
|
|
|
+ usb_put_function(f_acm_rndis);
|
|
|
+#endif
|
|
|
+ usb_put_function_instance(fi_acm);
|
|
|
gserial_free_line(tty_line);
|
|
|
gether_cleanup();
|
|
|
return 0;
|