usb: gadget: udc-core: allow udc class register gadget device

[firefly-linux-kernel-4.4.55.git] / drivers / usb / gadget / udc-core.c

diff --git a/drivers/usb/gadget/udc-core.c b/drivers/usb/gadget/udc-core.c
index 2a9cd369f71cd857cce96f48acb4b600a828c981..919505426ec14dd8b224985817d00693d288e740 100644 (file)
--- a/drivers/usb/gadget/udc-core.c
+++ b/drivers/usb/gadget/udc-core.c
@@ -173,6 +173,14 @@ int usb_add_gadget_udc(struct device *parent, struct usb_gadget *gadget)
        if (!udc)
                goto err1;
 
+       if (gadget->register_my_device) {
+               dev_set_name(&gadget->dev, "gadget");
+
+               ret = device_register(&gadget->dev);
+               if (ret)
+                       goto err2;
+       }
+
        device_initialize(&udc->dev);
        udc->dev.release = usb_udc_release;
        udc->dev.class = udc_class;
@@ -180,7 +188,7 @@ int usb_add_gadget_udc(struct device *parent, struct usb_gadget *gadget)
        udc->dev.parent = parent;
        ret = dev_set_name(&udc->dev, "%s", kobject_name(&parent->kobj));
        if (ret)
-               goto err2;
+               goto err3;
 
        udc->gadget = gadget;
 
@@ -189,18 +197,22 @@ int usb_add_gadget_udc(struct device *parent, struct usb_gadget *gadget)
 
        ret = device_add(&udc->dev);
        if (ret)
-               goto err3;
+               goto err4;
 
        mutex_unlock(&udc_lock);
 
        return 0;
-err3:
+
+err4:
        list_del(&udc->list);
        mutex_unlock(&udc_lock);
 
-err2:
+err3:
        put_device(&udc->dev);
 
+err2:
+       if (gadget->register_my_device)
+               put_device(&gadget->dev);
 err1:
        return ret;
 }
@@ -254,6 +266,9 @@ found:
 
        kobject_uevent(&udc->dev.kobj, KOBJ_REMOVE);
        device_unregister(&udc->dev);
+
+       if (gadget->register_my_device)
+               device_unregister(&gadget->dev);
 }
 EXPORT_SYMBOL_GPL(usb_del_gadget_udc);