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 15 static unsigned int vudc_number = 1; 16 17 module_param_named(num, vudc_number, uint, S_IRUGO); 18 MODULE_PARM_DESC(num, "number of emulated controllers"); 19 20 static struct platform_driver vudc_driver = { 21 .probe = vudc_probe, 22 .remove = vudc_remove, 23 .driver = { 24 .name = GADGET_NAME, 25 }, 26 }; 27 28 static struct list_head vudc_devices = LIST_HEAD_INIT(vudc_devices); 29 30 static int __init init(void) 31 { 32 int retval = -ENOMEM; 33 int i; 34 struct vudc_device *udc_dev = NULL, *udc_dev2 = NULL; 35 36 if (usb_disabled()) 37 return -ENODEV; 38 39 if (vudc_number < 1) { 40 pr_err("Number of emulated UDC must be no less than 1"); 41 return -EINVAL; 42 } 43 44 retval = platform_driver_register(&vudc_driver); 45 if (retval < 0) 46 goto out; 47 48 for (i = 0; i < vudc_number; i++) { 49 udc_dev = alloc_vudc_device(i); 50 if (!udc_dev) { 51 retval = -ENOMEM; 52 goto cleanup; 53 } 54 55 retval = platform_device_add(udc_dev->pdev); 56 if (retval < 0) { 57 put_vudc_device(udc_dev); 58 goto cleanup; 59 } 60 61 list_add_tail(&udc_dev->dev_entry, &vudc_devices); 62 if (!platform_get_drvdata(udc_dev->pdev)) { 63 /* 64 * The udc was added successfully but its probe 65 * function failed for some reason. 66 */ 67 retval = -EINVAL; 68 goto cleanup; 69 } 70 } 71 goto out; 72 73 cleanup: 74 list_for_each_entry_safe(udc_dev, udc_dev2, &vudc_devices, dev_entry) { 75 list_del(&udc_dev->dev_entry); 76 platform_device_del(udc_dev->pdev); 77 put_vudc_device(udc_dev); 78 } 79 80 platform_driver_unregister(&vudc_driver); 81 out: 82 return retval; 83 } 84 module_init(init); 85 86 static void __exit cleanup(void) 87 { 88 struct vudc_device *udc_dev = NULL, *udc_dev2 = NULL; 89 90 list_for_each_entry_safe(udc_dev, udc_dev2, &vudc_devices, dev_entry) { 91 list_del(&udc_dev->dev_entry); 92 platform_device_unregister(udc_dev->pdev); 93 put_vudc_device(udc_dev); 94 } 95 platform_driver_unregister(&vudc_driver); 96 } 97 module_exit(cleanup); 98 99 MODULE_DESCRIPTION("USB over IP Device Controller"); 100 MODULE_AUTHOR("Krzysztof Opasiak, Karol Kosik, Igor Kotrasinski"); 101 MODULE_LICENSE("GPL"); 102