udc-core.c revision 974a70bdecea5296db1b643e4046ef208e99c592
12ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi/** 22ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * udc.c - Core UDC Framework 32ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * 42ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * Copyright (C) 2010 Texas Instruments 52ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * Author: Felipe Balbi <balbi@ti.com> 62ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * 72ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * This program is free software: you can redistribute it and/or modify 82ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * it under the terms of the GNU General Public License version 2 of 92ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * the License as published by the Free Software Foundation. 102ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * 112ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * This program is distributed in the hope that it will be useful, 122ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * but WITHOUT ANY WARRANTY; without even the implied warranty of 132ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 142ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * GNU General Public License for more details. 152ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * 162ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * You should have received a copy of the GNU General Public License 172ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * along with this program. If not, see <http://www.gnu.org/licenses/>. 182ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi */ 192ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 202ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi#include <linux/kernel.h> 212ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi#include <linux/module.h> 222ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi#include <linux/device.h> 232ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi#include <linux/list.h> 242ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi#include <linux/err.h> 25a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi#include <linux/dma-mapping.h> 265702f75375aa9ecf8ad3431aef3fe6ce8c8dbd15Felipe Balbi#include <linux/workqueue.h> 272ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 282ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi#include <linux/usb/ch9.h> 292ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi#include <linux/usb/gadget.h> 302ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 312ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi/** 322ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * struct usb_udc - describes one usb device controller 332ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * @driver - the gadget driver pointer. For use by the class code 342ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * @dev - the child device to the actual controller 352ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * @gadget - the gadget. For use by the class code 362ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * @list - for use by the udc class driver 372ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * 382ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * This represents the internal data structure which is used by the UDC-class 392ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * to hold information about udc driver and gadget together. 402ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi */ 412ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistruct usb_udc { 422ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct usb_gadget_driver *driver; 432ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct usb_gadget *gadget; 442ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct device dev; 452ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct list_head list; 462ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi}; 472ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 482ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic struct class *udc_class; 492ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic LIST_HEAD(udc_list); 502ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic DEFINE_MUTEX(udc_lock); 512ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 522ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi/* ------------------------------------------------------------------------- */ 532ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 54908b961326b2ecfbf494c9b2f206847d925f269dAlan Stern#ifdef CONFIG_HAS_DMA 55908b961326b2ecfbf494c9b2f206847d925f269dAlan Stern 56a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbiint usb_gadget_map_request(struct usb_gadget *gadget, 57a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi struct usb_request *req, int is_in) 58a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi{ 59a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi if (req->length == 0) 60a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi return 0; 61a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi 62a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi if (req->num_sgs) { 63a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi int mapped; 64a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi 65a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi mapped = dma_map_sg(&gadget->dev, req->sg, req->num_sgs, 66a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi is_in ? DMA_TO_DEVICE : DMA_FROM_DEVICE); 67a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi if (mapped == 0) { 68a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi dev_err(&gadget->dev, "failed to map SGs\n"); 69a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi return -EFAULT; 70a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi } 71a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi 72a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi req->num_mapped_sgs = mapped; 73a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi } else { 74a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi req->dma = dma_map_single(&gadget->dev, req->buf, req->length, 75a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi is_in ? DMA_TO_DEVICE : DMA_FROM_DEVICE); 76a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi 77a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi if (dma_mapping_error(&gadget->dev, req->dma)) { 78a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi dev_err(&gadget->dev, "failed to map buffer\n"); 79a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi return -EFAULT; 80a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi } 81a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi } 82a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi 83a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi return 0; 84a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi} 85a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe BalbiEXPORT_SYMBOL_GPL(usb_gadget_map_request); 86a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi 87a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbivoid usb_gadget_unmap_request(struct usb_gadget *gadget, 88a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi struct usb_request *req, int is_in) 89a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi{ 90a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi if (req->length == 0) 91a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi return; 92a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi 93a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi if (req->num_mapped_sgs) { 94a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi dma_unmap_sg(&gadget->dev, req->sg, req->num_mapped_sgs, 95a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi is_in ? DMA_TO_DEVICE : DMA_FROM_DEVICE); 96a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi 97a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi req->num_mapped_sgs = 0; 98a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi } else { 99a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi dma_unmap_single(&gadget->dev, req->dma, req->length, 100a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi is_in ? DMA_TO_DEVICE : DMA_FROM_DEVICE); 101a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi } 102a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi} 103a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe BalbiEXPORT_SYMBOL_GPL(usb_gadget_unmap_request); 104a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi 105908b961326b2ecfbf494c9b2f206847d925f269dAlan Stern#endif /* CONFIG_HAS_DMA */ 106908b961326b2ecfbf494c9b2f206847d925f269dAlan Stern 107a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi/* ------------------------------------------------------------------------- */ 108a698908d3b3be915ac20cd37faeff1216f6b4fe8Felipe Balbi 1095702f75375aa9ecf8ad3431aef3fe6ce8c8dbd15Felipe Balbistatic void usb_gadget_state_work(struct work_struct *work) 1105702f75375aa9ecf8ad3431aef3fe6ce8c8dbd15Felipe Balbi{ 1115702f75375aa9ecf8ad3431aef3fe6ce8c8dbd15Felipe Balbi struct usb_gadget *gadget = work_to_gadget(work); 1125702f75375aa9ecf8ad3431aef3fe6ce8c8dbd15Felipe Balbi 113165f60642ae988f0b9dcfd4988806e7a938b26c7Greg Kroah-Hartman sysfs_notify(&gadget->dev.kobj, NULL, "state"); 1145702f75375aa9ecf8ad3431aef3fe6ce8c8dbd15Felipe Balbi} 1155702f75375aa9ecf8ad3431aef3fe6ce8c8dbd15Felipe Balbi 11649401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbivoid usb_gadget_set_state(struct usb_gadget *gadget, 11749401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi enum usb_device_state state) 11849401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi{ 11949401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi gadget->state = state; 1205702f75375aa9ecf8ad3431aef3fe6ce8c8dbd15Felipe Balbi schedule_work(&gadget->work); 12149401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi} 12249401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe BalbiEXPORT_SYMBOL_GPL(usb_gadget_set_state); 12349401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi 12449401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi/* ------------------------------------------------------------------------- */ 12549401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi 1262ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi/** 127974a70bdecea5296db1b643e4046ef208e99c592Peter Chen * usb_gadget_udc_reset - notifies the udc core that bus reset occurs 128974a70bdecea5296db1b643e4046ef208e99c592Peter Chen * @gadget: The gadget which bus reset occurs 129974a70bdecea5296db1b643e4046ef208e99c592Peter Chen * @driver: The gadget driver we want to notify 130974a70bdecea5296db1b643e4046ef208e99c592Peter Chen * 131974a70bdecea5296db1b643e4046ef208e99c592Peter Chen * If the udc driver has bus reset handler, it needs to call this when the bus 132974a70bdecea5296db1b643e4046ef208e99c592Peter Chen * reset occurs, it notifies the gadget driver that the bus reset occurs as 133974a70bdecea5296db1b643e4046ef208e99c592Peter Chen * well as updates gadget state. 134974a70bdecea5296db1b643e4046ef208e99c592Peter Chen */ 135974a70bdecea5296db1b643e4046ef208e99c592Peter Chenvoid usb_gadget_udc_reset(struct usb_gadget *gadget, 136974a70bdecea5296db1b643e4046ef208e99c592Peter Chen struct usb_gadget_driver *driver) 137974a70bdecea5296db1b643e4046ef208e99c592Peter Chen{ 138974a70bdecea5296db1b643e4046ef208e99c592Peter Chen driver->reset(gadget); 139974a70bdecea5296db1b643e4046ef208e99c592Peter Chen usb_gadget_set_state(gadget, USB_STATE_DEFAULT); 140974a70bdecea5296db1b643e4046ef208e99c592Peter Chen} 141974a70bdecea5296db1b643e4046ef208e99c592Peter ChenEXPORT_SYMBOL_GPL(usb_gadget_udc_reset); 142974a70bdecea5296db1b643e4046ef208e99c592Peter Chen 143974a70bdecea5296db1b643e4046ef208e99c592Peter Chen/** 144352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * usb_gadget_udc_start - tells usb device controller to start up 145352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * @gadget: The gadget we want to get started 146352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * @driver: The driver we want to bind to @gadget 147352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * 148352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * This call is issued by the UDC Class driver when it's about 149352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * to register a gadget driver to the device controller, before 150352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * calling gadget driver's bind() method. 151352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * 152352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * It allows the controller to be powered off until strictly 153352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * necessary to have it powered on. 154352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * 155352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * Returns zero on success, else negative errno. 156352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior */ 157352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewiorstatic inline int usb_gadget_udc_start(struct usb_gadget *gadget, 158352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior struct usb_gadget_driver *driver) 159352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior{ 160352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior return gadget->ops->udc_start(gadget, driver); 161352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior} 162352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior 163352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior/** 164352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * usb_gadget_udc_stop - tells usb device controller we don't need it anymore 165352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * @gadget: The device we want to stop activity 166352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * @driver: The driver to unbind from @gadget 167352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * 168352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * This call is issued by the UDC Class driver after calling 169352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * gadget driver's unbind() method. 170352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * 171352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * The details are implementation specific, but it can go as 172352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * far as powering off UDC completely and disable its data 173352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior * line pullups. 174352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior */ 175352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewiorstatic inline void usb_gadget_udc_stop(struct usb_gadget *gadget, 176352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior struct usb_gadget_driver *driver) 177352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior{ 178352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior gadget->ops->udc_stop(gadget, driver); 179352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior} 180352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior 181352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior/** 1822ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * usb_udc_release - release the usb_udc struct 1832ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * @dev: the dev member within usb_udc 1842ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * 1852ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * This is called by driver's core in order to free memory once the last 1862ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * reference is released. 1872ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi */ 1882ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic void usb_udc_release(struct device *dev) 1892ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ 1902ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct usb_udc *udc; 1912ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 1922ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc = container_of(dev, struct usb_udc, dev); 1932ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi dev_dbg(dev, "releasing '%s'\n", dev_name(dev)); 1942ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi kfree(udc); 1952ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} 1962ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 197019f976e8f268a63b2fcbb662aa2f77f6b07bac6Sebastian Andrzej Siewiorstatic const struct attribute_group *usb_udc_attr_groups[]; 198792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi 199792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbistatic void usb_udc_nop_release(struct device *dev) 200792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi{ 201792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi dev_vdbg(dev, "%s\n", __func__); 202792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi} 203792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi 2042ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi/** 205792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi * usb_add_gadget_udc_release - adds a new gadget to the udc class driver list 206792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi * @parent: the parent device to this udc. Usually the controller driver's 207792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi * device. 208792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi * @gadget: the gadget to be added to the list. 209792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi * @release: a gadget release function. 2102ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * 2112ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * Returns zero on success, negative errno otherwise. 2122ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi */ 213792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbiint usb_add_gadget_udc_release(struct device *parent, struct usb_gadget *gadget, 214792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi void (*release)(struct device *dev)) 2152ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ 2162ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct usb_udc *udc; 2172ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi int ret = -ENOMEM; 2182ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 2192ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc = kzalloc(sizeof(*udc), GFP_KERNEL); 2202ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (!udc) 2212ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi goto err1; 2222ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 2237bce401cc6db5508ef2517e45bd8caf7ce0a15eeFelipe Balbi dev_set_name(&gadget->dev, "gadget"); 2245702f75375aa9ecf8ad3431aef3fe6ce8c8dbd15Felipe Balbi INIT_WORK(&gadget->work, usb_gadget_state_work); 2252ed14320f3fed9e5b774ef68bdf73a4f3e28844eFelipe Balbi gadget->dev.parent = parent; 226f07bd56bbdaa2340ebf46af9a37e7b2d1b4578e3Felipe Balbi 227908b961326b2ecfbf494c9b2f206847d925f269dAlan Stern#ifdef CONFIG_HAS_DMA 228658c8cf14dce1093e9f810f7e04a711ed79da6bdFelipe Balbi dma_set_coherent_mask(&gadget->dev, parent->coherent_dma_mask); 229658c8cf14dce1093e9f810f7e04a711ed79da6bdFelipe Balbi gadget->dev.dma_parms = parent->dma_parms; 230658c8cf14dce1093e9f810f7e04a711ed79da6bdFelipe Balbi gadget->dev.dma_mask = parent->dma_mask; 231908b961326b2ecfbf494c9b2f206847d925f269dAlan Stern#endif 232658c8cf14dce1093e9f810f7e04a711ed79da6bdFelipe Balbi 233ddf47ccbfebc12add813cf729ecfc2d5ab59ca19Felipe Balbi if (release) 234792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi gadget->dev.release = release; 235ddf47ccbfebc12add813cf729ecfc2d5ab59ca19Felipe Balbi else 236ddf47ccbfebc12add813cf729ecfc2d5ab59ca19Felipe Balbi gadget->dev.release = usb_udc_nop_release; 237792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi 2387bce401cc6db5508ef2517e45bd8caf7ce0a15eeFelipe Balbi ret = device_register(&gadget->dev); 2397bce401cc6db5508ef2517e45bd8caf7ce0a15eeFelipe Balbi if (ret) 2407bce401cc6db5508ef2517e45bd8caf7ce0a15eeFelipe Balbi goto err2; 241f07bd56bbdaa2340ebf46af9a37e7b2d1b4578e3Felipe Balbi 2422ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi device_initialize(&udc->dev); 2432ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->dev.release = usb_udc_release; 2442ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->dev.class = udc_class; 245019f976e8f268a63b2fcbb662aa2f77f6b07bac6Sebastian Andrzej Siewior udc->dev.groups = usb_udc_attr_groups; 2462ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->dev.parent = parent; 2472ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi ret = dev_set_name(&udc->dev, "%s", kobject_name(&parent->kobj)); 2482ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (ret) 249f07bd56bbdaa2340ebf46af9a37e7b2d1b4578e3Felipe Balbi goto err3; 2502ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 2512ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->gadget = gadget; 2522ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 2532ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi mutex_lock(&udc_lock); 2542ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi list_add_tail(&udc->list, &udc_list); 2552ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 2562ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi ret = device_add(&udc->dev); 2572ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (ret) 258f07bd56bbdaa2340ebf46af9a37e7b2d1b4578e3Felipe Balbi goto err4; 2592ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 26049401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi usb_gadget_set_state(gadget, USB_STATE_NOTATTACHED); 2612ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 2622ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi mutex_unlock(&udc_lock); 2632ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 2642ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return 0; 265f07bd56bbdaa2340ebf46af9a37e7b2d1b4578e3Felipe Balbi 266f07bd56bbdaa2340ebf46af9a37e7b2d1b4578e3Felipe Balbierr4: 2672ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi list_del(&udc->list); 2682ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi mutex_unlock(&udc_lock); 2692ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 270f07bd56bbdaa2340ebf46af9a37e7b2d1b4578e3Felipe Balbierr3: 2712ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi put_device(&udc->dev); 2722ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 273f07bd56bbdaa2340ebf46af9a37e7b2d1b4578e3Felipe Balbierr2: 2747bce401cc6db5508ef2517e45bd8caf7ce0a15eeFelipe Balbi put_device(&gadget->dev); 275c5dbc220b327dc1ff5e0b1d829c091347511ed83Felipe Balbi kfree(udc); 2767bce401cc6db5508ef2517e45bd8caf7ce0a15eeFelipe Balbi 2772ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbierr1: 2782ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return ret; 2792ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} 280792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe BalbiEXPORT_SYMBOL_GPL(usb_add_gadget_udc_release); 281792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi 282792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi/** 283792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi * usb_add_gadget_udc - adds a new gadget to the udc class driver list 284792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi * @parent: the parent device to this udc. Usually the controller 285792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi * driver's device. 286792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi * @gadget: the gadget to be added to the list 287792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi * 288792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi * Returns zero on success, negative errno otherwise. 289792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi */ 290792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbiint usb_add_gadget_udc(struct device *parent, struct usb_gadget *gadget) 291792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi{ 292792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi return usb_add_gadget_udc_release(parent, gadget, NULL); 293792bfcf7a1cd7913fa5d55f2b3a40e3275e98f6fFelipe Balbi} 2942ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe BalbiEXPORT_SYMBOL_GPL(usb_add_gadget_udc); 2952ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 2962ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic void usb_gadget_remove_driver(struct usb_udc *udc) 2972ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ 2982ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi dev_dbg(&udc->dev, "unregistering UDC driver [%s]\n", 2992ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->gadget->name); 3002ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3012ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi kobject_uevent(&udc->dev.kobj, KOBJ_CHANGE); 3022ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3032d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi usb_gadget_disconnect(udc->gadget); 3042d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi udc->driver->disconnect(udc->gadget); 3052d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi udc->driver->unbind(udc->gadget); 306511f3c5326eabe1ece35202a404c24c0aeacc246Alan Stern usb_gadget_udc_stop(udc->gadget, NULL); 3072ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3082ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->driver = NULL; 3092ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->dev.driver = NULL; 31070d3a49878cb3fc0e5ec0bd1e607c7ac63743f67Felipe Balbi udc->gadget->dev.driver = NULL; 3112ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} 3122ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3132ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi/** 3142ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * usb_del_gadget_udc - deletes @udc from udc_list 3152ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * @gadget: the gadget to be removed. 3162ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * 3172ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * This, will call usb_gadget_unregister_driver() if 3182ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi * the @udc is still busy. 3192ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi */ 3202ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbivoid usb_del_gadget_udc(struct usb_gadget *gadget) 3212ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ 3222ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct usb_udc *udc = NULL; 3232ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3242ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi mutex_lock(&udc_lock); 3252ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi list_for_each_entry(udc, &udc_list, list) 3262ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (udc->gadget == gadget) 3272ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi goto found; 3282ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3292ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi dev_err(gadget->dev.parent, "gadget not registered.\n"); 3302ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi mutex_unlock(&udc_lock); 3312ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3322ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return; 3332ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3342ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbifound: 3352ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi dev_vdbg(gadget->dev.parent, "unregistering gadget\n"); 3362ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3372ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi list_del(&udc->list); 3382ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi mutex_unlock(&udc_lock); 3392ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3402ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (udc->driver) 3412ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi usb_gadget_remove_driver(udc); 3422ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3432ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi kobject_uevent(&udc->dev.kobj, KOBJ_REMOVE); 3445702f75375aa9ecf8ad3431aef3fe6ce8c8dbd15Felipe Balbi flush_work(&gadget->work); 3452ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi device_unregister(&udc->dev); 3467bce401cc6db5508ef2517e45bd8caf7ce0a15eeFelipe Balbi device_unregister(&gadget->dev); 3472ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} 3482ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe BalbiEXPORT_SYMBOL_GPL(usb_del_gadget_udc); 3492ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3502ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi/* ------------------------------------------------------------------------- */ 3512ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3524c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewiorstatic int udc_bind_to_driver(struct usb_udc *udc, struct usb_gadget_driver *driver) 3532ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ 3544c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior int ret; 3552ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3562ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi dev_dbg(&udc->dev, "registering UDC driver [%s]\n", 3572ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi driver->function); 3582ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3592ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->driver = driver; 3602ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->dev.driver = &driver->driver; 36170d3a49878cb3fc0e5ec0bd1e607c7ac63743f67Felipe Balbi udc->gadget->dev.driver = &driver->driver; 3622ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3632d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi ret = driver->bind(udc->gadget, driver); 3642d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi if (ret) 3652d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi goto err1; 3662d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi ret = usb_gadget_udc_start(udc->gadget, driver); 3672d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi if (ret) { 3682d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi driver->unbind(udc->gadget); 3692d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi goto err1; 370352c2dc8b07491bbab77ddf86c20c16a97326ee7Sebastian Andrzej Siewior } 3712d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi usb_gadget_connect(udc->gadget); 3722ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 3732ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi kobject_uevent(&udc->dev.kobj, KOBJ_CHANGE); 3742ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return 0; 3752ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbierr1: 376f8cffc84a2ff8efc2ecca6128485877109e499f5Fabio Estevam if (ret != -EISNAM) 377f8cffc84a2ff8efc2ecca6128485877109e499f5Fabio Estevam dev_err(&udc->dev, "failed to start %s: %d\n", 3782ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->driver->function, ret); 3792ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->driver = NULL; 3802ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->dev.driver = NULL; 38170d3a49878cb3fc0e5ec0bd1e607c7ac63743f67Felipe Balbi udc->gadget->dev.driver = NULL; 3824c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior return ret; 3834c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior} 3844c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior 3854c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewiorint udc_attach_driver(const char *name, struct usb_gadget_driver *driver) 3864c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior{ 3874c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior struct usb_udc *udc = NULL; 3884c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior int ret = -ENODEV; 3894c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior 3904c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior mutex_lock(&udc_lock); 3914c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior list_for_each_entry(udc, &udc_list, list) { 3924c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior ret = strcmp(name, dev_name(&udc->dev)); 3934c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior if (!ret) 3944c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior break; 3954c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior } 3964c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior if (ret) { 3974c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior ret = -ENODEV; 3984c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior goto out; 3994c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior } 4004c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior if (udc->driver) { 4014c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior ret = -EBUSY; 4024c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior goto out; 4034c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior } 4044c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior ret = udc_bind_to_driver(udc, driver); 4054c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewiorout: 4064c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior mutex_unlock(&udc_lock); 4074c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior return ret; 4084c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior} 4094c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej SiewiorEXPORT_SYMBOL_GPL(udc_attach_driver); 4104c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior 4114c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewiorint usb_gadget_probe_driver(struct usb_gadget_driver *driver) 4124c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior{ 4134c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior struct usb_udc *udc = NULL; 4144c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior int ret; 4154c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior 4164c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior if (!driver || !driver->bind || !driver->setup) 4174c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior return -EINVAL; 4184c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior 4194c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior mutex_lock(&udc_lock); 4204c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior list_for_each_entry(udc, &udc_list, list) { 4214c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior /* For now we take the first one */ 4224c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior if (!udc->driver) 4234c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior goto found; 4244c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior } 4254c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior 4264c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior pr_debug("couldn't find an available UDC\n"); 4274c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior mutex_unlock(&udc_lock); 4284c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior return -ENODEV; 4294c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewiorfound: 4304c49a5f0ef1bc61395329ea7a9fce2893e97eaa6Sebastian Andrzej Siewior ret = udc_bind_to_driver(udc, driver); 4312ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi mutex_unlock(&udc_lock); 4322ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return ret; 4332ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} 4342ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe BalbiEXPORT_SYMBOL_GPL(usb_gadget_probe_driver); 4352ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 4362ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbiint usb_gadget_unregister_driver(struct usb_gadget_driver *driver) 4372ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ 4382ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct usb_udc *udc = NULL; 4392ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi int ret = -ENODEV; 4402ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 4412ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (!driver || !driver->unbind) 4422ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return -EINVAL; 4432ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 4442ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi mutex_lock(&udc_lock); 4452ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi list_for_each_entry(udc, &udc_list, list) 4462ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (udc->driver == driver) { 4472ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi usb_gadget_remove_driver(udc); 448b5fb8d0a40eb52039e8df6fadafa95ecdcdc3026Peter Chen usb_gadget_set_state(udc->gadget, 449b5fb8d0a40eb52039e8df6fadafa95ecdcdc3026Peter Chen USB_STATE_NOTATTACHED); 4502ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi ret = 0; 4512ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi break; 4522ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi } 4532ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 4542ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi mutex_unlock(&udc_lock); 4552ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return ret; 4562ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} 4572ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe BalbiEXPORT_SYMBOL_GPL(usb_gadget_unregister_driver); 4582ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 4592ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi/* ------------------------------------------------------------------------- */ 4602ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 4612ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic ssize_t usb_udc_srp_store(struct device *dev, 4622ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct device_attribute *attr, const char *buf, size_t n) 4632ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ 4641d91a96268a0b2d7301c3ee67a784b712f34010fFelipe Balbi struct usb_udc *udc = container_of(dev, struct usb_udc, dev); 4652ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 4662ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (sysfs_streq(buf, "1")) 4672ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi usb_gadget_wakeup(udc->gadget); 4682ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 4692ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return n; 4702ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} 4712ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic DEVICE_ATTR(srp, S_IWUSR, NULL, usb_udc_srp_store); 4722ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 4732ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic ssize_t usb_udc_softconn_store(struct device *dev, 4742ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct device_attribute *attr, const char *buf, size_t n) 4752ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ 476865569ba5a8b0cc840e2b9c16ca6b42d6d5306b4Felipe Balbi struct usb_udc *udc = container_of(dev, struct usb_udc, dev); 4772ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 4782ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (sysfs_streq(buf, "connect")) { 4792d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi usb_gadget_udc_start(udc->gadget, udc->driver); 4802ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi usb_gadget_connect(udc->gadget); 4812ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi } else if (sysfs_streq(buf, "disconnect")) { 48283a787a71e034244a9fd1d5988fe18f226341417Felipe Balbi usb_gadget_disconnect(udc->gadget); 4832d7ebbb0946e9e13285eee348df1dbc48f0580e0Felipe Balbi usb_gadget_udc_stop(udc->gadget, udc->driver); 4842ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi } else { 4852ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi dev_err(dev, "unsupported command '%s'\n", buf); 4862ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return -EINVAL; 4872ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi } 4882ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 4892ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return n; 4902ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} 4912ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic DEVICE_ATTR(soft_connect, S_IWUSR, NULL, usb_udc_softconn_store); 4922ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 493ce26bd23d4ad180883f53709f9a2220dc771c030Greg Kroah-Hartmanstatic ssize_t state_show(struct device *dev, struct device_attribute *attr, 494ce26bd23d4ad180883f53709f9a2220dc771c030Greg Kroah-Hartman char *buf) 49549401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi{ 49649401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi struct usb_udc *udc = container_of(dev, struct usb_udc, dev); 49749401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi struct usb_gadget *gadget = udc->gadget; 49849401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi 49949401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi return sprintf(buf, "%s\n", usb_state_string(gadget->state)); 50049401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi} 501ce26bd23d4ad180883f53709f9a2220dc771c030Greg Kroah-Hartmanstatic DEVICE_ATTR_RO(state); 50249401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi 503d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewicz#define USB_UDC_SPEED_ATTR(name, param) \ 504ce26bd23d4ad180883f53709f9a2220dc771c030Greg Kroah-Hartmanssize_t name##_show(struct device *dev, \ 505d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewicz struct device_attribute *attr, char *buf) \ 506d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewicz{ \ 507d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewicz struct usb_udc *udc = container_of(dev, struct usb_udc, dev); \ 508d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewicz return snprintf(buf, PAGE_SIZE, "%s\n", \ 509d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewicz usb_speed_string(udc->gadget->param)); \ 510d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewicz} \ 511ce26bd23d4ad180883f53709f9a2220dc771c030Greg Kroah-Hartmanstatic DEVICE_ATTR_RO(name) 512d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewicz 513d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewiczstatic USB_UDC_SPEED_ATTR(current_speed, speed); 514d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewiczstatic USB_UDC_SPEED_ATTR(maximum_speed, max_speed); 515d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewicz 5162ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi#define USB_UDC_ATTR(name) \ 517ce26bd23d4ad180883f53709f9a2220dc771c030Greg Kroah-Hartmanssize_t name##_show(struct device *dev, \ 5182ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct device_attribute *attr, char *buf) \ 5192ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ \ 520019f976e8f268a63b2fcbb662aa2f77f6b07bac6Sebastian Andrzej Siewior struct usb_udc *udc = container_of(dev, struct usb_udc, dev); \ 5212ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct usb_gadget *gadget = udc->gadget; \ 5222ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi \ 5232ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return snprintf(buf, PAGE_SIZE, "%d\n", gadget->name); \ 5242ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} \ 525ce26bd23d4ad180883f53709f9a2220dc771c030Greg Kroah-Hartmanstatic DEVICE_ATTR_RO(name) 5262ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5272ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic USB_UDC_ATTR(is_otg); 5282ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic USB_UDC_ATTR(is_a_peripheral); 5292ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic USB_UDC_ATTR(b_hnp_enable); 5302ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic USB_UDC_ATTR(a_hnp_support); 5312ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic USB_UDC_ATTR(a_alt_hnp_support); 5322ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5332ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic struct attribute *usb_udc_attrs[] = { 5342ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi &dev_attr_srp.attr, 5352ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi &dev_attr_soft_connect.attr, 53649401f4169c0e5a1b38f1a676d6f12eecaf77485Felipe Balbi &dev_attr_state.attr, 537d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewicz &dev_attr_current_speed.attr, 538d327ab5b6d660d6fe22b073b743fde1668e593bbMichal Nazarewicz &dev_attr_maximum_speed.attr, 5392ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5402ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi &dev_attr_is_otg.attr, 5412ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi &dev_attr_is_a_peripheral.attr, 5422ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi &dev_attr_b_hnp_enable.attr, 5432ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi &dev_attr_a_hnp_support.attr, 5442ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi &dev_attr_a_alt_hnp_support.attr, 5452ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi NULL, 5462ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi}; 5472ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5482ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic const struct attribute_group usb_udc_attr_group = { 5492ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi .attrs = usb_udc_attrs, 5502ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi}; 5512ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5522ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic const struct attribute_group *usb_udc_attr_groups[] = { 5532ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi &usb_udc_attr_group, 5542ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi NULL, 5552ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi}; 5562ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5572ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic int usb_udc_uevent(struct device *dev, struct kobj_uevent_env *env) 5582ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ 5592ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi struct usb_udc *udc = container_of(dev, struct usb_udc, dev); 5602ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi int ret; 5612ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5622ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi ret = add_uevent_var(env, "USB_UDC_NAME=%s", udc->gadget->name); 5632ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (ret) { 5642ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi dev_err(dev, "failed to add uevent USB_UDC_NAME\n"); 5652ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return ret; 5662ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi } 5672ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5682ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (udc->driver) { 5692ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi ret = add_uevent_var(env, "USB_UDC_DRIVER=%s", 5702ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc->driver->function); 5712ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (ret) { 5722ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi dev_err(dev, "failed to add uevent USB_UDC_DRIVER\n"); 5732ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return ret; 5742ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi } 5752ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi } 5762ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5772ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return 0; 5782ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} 5792ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5802ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic int __init usb_udc_init(void) 5812ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ 5822ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc_class = class_create(THIS_MODULE, "udc"); 5832ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi if (IS_ERR(udc_class)) { 5842ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi pr_err("failed to create udc class --> %ld\n", 5852ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi PTR_ERR(udc_class)); 5862ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return PTR_ERR(udc_class); 5872ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi } 5882ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5892ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi udc_class->dev_uevent = usb_udc_uevent; 5902ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi return 0; 5912ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} 5922ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbisubsys_initcall(usb_udc_init); 5932ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 5942ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbistatic void __exit usb_udc_exit(void) 5952ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi{ 5962ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi class_destroy(udc_class); 5972ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi} 5982ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbimodule_exit(usb_udc_exit); 5992ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe Balbi 6002ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe BalbiMODULE_DESCRIPTION("UDC Framework"); 6012ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe BalbiMODULE_AUTHOR("Felipe Balbi <balbi@ti.com>"); 6022ccea03a8f7ec93641791f2760d7cdc6cab6205fFelipe BalbiMODULE_LICENSE("GPL v2"); 603