1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Copyright (C) 2015 Karol Kosik <karo9@interia.eu>
4 * Copyright (C) 2015-2016 Samsung Electronics
5 *               Igor Kotrasinski <i.kotrasinsk@samsung.com>
6 *               Krzysztof Opasiak <k.opasiak@samsung.com>
7 */
8
9#include <linux/device.h>
10#include <linux/list.h>
11#include <linux/module.h>
12
13#include "vudc.h"
14
15static unsigned int vudc_number = 1;
16
17module_param_named(num, vudc_number, uint, S_IRUGO);
18MODULE_PARM_DESC(num, "number of emulated controllers");
19
20static struct platform_driver vudc_driver = {
21	.probe		= vudc_probe,
22	.remove_new	= vudc_remove,
23	.driver		= {
24		.name	= GADGET_NAME,
25		.dev_groups = vudc_groups,
26	},
27};
28
29static LIST_HEAD(vudc_devices);
30
31static int __init vudc_init(void)
32{
33	int retval = -ENOMEM;
34	int i;
35	struct vudc_device *udc_dev = NULL, *udc_dev2 = NULL;
36
37	if (usb_disabled())
38		return -ENODEV;
39
40	if (vudc_number < 1) {
41		pr_err("Number of emulated UDC must be no less than 1");
42		return -EINVAL;
43	}
44
45	retval = platform_driver_register(&vudc_driver);
46	if (retval < 0)
47		goto out;
48
49	for (i = 0; i < vudc_number; i++) {
50		udc_dev = alloc_vudc_device(i);
51		if (!udc_dev) {
52			retval = -ENOMEM;
53			goto cleanup;
54		}
55
56		retval = platform_device_add(udc_dev->pdev);
57		if (retval < 0) {
58			put_vudc_device(udc_dev);
59			goto cleanup;
60		}
61
62		list_add_tail(&udc_dev->dev_entry, &vudc_devices);
63		if (!platform_get_drvdata(udc_dev->pdev)) {
64			/*
65			 * The udc was added successfully but its probe
66			 * function failed for some reason.
67			 */
68			retval = -EINVAL;
69			goto cleanup;
70		}
71	}
72	goto out;
73
74cleanup:
75	list_for_each_entry_safe(udc_dev, udc_dev2, &vudc_devices, dev_entry) {
76		list_del(&udc_dev->dev_entry);
77		/*
78		 * Just do platform_device_del() here, put_vudc_device()
79		 * calls the platform_device_put()
80		 */
81		platform_device_del(udc_dev->pdev);
82		put_vudc_device(udc_dev);
83	}
84
85	platform_driver_unregister(&vudc_driver);
86out:
87	return retval;
88}
89module_init(vudc_init);
90
91static void __exit vudc_cleanup(void)
92{
93	struct vudc_device *udc_dev = NULL, *udc_dev2 = NULL;
94
95	list_for_each_entry_safe(udc_dev, udc_dev2, &vudc_devices, dev_entry) {
96		list_del(&udc_dev->dev_entry);
97		/*
98		 * Just do platform_device_del() here, put_vudc_device()
99		 * calls the platform_device_put()
100		 */
101		platform_device_del(udc_dev->pdev);
102		put_vudc_device(udc_dev);
103	}
104	platform_driver_unregister(&vudc_driver);
105}
106module_exit(vudc_cleanup);
107
108MODULE_DESCRIPTION("USB over IP Device Controller");
109MODULE_AUTHOR("Krzysztof Opasiak, Karol Kosik, Igor Kotrasinski");
110MODULE_LICENSE("GPL");
111