Merge "USB: gadget: qti: Add sysfs node to unbind/bind gadget" (794df1bc) · Commits · e / devices / android_kernel_xiaomi_nabu

drivers/usb/gadget/legacy/qti_gadget.c

+43 −0

Original line number	Diff line number	Diff line
		@@ -42,6 +42,7 @@ struct qti_usb_gadget {
		struct usb_composite_driver composite;

		const char *composition_funcs;
		bool enabled;
		struct device *dev;
		};

		@@ -419,6 +420,9 @@ static int qti_gadget_register(struct qti_usb_gadget *qg)
		{
		int ret;

		if (qg->enabled)
		return -EINVAL;

		ret = qti_usb_configs_make(qg, qg->composition_funcs);
		if (ret)
		return ret;
		@@ -443,6 +447,8 @@ static int qti_gadget_register(struct qti_usb_gadget *qg)
		if (ret)
		goto free_name;

		qg->enabled = true;

		return 0;

		free_name:
		@@ -455,9 +461,14 @@ static int qti_gadget_register(struct qti_usb_gadget *qg)

		static void qti_gadget_unregister(struct qti_usb_gadget *qg)
		{
		if (!qg->enabled)
		return;

		usb_gadget_unregister_driver(&qg->composite.gadget_driver);
		kfree(qg->composite.gadget_driver.function);
		qti_cleanup_configs_funcs(qg);

		qg->enabled = false;
		}

		static int qti_gadget_get_properties(struct qti_usb_gadget *gadget)
		@@ -525,6 +536,35 @@ static int qti_gadget_get_properties(struct qti_usb_gadget *gadget)
		return 0;
		}

		static ssize_t enabled_show(struct device *dev,
		struct device_attribute attr, char buf)
		{
		struct qti_usb_gadget *qg = dev_get_drvdata(dev);

		return snprintf(buf, PAGE_SIZE, "%c\n",
		qg->enabled ? 'Y' : 'N');
		}

		static ssize_t enabled_store(struct device *dev,
		struct device_attribute attr, const char buf, size_t count)
		{
		struct qti_usb_gadget *qg = dev_get_drvdata(dev);
		bool enable;
		int ret;

		ret = strtobool(buf, &enable);
		if (ret)
		return ret;

		if (enable)
		qti_gadget_register(qg);
		else
		qti_gadget_unregister(qg);

		return count;
		}
		static DEVICE_ATTR_RW(enabled);

		static int qti_gadget_probe(struct platform_device *pdev)
		{
		int ret;
		@@ -548,6 +588,8 @@ static int qti_gadget_probe(struct platform_device *pdev)
		if (ret)
		return ret;

		device_create_file(&pdev->dev, &dev_attr_enabled);

		return 0;
		}

		@@ -555,6 +597,7 @@ static int qti_gadget_remove(struct platform_device *pdev)
		{
		struct qti_usb_gadget *qg = platform_get_drvdata(pdev);

		device_remove_file(&pdev->dev, &dev_attr_enabled);
		qti_gadget_unregister(qg);

		return 0;