projects / deliverable / linux.git / blame
| Commit | Line | Data |
|---|---|---|
| 80fd9cd5 IK |
1 | /* |
| 2 | * Copyright (C) 2015 Karol Kosik <karo9@interia.eu> | |
| 3 | * Copyright (C) 2015-2016 Samsung Electronics | |
| 4 | * Igor Kotrasinski <i.kotrasinsk@samsung.com> | |
| 5 | * Krzysztof Opasiak <k.opasiak@samsung.com> | |
| 6 | * | |
| 7 | * This program is free software; you can redistribute it and/or modify | |
| 8 | * it under the terms of the GNU General Public License as published by | |
| 9 | * the Free Software Foundation; either version 2 of the License, or | |
| 10 | * (at your option) any later version. | |
| 11 | * | |
| 12 | * This program is distributed in the hope that it will be useful, | |
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
| 15 | * GNU General Public License for more details. | |
| 16 | * | |
| 17 | * You should have received a copy of the GNU General Public License | |
| 18 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | |
| 19 | */ | |
| 20 | ||
| 21 | #include <linux/device.h> | |
| 22 | #include <linux/list.h> | |
| 23 | #include <linux/module.h> | |
| 24 | ||
| 25 | #include "vudc.h" | |
| 26 | ||
| 27 | static unsigned int vudc_number = 1; | |
| 28 | ||
| 29 | module_param_named(num, vudc_number, uint, S_IRUGO); | |
| 30 | MODULE_PARM_DESC(num, "number of emulated controllers"); | |
| 31 | ||
| 32 | static struct platform_driver vudc_driver = { | |
| 33 | .probe = vudc_probe, | |
| 34 | .remove = vudc_remove, | |
| 35 | .driver = { | |
| 36 | .name = GADGET_NAME, | |
| 37 | }, | |
| 38 | }; | |
| 39 | ||
| 40 | static struct list_head vudc_devices = LIST_HEAD_INIT(vudc_devices); | |
| 41 | ||
| 42 | static int __init init(void) | |
| 43 | { | |
| 44 | int retval = -ENOMEM; | |
| 45 | int i; | |
| 46 | struct vudc_device *udc_dev = NULL, *udc_dev2 = NULL; | |
| 47 | ||
| 48 | if (usb_disabled()) | |
| 49 | return -ENODEV; | |
| 50 | ||
| 51 | if (vudc_number < 1) { | |
| 52 | pr_err("Number of emulated UDC must be no less than 1"); | |
| 53 | return -EINVAL; | |
| 54 | } | |
| 55 | ||
| 56 | retval = platform_driver_register(&vudc_driver); | |
| 57 | if (retval < 0) | |
| 58 | goto out; | |
| 59 | ||
| 60 | for (i = 0; i < vudc_number; i++) { | |
| 61 | udc_dev = alloc_vudc_device(i); | |
| 62 | if (!udc_dev) { | |
| 63 | retval = -ENOMEM; | |
| 64 | goto cleanup; | |
| 65 | } | |
| 66 | ||
| 67 | retval = platform_device_add(udc_dev->pdev); | |
| 68 | if (retval < 0) { | |
| 69 | put_vudc_device(udc_dev); | |
| 70 | goto cleanup; | |
| 71 | } | |
| 72 | ||
| 73 | list_add_tail(&udc_dev->dev_entry, &vudc_devices); | |
| 74 | if (!platform_get_drvdata(udc_dev->pdev)) { | |
| 75 | /* | |
| 76 | * The udc was added successfully but its probe | |
| 77 | * function failed for some reason. | |
| 78 | */ | |
| 79 | retval = -EINVAL; | |
| 80 | goto cleanup; | |
| 81 | } | |
| 82 | } | |
| 83 | goto out; | |
| 84 | ||
| 85 | cleanup: | |
| 86 | list_for_each_entry_safe(udc_dev, udc_dev2, &vudc_devices, dev_entry) { | |
| 87 | list_del(&udc_dev->dev_entry); | |
| 88 | platform_device_del(udc_dev->pdev); | |
| 89 | put_vudc_device(udc_dev); | |
| 90 | } | |
| 91 | ||
| 92 | platform_driver_unregister(&vudc_driver); | |
| 93 | out: | |
| 94 | return retval; | |
| 95 | } | |
| 96 | module_init(init); | |
| 97 | ||
| 98 | static void __exit cleanup(void) | |
| 99 | { | |
| 100 | struct vudc_device *udc_dev = NULL, *udc_dev2 = NULL; | |
| 101 | ||
| 102 | list_for_each_entry_safe(udc_dev, udc_dev2, &vudc_devices, dev_entry) { | |
| 103 | list_del(&udc_dev->dev_entry); | |
| 104 | platform_device_unregister(udc_dev->pdev); | |
| 105 | put_vudc_device(udc_dev); | |
| 106 | } | |
| 107 | platform_driver_unregister(&vudc_driver); | |
| 108 | } | |
| 109 | module_exit(cleanup); | |
| 110 | ||
| 111 | MODULE_DESCRIPTION("USB over IP Device Controller"); | |
| 112 | MODULE_AUTHOR("Krzysztof Opasiak, Karol Kosik, Igor Kotrasinski"); | |
| 113 | MODULE_LICENSE("GPL"); |