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