| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * dummy_hcd.c -- Dummy/Loopback USB host and device emulator driver. | 
|  | 3 | * | 
|  | 4 | * Maintainer: Alan Stern <stern@rowland.harvard.edu> | 
|  | 5 | * | 
|  | 6 | * Copyright (C) 2003 David Brownell | 
|  | 7 | * Copyright (C) 2003-2005 Alan Stern | 
|  | 8 | * | 
|  | 9 | * This program is free software; you can redistribute it and/or modify | 
|  | 10 | * it under the terms of the GNU General Public License as published by | 
|  | 11 | * the Free Software Foundation; either version 2 of the License, or | 
|  | 12 | * (at your option) any later version. | 
|  | 13 | * | 
|  | 14 | * This program is distributed in the hope that it will be useful, | 
|  | 15 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | 16 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  | 17 | * GNU General Public License for more details. | 
|  | 18 | * | 
|  | 19 | * You should have received a copy of the GNU General Public License | 
|  | 20 | * along with this program; if not, write to the Free Software | 
|  | 21 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA | 
|  | 22 | */ | 
|  | 23 |  | 
|  | 24 |  | 
|  | 25 | /* | 
|  | 26 | * This exposes a device side "USB gadget" API, driven by requests to a | 
|  | 27 | * Linux-USB host controller driver.  USB traffic is simulated; there's | 
|  | 28 | * no need for USB hardware.  Use this with two other drivers: | 
|  | 29 | * | 
|  | 30 | *  - Gadget driver, responding to requests (slave); | 
|  | 31 | *  - Host-side device driver, as already familiar in Linux. | 
|  | 32 | * | 
|  | 33 | * Having this all in one kernel can help some stages of development, | 
|  | 34 | * bypassing some hardware (and driver) issues.  UML could help too. | 
|  | 35 | */ | 
|  | 36 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | #include <linux/module.h> | 
|  | 38 | #include <linux/kernel.h> | 
|  | 39 | #include <linux/delay.h> | 
|  | 40 | #include <linux/ioport.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | #include <linux/slab.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | #include <linux/errno.h> | 
|  | 43 | #include <linux/init.h> | 
|  | 44 | #include <linux/timer.h> | 
|  | 45 | #include <linux/list.h> | 
|  | 46 | #include <linux/interrupt.h> | 
| Russell King | d052d1b | 2005-10-29 19:07:23 +0100 | [diff] [blame] | 47 | #include <linux/platform_device.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | #include <linux/usb.h> | 
| David Brownell | 9454a57 | 2007-10-04 18:05:17 -0700 | [diff] [blame] | 49 | #include <linux/usb/gadget.h> | 
| Eric Lescouet | 27729aa | 2010-04-24 23:21:52 +0200 | [diff] [blame] | 50 | #include <linux/usb/hcd.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 51 |  | 
|  | 52 | #include <asm/byteorder.h> | 
|  | 53 | #include <asm/io.h> | 
|  | 54 | #include <asm/irq.h> | 
|  | 55 | #include <asm/system.h> | 
|  | 56 | #include <asm/unaligned.h> | 
|  | 57 |  | 
|  | 58 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | #define DRIVER_DESC	"USB Host+Gadget Emulator" | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 60 | #define DRIVER_VERSION	"02 May 2005" | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 61 |  | 
| Alan Stern | caf29f6 | 2007-12-06 11:10:39 -0500 | [diff] [blame] | 62 | #define POWER_BUDGET	500	/* in mA; use 8 for low-power port testing */ | 
|  | 63 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 64 | static const char	driver_name [] = "dummy_hcd"; | 
|  | 65 | static const char	driver_desc [] = "USB Host+Gadget Emulator"; | 
|  | 66 |  | 
|  | 67 | static const char	gadget_name [] = "dummy_udc"; | 
|  | 68 |  | 
|  | 69 | MODULE_DESCRIPTION (DRIVER_DESC); | 
|  | 70 | MODULE_AUTHOR ("David Brownell"); | 
|  | 71 | MODULE_LICENSE ("GPL"); | 
|  | 72 |  | 
|  | 73 | /*-------------------------------------------------------------------------*/ | 
|  | 74 |  | 
|  | 75 | /* gadget side driver data structres */ | 
|  | 76 | struct dummy_ep { | 
|  | 77 | struct list_head		queue; | 
|  | 78 | unsigned long			last_io;	/* jiffies timestamp */ | 
|  | 79 | struct usb_gadget		*gadget; | 
|  | 80 | const struct usb_endpoint_descriptor *desc; | 
|  | 81 | struct usb_ep			ep; | 
|  | 82 | unsigned			halted : 1; | 
| Alan Stern | 851a526 | 2008-08-14 15:48:30 -0400 | [diff] [blame] | 83 | unsigned			wedged : 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 | unsigned			already_seen : 1; | 
|  | 85 | unsigned			setup_stage : 1; | 
|  | 86 | }; | 
|  | 87 |  | 
|  | 88 | struct dummy_request { | 
|  | 89 | struct list_head		queue;		/* ep's requests */ | 
|  | 90 | struct usb_request		req; | 
|  | 91 | }; | 
|  | 92 |  | 
|  | 93 | static inline struct dummy_ep *usb_ep_to_dummy_ep (struct usb_ep *_ep) | 
|  | 94 | { | 
|  | 95 | return container_of (_ep, struct dummy_ep, ep); | 
|  | 96 | } | 
|  | 97 |  | 
|  | 98 | static inline struct dummy_request *usb_request_to_dummy_request | 
|  | 99 | (struct usb_request *_req) | 
|  | 100 | { | 
|  | 101 | return container_of (_req, struct dummy_request, req); | 
|  | 102 | } | 
|  | 103 |  | 
|  | 104 | /*-------------------------------------------------------------------------*/ | 
|  | 105 |  | 
|  | 106 | /* | 
|  | 107 | * Every device has ep0 for control requests, plus up to 30 more endpoints, | 
|  | 108 | * in one of two types: | 
|  | 109 | * | 
|  | 110 | *   - Configurable:  direction (in/out), type (bulk, iso, etc), and endpoint | 
|  | 111 | *     number can be changed.  Names like "ep-a" are used for this type. | 
|  | 112 | * | 
|  | 113 | *   - Fixed Function:  in other cases.  some characteristics may be mutable; | 
|  | 114 | *     that'd be hardware-specific.  Names like "ep12out-bulk" are used. | 
|  | 115 | * | 
|  | 116 | * Gadget drivers are responsible for not setting up conflicting endpoint | 
|  | 117 | * configurations, illegal or unsupported packet lengths, and so on. | 
|  | 118 | */ | 
|  | 119 |  | 
|  | 120 | static const char ep0name [] = "ep0"; | 
|  | 121 |  | 
|  | 122 | static const char *const ep_name [] = { | 
|  | 123 | ep0name,				/* everyone has ep0 */ | 
|  | 124 |  | 
|  | 125 | /* act like a net2280: high speed, six configurable endpoints */ | 
|  | 126 | "ep-a", "ep-b", "ep-c", "ep-d", "ep-e", "ep-f", | 
|  | 127 |  | 
|  | 128 | /* or like pxa250: fifteen fixed function endpoints */ | 
|  | 129 | "ep1in-bulk", "ep2out-bulk", "ep3in-iso", "ep4out-iso", "ep5in-int", | 
|  | 130 | "ep6in-bulk", "ep7out-bulk", "ep8in-iso", "ep9out-iso", "ep10in-int", | 
|  | 131 | "ep11in-bulk", "ep12out-bulk", "ep13in-iso", "ep14out-iso", | 
|  | 132 | "ep15in-int", | 
|  | 133 |  | 
|  | 134 | /* or like sa1100: two fixed function endpoints */ | 
|  | 135 | "ep1out-bulk", "ep2in-bulk", | 
|  | 136 | }; | 
| Tobias Klauser | 52950ed | 2005-12-11 16:20:08 +0100 | [diff] [blame] | 137 | #define DUMMY_ENDPOINTS	ARRAY_SIZE(ep_name) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 138 |  | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 139 | /*-------------------------------------------------------------------------*/ | 
|  | 140 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 141 | #define FIFO_SIZE		64 | 
|  | 142 |  | 
|  | 143 | struct urbp { | 
|  | 144 | struct urb		*urb; | 
|  | 145 | struct list_head	urbp_list; | 
|  | 146 | }; | 
|  | 147 |  | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 148 |  | 
|  | 149 | enum dummy_rh_state { | 
|  | 150 | DUMMY_RH_RESET, | 
|  | 151 | DUMMY_RH_SUSPENDED, | 
|  | 152 | DUMMY_RH_RUNNING | 
|  | 153 | }; | 
|  | 154 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 | struct dummy { | 
|  | 156 | spinlock_t			lock; | 
|  | 157 |  | 
|  | 158 | /* | 
|  | 159 | * SLAVE/GADGET side support | 
|  | 160 | */ | 
|  | 161 | struct dummy_ep			ep [DUMMY_ENDPOINTS]; | 
|  | 162 | int				address; | 
|  | 163 | struct usb_gadget		gadget; | 
|  | 164 | struct usb_gadget_driver	*driver; | 
|  | 165 | struct dummy_request		fifo_req; | 
|  | 166 | u8				fifo_buf [FIFO_SIZE]; | 
|  | 167 | u16				devstatus; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 168 | unsigned			udc_suspended:1; | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 169 | unsigned			pullup:1; | 
|  | 170 | unsigned			active:1; | 
|  | 171 | unsigned			old_active:1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 172 |  | 
|  | 173 | /* | 
|  | 174 | * MASTER/HOST side support | 
|  | 175 | */ | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 176 | enum dummy_rh_state		rh_state; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 177 | struct timer_list		timer; | 
|  | 178 | u32				port_status; | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 179 | u32				old_status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 180 | unsigned			resuming:1; | 
|  | 181 | unsigned long			re_timeout; | 
|  | 182 |  | 
|  | 183 | struct usb_device		*udev; | 
|  | 184 | struct list_head		urbp_list; | 
|  | 185 | }; | 
|  | 186 |  | 
|  | 187 | static inline struct dummy *hcd_to_dummy (struct usb_hcd *hcd) | 
|  | 188 | { | 
|  | 189 | return (struct dummy *) (hcd->hcd_priv); | 
|  | 190 | } | 
|  | 191 |  | 
|  | 192 | static inline struct usb_hcd *dummy_to_hcd (struct dummy *dum) | 
|  | 193 | { | 
|  | 194 | return container_of((void *) dum, struct usb_hcd, hcd_priv); | 
|  | 195 | } | 
|  | 196 |  | 
|  | 197 | static inline struct device *dummy_dev (struct dummy *dum) | 
|  | 198 | { | 
|  | 199 | return dummy_to_hcd(dum)->self.controller; | 
|  | 200 | } | 
|  | 201 |  | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 202 | static inline struct device *udc_dev (struct dummy *dum) | 
|  | 203 | { | 
|  | 204 | return dum->gadget.dev.parent; | 
|  | 205 | } | 
|  | 206 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 207 | static inline struct dummy *ep_to_dummy (struct dummy_ep *ep) | 
|  | 208 | { | 
|  | 209 | return container_of (ep->gadget, struct dummy, gadget); | 
|  | 210 | } | 
|  | 211 |  | 
|  | 212 | static inline struct dummy *gadget_to_dummy (struct usb_gadget *gadget) | 
|  | 213 | { | 
|  | 214 | return container_of (gadget, struct dummy, gadget); | 
|  | 215 | } | 
|  | 216 |  | 
|  | 217 | static inline struct dummy *gadget_dev_to_dummy (struct device *dev) | 
|  | 218 | { | 
|  | 219 | return container_of (dev, struct dummy, gadget.dev); | 
|  | 220 | } | 
|  | 221 |  | 
|  | 222 | static struct dummy			*the_controller; | 
|  | 223 |  | 
|  | 224 | /*-------------------------------------------------------------------------*/ | 
|  | 225 |  | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 226 | /* SLAVE/GADGET SIDE UTILITY ROUTINES */ | 
|  | 227 |  | 
|  | 228 | /* called with spinlock held */ | 
|  | 229 | static void nuke (struct dummy *dum, struct dummy_ep *ep) | 
|  | 230 | { | 
|  | 231 | while (!list_empty (&ep->queue)) { | 
|  | 232 | struct dummy_request	*req; | 
|  | 233 |  | 
|  | 234 | req = list_entry (ep->queue.next, struct dummy_request, queue); | 
|  | 235 | list_del_init (&req->queue); | 
|  | 236 | req->req.status = -ESHUTDOWN; | 
|  | 237 |  | 
|  | 238 | spin_unlock (&dum->lock); | 
|  | 239 | req->req.complete (&ep->ep, &req->req); | 
|  | 240 | spin_lock (&dum->lock); | 
|  | 241 | } | 
|  | 242 | } | 
|  | 243 |  | 
|  | 244 | /* caller must hold lock */ | 
|  | 245 | static void | 
|  | 246 | stop_activity (struct dummy *dum) | 
|  | 247 | { | 
|  | 248 | struct dummy_ep	*ep; | 
|  | 249 |  | 
|  | 250 | /* prevent any more requests */ | 
|  | 251 | dum->address = 0; | 
|  | 252 |  | 
|  | 253 | /* The timer is left running so that outstanding URBs can fail */ | 
|  | 254 |  | 
|  | 255 | /* nuke any pending requests first, so driver i/o is quiesced */ | 
|  | 256 | list_for_each_entry (ep, &dum->gadget.ep_list, ep.ep_list) | 
|  | 257 | nuke (dum, ep); | 
|  | 258 |  | 
|  | 259 | /* driver now does any non-usb quiescing necessary */ | 
|  | 260 | } | 
|  | 261 |  | 
|  | 262 | /* caller must hold lock */ | 
|  | 263 | static void | 
|  | 264 | set_link_state (struct dummy *dum) | 
|  | 265 | { | 
|  | 266 | dum->active = 0; | 
|  | 267 | if ((dum->port_status & USB_PORT_STAT_POWER) == 0) | 
|  | 268 | dum->port_status = 0; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 269 |  | 
|  | 270 | /* UDC suspend must cause a disconnect */ | 
|  | 271 | else if (!dum->pullup || dum->udc_suspended) { | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 272 | dum->port_status &= ~(USB_PORT_STAT_CONNECTION | | 
|  | 273 | USB_PORT_STAT_ENABLE | | 
|  | 274 | USB_PORT_STAT_LOW_SPEED | | 
|  | 275 | USB_PORT_STAT_HIGH_SPEED | | 
|  | 276 | USB_PORT_STAT_SUSPEND); | 
|  | 277 | if ((dum->old_status & USB_PORT_STAT_CONNECTION) != 0) | 
|  | 278 | dum->port_status |= (USB_PORT_STAT_C_CONNECTION << 16); | 
|  | 279 | } else { | 
|  | 280 | dum->port_status |= USB_PORT_STAT_CONNECTION; | 
|  | 281 | if ((dum->old_status & USB_PORT_STAT_CONNECTION) == 0) | 
|  | 282 | dum->port_status |= (USB_PORT_STAT_C_CONNECTION << 16); | 
|  | 283 | if ((dum->port_status & USB_PORT_STAT_ENABLE) == 0) | 
|  | 284 | dum->port_status &= ~USB_PORT_STAT_SUSPEND; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 285 | else if ((dum->port_status & USB_PORT_STAT_SUSPEND) == 0 && | 
|  | 286 | dum->rh_state != DUMMY_RH_SUSPENDED) | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 287 | dum->active = 1; | 
|  | 288 | } | 
|  | 289 |  | 
|  | 290 | if ((dum->port_status & USB_PORT_STAT_ENABLE) == 0 || dum->active) | 
|  | 291 | dum->resuming = 0; | 
|  | 292 |  | 
|  | 293 | if ((dum->port_status & USB_PORT_STAT_CONNECTION) == 0 || | 
|  | 294 | (dum->port_status & USB_PORT_STAT_RESET) != 0) { | 
|  | 295 | if ((dum->old_status & USB_PORT_STAT_CONNECTION) != 0 && | 
|  | 296 | (dum->old_status & USB_PORT_STAT_RESET) == 0 && | 
|  | 297 | dum->driver) { | 
|  | 298 | stop_activity (dum); | 
|  | 299 | spin_unlock (&dum->lock); | 
|  | 300 | dum->driver->disconnect (&dum->gadget); | 
|  | 301 | spin_lock (&dum->lock); | 
|  | 302 | } | 
|  | 303 | } else if (dum->active != dum->old_active) { | 
|  | 304 | if (dum->old_active && dum->driver->suspend) { | 
|  | 305 | spin_unlock (&dum->lock); | 
|  | 306 | dum->driver->suspend (&dum->gadget); | 
|  | 307 | spin_lock (&dum->lock); | 
|  | 308 | } else if (!dum->old_active && dum->driver->resume) { | 
|  | 309 | spin_unlock (&dum->lock); | 
|  | 310 | dum->driver->resume (&dum->gadget); | 
|  | 311 | spin_lock (&dum->lock); | 
|  | 312 | } | 
|  | 313 | } | 
|  | 314 |  | 
|  | 315 | dum->old_status = dum->port_status; | 
|  | 316 | dum->old_active = dum->active; | 
|  | 317 | } | 
|  | 318 |  | 
|  | 319 | /*-------------------------------------------------------------------------*/ | 
|  | 320 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 321 | /* SLAVE/GADGET SIDE DRIVER | 
|  | 322 | * | 
|  | 323 | * This only tracks gadget state.  All the work is done when the host | 
|  | 324 | * side tries some (emulated) i/o operation.  Real device controller | 
|  | 325 | * drivers would do real i/o using dma, fifos, irqs, timers, etc. | 
|  | 326 | */ | 
|  | 327 |  | 
|  | 328 | #define is_enabled(dum) \ | 
|  | 329 | (dum->port_status & USB_PORT_STAT_ENABLE) | 
|  | 330 |  | 
|  | 331 | static int | 
|  | 332 | dummy_enable (struct usb_ep *_ep, const struct usb_endpoint_descriptor *desc) | 
|  | 333 | { | 
|  | 334 | struct dummy		*dum; | 
|  | 335 | struct dummy_ep		*ep; | 
|  | 336 | unsigned		max; | 
|  | 337 | int			retval; | 
|  | 338 |  | 
|  | 339 | ep = usb_ep_to_dummy_ep (_ep); | 
|  | 340 | if (!_ep || !desc || ep->desc || _ep->name == ep0name | 
|  | 341 | || desc->bDescriptorType != USB_DT_ENDPOINT) | 
|  | 342 | return -EINVAL; | 
|  | 343 | dum = ep_to_dummy (ep); | 
|  | 344 | if (!dum->driver || !is_enabled (dum)) | 
|  | 345 | return -ESHUTDOWN; | 
|  | 346 | max = le16_to_cpu(desc->wMaxPacketSize) & 0x3ff; | 
|  | 347 |  | 
|  | 348 | /* drivers must not request bad settings, since lower levels | 
|  | 349 | * (hardware or its drivers) may not check.  some endpoints | 
|  | 350 | * can't do iso, many have maxpacket limitations, etc. | 
|  | 351 | * | 
|  | 352 | * since this "hardware" driver is here to help debugging, we | 
|  | 353 | * have some extra sanity checks.  (there could be more though, | 
|  | 354 | * especially for "ep9out" style fixed function ones.) | 
|  | 355 | */ | 
|  | 356 | retval = -EINVAL; | 
|  | 357 | switch (desc->bmAttributes & 0x03) { | 
|  | 358 | case USB_ENDPOINT_XFER_BULK: | 
|  | 359 | if (strstr (ep->ep.name, "-iso") | 
|  | 360 | || strstr (ep->ep.name, "-int")) { | 
|  | 361 | goto done; | 
|  | 362 | } | 
|  | 363 | switch (dum->gadget.speed) { | 
|  | 364 | case USB_SPEED_HIGH: | 
|  | 365 | if (max == 512) | 
|  | 366 | break; | 
| Ingo van Lil | 9063ff4 | 2008-03-28 14:50:26 -0700 | [diff] [blame] | 367 | goto done; | 
|  | 368 | case USB_SPEED_FULL: | 
|  | 369 | if (max == 8 || max == 16 || max == 32 || max == 64) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 370 | /* we'll fake any legal size */ | 
|  | 371 | break; | 
| Ingo van Lil | 9063ff4 | 2008-03-28 14:50:26 -0700 | [diff] [blame] | 372 | /* save a return statement */ | 
|  | 373 | default: | 
|  | 374 | goto done; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 375 | } | 
|  | 376 | break; | 
|  | 377 | case USB_ENDPOINT_XFER_INT: | 
|  | 378 | if (strstr (ep->ep.name, "-iso")) /* bulk is ok */ | 
|  | 379 | goto done; | 
|  | 380 | /* real hardware might not handle all packet sizes */ | 
|  | 381 | switch (dum->gadget.speed) { | 
|  | 382 | case USB_SPEED_HIGH: | 
|  | 383 | if (max <= 1024) | 
|  | 384 | break; | 
|  | 385 | /* save a return statement */ | 
|  | 386 | case USB_SPEED_FULL: | 
|  | 387 | if (max <= 64) | 
|  | 388 | break; | 
|  | 389 | /* save a return statement */ | 
|  | 390 | default: | 
|  | 391 | if (max <= 8) | 
|  | 392 | break; | 
|  | 393 | goto done; | 
|  | 394 | } | 
|  | 395 | break; | 
|  | 396 | case USB_ENDPOINT_XFER_ISOC: | 
|  | 397 | if (strstr (ep->ep.name, "-bulk") | 
|  | 398 | || strstr (ep->ep.name, "-int")) | 
|  | 399 | goto done; | 
|  | 400 | /* real hardware might not handle all packet sizes */ | 
|  | 401 | switch (dum->gadget.speed) { | 
|  | 402 | case USB_SPEED_HIGH: | 
|  | 403 | if (max <= 1024) | 
|  | 404 | break; | 
|  | 405 | /* save a return statement */ | 
|  | 406 | case USB_SPEED_FULL: | 
|  | 407 | if (max <= 1023) | 
|  | 408 | break; | 
|  | 409 | /* save a return statement */ | 
|  | 410 | default: | 
|  | 411 | goto done; | 
|  | 412 | } | 
|  | 413 | break; | 
|  | 414 | default: | 
|  | 415 | /* few chips support control except on ep0 */ | 
|  | 416 | goto done; | 
|  | 417 | } | 
|  | 418 |  | 
|  | 419 | _ep->maxpacket = max; | 
|  | 420 | ep->desc = desc; | 
|  | 421 |  | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 422 | dev_dbg (udc_dev(dum), "enabled %s (ep%d%s-%s) maxpacket %d\n", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 423 | _ep->name, | 
|  | 424 | desc->bEndpointAddress & 0x0f, | 
|  | 425 | (desc->bEndpointAddress & USB_DIR_IN) ? "in" : "out", | 
|  | 426 | ({ char *val; | 
|  | 427 | switch (desc->bmAttributes & 0x03) { | 
|  | 428 | case USB_ENDPOINT_XFER_BULK: val = "bulk"; break; | 
|  | 429 | case USB_ENDPOINT_XFER_ISOC: val = "iso"; break; | 
|  | 430 | case USB_ENDPOINT_XFER_INT: val = "intr"; break; | 
|  | 431 | default: val = "ctrl"; break; | 
|  | 432 | }; val; }), | 
|  | 433 | max); | 
|  | 434 |  | 
|  | 435 | /* at this point real hardware should be NAKing transfers | 
|  | 436 | * to that endpoint, until a buffer is queued to it. | 
|  | 437 | */ | 
| Alan Stern | 851a526 | 2008-08-14 15:48:30 -0400 | [diff] [blame] | 438 | ep->halted = ep->wedged = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 439 | retval = 0; | 
|  | 440 | done: | 
|  | 441 | return retval; | 
|  | 442 | } | 
|  | 443 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 444 | static int dummy_disable (struct usb_ep *_ep) | 
|  | 445 | { | 
|  | 446 | struct dummy_ep		*ep; | 
|  | 447 | struct dummy		*dum; | 
|  | 448 | unsigned long		flags; | 
|  | 449 | int			retval; | 
|  | 450 |  | 
|  | 451 | ep = usb_ep_to_dummy_ep (_ep); | 
|  | 452 | if (!_ep || !ep->desc || _ep->name == ep0name) | 
|  | 453 | return -EINVAL; | 
|  | 454 | dum = ep_to_dummy (ep); | 
|  | 455 |  | 
|  | 456 | spin_lock_irqsave (&dum->lock, flags); | 
|  | 457 | ep->desc = NULL; | 
|  | 458 | retval = 0; | 
|  | 459 | nuke (dum, ep); | 
|  | 460 | spin_unlock_irqrestore (&dum->lock, flags); | 
|  | 461 |  | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 462 | dev_dbg (udc_dev(dum), "disabled %s\n", _ep->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 463 | return retval; | 
|  | 464 | } | 
|  | 465 |  | 
|  | 466 | static struct usb_request * | 
| Al Viro | 55016f1 | 2005-10-21 03:21:58 -0400 | [diff] [blame] | 467 | dummy_alloc_request (struct usb_ep *_ep, gfp_t mem_flags) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 468 | { | 
|  | 469 | struct dummy_ep		*ep; | 
|  | 470 | struct dummy_request	*req; | 
|  | 471 |  | 
|  | 472 | if (!_ep) | 
|  | 473 | return NULL; | 
|  | 474 | ep = usb_ep_to_dummy_ep (_ep); | 
|  | 475 |  | 
| Eric Sesterhenn | 7039f42 | 2006-02-27 13:34:10 -0800 | [diff] [blame] | 476 | req = kzalloc(sizeof(*req), mem_flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 477 | if (!req) | 
|  | 478 | return NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 479 | INIT_LIST_HEAD (&req->queue); | 
|  | 480 | return &req->req; | 
|  | 481 | } | 
|  | 482 |  | 
|  | 483 | static void | 
|  | 484 | dummy_free_request (struct usb_ep *_ep, struct usb_request *_req) | 
|  | 485 | { | 
|  | 486 | struct dummy_ep		*ep; | 
|  | 487 | struct dummy_request	*req; | 
|  | 488 |  | 
|  | 489 | ep = usb_ep_to_dummy_ep (_ep); | 
|  | 490 | if (!ep || !_req || (!ep->desc && _ep->name != ep0name)) | 
|  | 491 | return; | 
|  | 492 |  | 
|  | 493 | req = usb_request_to_dummy_request (_req); | 
|  | 494 | WARN_ON (!list_empty (&req->queue)); | 
|  | 495 | kfree (req); | 
|  | 496 | } | 
|  | 497 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 498 | static void | 
|  | 499 | fifo_complete (struct usb_ep *ep, struct usb_request *req) | 
|  | 500 | { | 
|  | 501 | } | 
|  | 502 |  | 
|  | 503 | static int | 
| Olav Kongas | 5db539e | 2005-06-23 20:25:36 +0300 | [diff] [blame] | 504 | dummy_queue (struct usb_ep *_ep, struct usb_request *_req, | 
| Al Viro | 55016f1 | 2005-10-21 03:21:58 -0400 | [diff] [blame] | 505 | gfp_t mem_flags) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 506 | { | 
|  | 507 | struct dummy_ep		*ep; | 
|  | 508 | struct dummy_request	*req; | 
|  | 509 | struct dummy		*dum; | 
|  | 510 | unsigned long		flags; | 
|  | 511 |  | 
|  | 512 | req = usb_request_to_dummy_request (_req); | 
|  | 513 | if (!_req || !list_empty (&req->queue) || !_req->complete) | 
|  | 514 | return -EINVAL; | 
|  | 515 |  | 
|  | 516 | ep = usb_ep_to_dummy_ep (_ep); | 
|  | 517 | if (!_ep || (!ep->desc && _ep->name != ep0name)) | 
|  | 518 | return -EINVAL; | 
|  | 519 |  | 
|  | 520 | dum = ep_to_dummy (ep); | 
|  | 521 | if (!dum->driver || !is_enabled (dum)) | 
|  | 522 | return -ESHUTDOWN; | 
|  | 523 |  | 
|  | 524 | #if 0 | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 525 | dev_dbg (udc_dev(dum), "ep %p queue req %p to %s, len %d buf %p\n", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 526 | ep, _req, _ep->name, _req->length, _req->buf); | 
|  | 527 | #endif | 
|  | 528 |  | 
|  | 529 | _req->status = -EINPROGRESS; | 
|  | 530 | _req->actual = 0; | 
|  | 531 | spin_lock_irqsave (&dum->lock, flags); | 
|  | 532 |  | 
|  | 533 | /* implement an emulated single-request FIFO */ | 
|  | 534 | if (ep->desc && (ep->desc->bEndpointAddress & USB_DIR_IN) && | 
|  | 535 | list_empty (&dum->fifo_req.queue) && | 
|  | 536 | list_empty (&ep->queue) && | 
|  | 537 | _req->length <= FIFO_SIZE) { | 
|  | 538 | req = &dum->fifo_req; | 
|  | 539 | req->req = *_req; | 
|  | 540 | req->req.buf = dum->fifo_buf; | 
|  | 541 | memcpy (dum->fifo_buf, _req->buf, _req->length); | 
|  | 542 | req->req.context = dum; | 
|  | 543 | req->req.complete = fifo_complete; | 
|  | 544 |  | 
| David Brownell | c728df7 | 2008-07-26 08:06:24 -0700 | [diff] [blame] | 545 | list_add_tail(&req->queue, &ep->queue); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 546 | spin_unlock (&dum->lock); | 
|  | 547 | _req->actual = _req->length; | 
|  | 548 | _req->status = 0; | 
|  | 549 | _req->complete (_ep, _req); | 
|  | 550 | spin_lock (&dum->lock); | 
| David Brownell | c728df7 | 2008-07-26 08:06:24 -0700 | [diff] [blame] | 551 | }  else | 
|  | 552 | list_add_tail(&req->queue, &ep->queue); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 553 | spin_unlock_irqrestore (&dum->lock, flags); | 
|  | 554 |  | 
|  | 555 | /* real hardware would likely enable transfers here, in case | 
|  | 556 | * it'd been left NAKing. | 
|  | 557 | */ | 
|  | 558 | return 0; | 
|  | 559 | } | 
|  | 560 |  | 
|  | 561 | static int dummy_dequeue (struct usb_ep *_ep, struct usb_request *_req) | 
|  | 562 | { | 
|  | 563 | struct dummy_ep		*ep; | 
|  | 564 | struct dummy		*dum; | 
|  | 565 | int			retval = -EINVAL; | 
|  | 566 | unsigned long		flags; | 
|  | 567 | struct dummy_request	*req = NULL; | 
|  | 568 |  | 
|  | 569 | if (!_ep || !_req) | 
|  | 570 | return retval; | 
|  | 571 | ep = usb_ep_to_dummy_ep (_ep); | 
|  | 572 | dum = ep_to_dummy (ep); | 
|  | 573 |  | 
|  | 574 | if (!dum->driver) | 
|  | 575 | return -ESHUTDOWN; | 
|  | 576 |  | 
| Alan Stern | b4dbda1 | 2006-07-28 17:07:34 -0400 | [diff] [blame] | 577 | local_irq_save (flags); | 
|  | 578 | spin_lock (&dum->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 579 | list_for_each_entry (req, &ep->queue, queue) { | 
|  | 580 | if (&req->req == _req) { | 
|  | 581 | list_del_init (&req->queue); | 
|  | 582 | _req->status = -ECONNRESET; | 
|  | 583 | retval = 0; | 
|  | 584 | break; | 
|  | 585 | } | 
|  | 586 | } | 
| Alan Stern | b4dbda1 | 2006-07-28 17:07:34 -0400 | [diff] [blame] | 587 | spin_unlock (&dum->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 588 |  | 
|  | 589 | if (retval == 0) { | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 590 | dev_dbg (udc_dev(dum), | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 591 | "dequeued req %p from %s, len %d buf %p\n", | 
|  | 592 | req, _ep->name, _req->length, _req->buf); | 
|  | 593 | _req->complete (_ep, _req); | 
|  | 594 | } | 
| Alan Stern | b4dbda1 | 2006-07-28 17:07:34 -0400 | [diff] [blame] | 595 | local_irq_restore (flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 596 | return retval; | 
|  | 597 | } | 
|  | 598 |  | 
|  | 599 | static int | 
| Alan Stern | 851a526 | 2008-08-14 15:48:30 -0400 | [diff] [blame] | 600 | dummy_set_halt_and_wedge(struct usb_ep *_ep, int value, int wedged) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 601 | { | 
|  | 602 | struct dummy_ep		*ep; | 
|  | 603 | struct dummy		*dum; | 
|  | 604 |  | 
|  | 605 | if (!_ep) | 
|  | 606 | return -EINVAL; | 
|  | 607 | ep = usb_ep_to_dummy_ep (_ep); | 
|  | 608 | dum = ep_to_dummy (ep); | 
|  | 609 | if (!dum->driver) | 
|  | 610 | return -ESHUTDOWN; | 
|  | 611 | if (!value) | 
| Alan Stern | 851a526 | 2008-08-14 15:48:30 -0400 | [diff] [blame] | 612 | ep->halted = ep->wedged = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 613 | else if (ep->desc && (ep->desc->bEndpointAddress & USB_DIR_IN) && | 
|  | 614 | !list_empty (&ep->queue)) | 
|  | 615 | return -EAGAIN; | 
| Alan Stern | 851a526 | 2008-08-14 15:48:30 -0400 | [diff] [blame] | 616 | else { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 617 | ep->halted = 1; | 
| Alan Stern | 851a526 | 2008-08-14 15:48:30 -0400 | [diff] [blame] | 618 | if (wedged) | 
|  | 619 | ep->wedged = 1; | 
|  | 620 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 621 | /* FIXME clear emulated data toggle too */ | 
|  | 622 | return 0; | 
|  | 623 | } | 
|  | 624 |  | 
| Alan Stern | 851a526 | 2008-08-14 15:48:30 -0400 | [diff] [blame] | 625 | static int | 
|  | 626 | dummy_set_halt(struct usb_ep *_ep, int value) | 
|  | 627 | { | 
|  | 628 | return dummy_set_halt_and_wedge(_ep, value, 0); | 
|  | 629 | } | 
|  | 630 |  | 
|  | 631 | static int dummy_set_wedge(struct usb_ep *_ep) | 
|  | 632 | { | 
|  | 633 | if (!_ep || _ep->name == ep0name) | 
|  | 634 | return -EINVAL; | 
|  | 635 | return dummy_set_halt_and_wedge(_ep, 1, 1); | 
|  | 636 | } | 
|  | 637 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 638 | static const struct usb_ep_ops dummy_ep_ops = { | 
|  | 639 | .enable		= dummy_enable, | 
|  | 640 | .disable	= dummy_disable, | 
|  | 641 |  | 
|  | 642 | .alloc_request	= dummy_alloc_request, | 
|  | 643 | .free_request	= dummy_free_request, | 
|  | 644 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 645 | .queue		= dummy_queue, | 
|  | 646 | .dequeue	= dummy_dequeue, | 
|  | 647 |  | 
|  | 648 | .set_halt	= dummy_set_halt, | 
| Alan Stern | 851a526 | 2008-08-14 15:48:30 -0400 | [diff] [blame] | 649 | .set_wedge	= dummy_set_wedge, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 650 | }; | 
|  | 651 |  | 
|  | 652 | /*-------------------------------------------------------------------------*/ | 
|  | 653 |  | 
|  | 654 | /* there are both host and device side versions of this call ... */ | 
|  | 655 | static int dummy_g_get_frame (struct usb_gadget *_gadget) | 
|  | 656 | { | 
|  | 657 | struct timeval	tv; | 
|  | 658 |  | 
|  | 659 | do_gettimeofday (&tv); | 
|  | 660 | return tv.tv_usec / 1000; | 
|  | 661 | } | 
|  | 662 |  | 
|  | 663 | static int dummy_wakeup (struct usb_gadget *_gadget) | 
|  | 664 | { | 
|  | 665 | struct dummy	*dum; | 
|  | 666 |  | 
|  | 667 | dum = gadget_to_dummy (_gadget); | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 668 | if (!(dum->devstatus &	( (1 << USB_DEVICE_B_HNP_ENABLE) | 
| Alan Stern | 5742b0c | 2005-05-02 11:25:17 -0400 | [diff] [blame] | 669 | | (1 << USB_DEVICE_REMOTE_WAKEUP)))) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 670 | return -EINVAL; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 671 | if ((dum->port_status & USB_PORT_STAT_CONNECTION) == 0) | 
|  | 672 | return -ENOLINK; | 
|  | 673 | if ((dum->port_status & USB_PORT_STAT_SUSPEND) == 0 && | 
|  | 674 | dum->rh_state != DUMMY_RH_SUSPENDED) | 
|  | 675 | return -EIO; | 
|  | 676 |  | 
|  | 677 | /* FIXME: What if the root hub is suspended but the port isn't? */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 678 |  | 
|  | 679 | /* hub notices our request, issues downstream resume, etc */ | 
|  | 680 | dum->resuming = 1; | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 681 | dum->re_timeout = jiffies + msecs_to_jiffies(20); | 
| Alan Stern | 685eb93 | 2005-05-03 16:27:26 -0400 | [diff] [blame] | 682 | mod_timer (&dummy_to_hcd (dum)->rh_timer, dum->re_timeout); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 683 | return 0; | 
|  | 684 | } | 
|  | 685 |  | 
|  | 686 | static int dummy_set_selfpowered (struct usb_gadget *_gadget, int value) | 
|  | 687 | { | 
|  | 688 | struct dummy	*dum; | 
|  | 689 |  | 
|  | 690 | dum = gadget_to_dummy (_gadget); | 
|  | 691 | if (value) | 
|  | 692 | dum->devstatus |= (1 << USB_DEVICE_SELF_POWERED); | 
|  | 693 | else | 
|  | 694 | dum->devstatus &= ~(1 << USB_DEVICE_SELF_POWERED); | 
|  | 695 | return 0; | 
|  | 696 | } | 
|  | 697 |  | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 698 | static int dummy_pullup (struct usb_gadget *_gadget, int value) | 
|  | 699 | { | 
|  | 700 | struct dummy	*dum; | 
|  | 701 | unsigned long	flags; | 
|  | 702 |  | 
|  | 703 | dum = gadget_to_dummy (_gadget); | 
|  | 704 | spin_lock_irqsave (&dum->lock, flags); | 
|  | 705 | dum->pullup = (value != 0); | 
|  | 706 | set_link_state (dum); | 
|  | 707 | spin_unlock_irqrestore (&dum->lock, flags); | 
| Alan Stern | 685eb93 | 2005-05-03 16:27:26 -0400 | [diff] [blame] | 708 |  | 
|  | 709 | usb_hcd_poll_rh_status (dummy_to_hcd (dum)); | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 710 | return 0; | 
|  | 711 | } | 
|  | 712 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 713 | static const struct usb_gadget_ops dummy_ops = { | 
|  | 714 | .get_frame	= dummy_g_get_frame, | 
|  | 715 | .wakeup		= dummy_wakeup, | 
|  | 716 | .set_selfpowered = dummy_set_selfpowered, | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 717 | .pullup		= dummy_pullup, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 718 | }; | 
|  | 719 |  | 
|  | 720 | /*-------------------------------------------------------------------------*/ | 
|  | 721 |  | 
|  | 722 | /* "function" sysfs attribute */ | 
|  | 723 | static ssize_t | 
| Yani Ioannou | 10523b3 | 2005-05-17 06:43:37 -0400 | [diff] [blame] | 724 | show_function (struct device *dev, struct device_attribute *attr, char *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 725 | { | 
|  | 726 | struct dummy	*dum = gadget_dev_to_dummy (dev); | 
|  | 727 |  | 
|  | 728 | if (!dum->driver || !dum->driver->function) | 
|  | 729 | return 0; | 
|  | 730 | return scnprintf (buf, PAGE_SIZE, "%s\n", dum->driver->function); | 
|  | 731 | } | 
| Alan Stern | cc095b0 | 2005-05-10 15:28:38 -0400 | [diff] [blame] | 732 | static DEVICE_ATTR (function, S_IRUGO, show_function, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 733 |  | 
|  | 734 | /*-------------------------------------------------------------------------*/ | 
|  | 735 |  | 
|  | 736 | /* | 
|  | 737 | * Driver registration/unregistration. | 
|  | 738 | * | 
|  | 739 | * This is basically hardware-specific; there's usually only one real USB | 
|  | 740 | * device (not host) controller since that's how USB devices are intended | 
|  | 741 | * to work.  So most implementations of these api calls will rely on the | 
|  | 742 | * fact that only one driver will ever bind to the hardware.  But curious | 
|  | 743 | * hardware can be built with discrete components, so the gadget API doesn't | 
|  | 744 | * require that assumption. | 
|  | 745 | * | 
|  | 746 | * For this emulator, it might be convenient to create a usb slave device | 
|  | 747 | * for each driver that registers:  just add to a big root hub. | 
|  | 748 | */ | 
|  | 749 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 750 | int | 
| Uwe Kleine-König | b0fca50 | 2010-08-12 17:43:53 +0200 | [diff] [blame] | 751 | usb_gadget_probe_driver(struct usb_gadget_driver *driver, | 
|  | 752 | int (*bind)(struct usb_gadget *)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 753 | { | 
|  | 754 | struct dummy	*dum = the_controller; | 
|  | 755 | int		retval, i; | 
|  | 756 |  | 
|  | 757 | if (!dum) | 
|  | 758 | return -EINVAL; | 
|  | 759 | if (dum->driver) | 
|  | 760 | return -EBUSY; | 
| Uwe Kleine-König | b0fca50 | 2010-08-12 17:43:53 +0200 | [diff] [blame] | 761 | if (!bind || !driver->setup || driver->speed == USB_SPEED_UNKNOWN) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 762 | return -EINVAL; | 
|  | 763 |  | 
|  | 764 | /* | 
|  | 765 | * SLAVE side init ... the layer above hardware, which | 
|  | 766 | * can't enumerate without help from the driver we're binding. | 
|  | 767 | */ | 
| Alan Stern | 5742b0c | 2005-05-02 11:25:17 -0400 | [diff] [blame] | 768 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 769 | dum->devstatus = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 770 |  | 
|  | 771 | INIT_LIST_HEAD (&dum->gadget.ep_list); | 
|  | 772 | for (i = 0; i < DUMMY_ENDPOINTS; i++) { | 
|  | 773 | struct dummy_ep	*ep = &dum->ep [i]; | 
|  | 774 |  | 
|  | 775 | if (!ep_name [i]) | 
|  | 776 | break; | 
|  | 777 | ep->ep.name = ep_name [i]; | 
|  | 778 | ep->ep.ops = &dummy_ep_ops; | 
|  | 779 | list_add_tail (&ep->ep.ep_list, &dum->gadget.ep_list); | 
| Alan Stern | 851a526 | 2008-08-14 15:48:30 -0400 | [diff] [blame] | 780 | ep->halted = ep->wedged = ep->already_seen = | 
|  | 781 | ep->setup_stage = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 782 | ep->ep.maxpacket = ~0; | 
|  | 783 | ep->last_io = jiffies; | 
|  | 784 | ep->gadget = &dum->gadget; | 
|  | 785 | ep->desc = NULL; | 
|  | 786 | INIT_LIST_HEAD (&ep->queue); | 
|  | 787 | } | 
|  | 788 |  | 
|  | 789 | dum->gadget.ep0 = &dum->ep [0].ep; | 
|  | 790 | dum->ep [0].ep.maxpacket = 64; | 
|  | 791 | list_del_init (&dum->ep [0].ep.ep_list); | 
|  | 792 | INIT_LIST_HEAD(&dum->fifo_req.queue); | 
|  | 793 |  | 
| Alan Stern | 5933101 | 2007-11-20 16:28:55 -0500 | [diff] [blame] | 794 | driver->driver.bus = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 795 | dum->driver = driver; | 
|  | 796 | dum->gadget.dev.driver = &driver->driver; | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 797 | dev_dbg (udc_dev(dum), "binding gadget driver '%s'\n", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 798 | driver->driver.name); | 
| Uwe Kleine-König | b0fca50 | 2010-08-12 17:43:53 +0200 | [diff] [blame] | 799 | retval = bind(&dum->gadget); | 
| Alan Stern | 5933101 | 2007-11-20 16:28:55 -0500 | [diff] [blame] | 800 | if (retval) { | 
|  | 801 | dum->driver = NULL; | 
|  | 802 | dum->gadget.dev.driver = NULL; | 
|  | 803 | return retval; | 
|  | 804 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 805 |  | 
|  | 806 | /* khubd will enumerate this in a while */ | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 807 | spin_lock_irq (&dum->lock); | 
|  | 808 | dum->pullup = 1; | 
|  | 809 | set_link_state (dum); | 
|  | 810 | spin_unlock_irq (&dum->lock); | 
| Alan Stern | 685eb93 | 2005-05-03 16:27:26 -0400 | [diff] [blame] | 811 |  | 
|  | 812 | usb_hcd_poll_rh_status (dummy_to_hcd (dum)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 813 | return 0; | 
|  | 814 | } | 
| Uwe Kleine-König | b0fca50 | 2010-08-12 17:43:53 +0200 | [diff] [blame] | 815 | EXPORT_SYMBOL(usb_gadget_probe_driver); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 816 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 817 | int | 
|  | 818 | usb_gadget_unregister_driver (struct usb_gadget_driver *driver) | 
|  | 819 | { | 
|  | 820 | struct dummy	*dum = the_controller; | 
|  | 821 | unsigned long	flags; | 
|  | 822 |  | 
|  | 823 | if (!dum) | 
|  | 824 | return -ENODEV; | 
| David Brownell | 6bea476 | 2006-12-05 03:15:33 -0800 | [diff] [blame] | 825 | if (!driver || driver != dum->driver || !driver->unbind) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 826 | return -EINVAL; | 
|  | 827 |  | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 828 | dev_dbg (udc_dev(dum), "unregister gadget driver '%s'\n", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 829 | driver->driver.name); | 
|  | 830 |  | 
|  | 831 | spin_lock_irqsave (&dum->lock, flags); | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 832 | dum->pullup = 0; | 
|  | 833 | set_link_state (dum); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 834 | spin_unlock_irqrestore (&dum->lock, flags); | 
|  | 835 |  | 
|  | 836 | driver->unbind (&dum->gadget); | 
| Alan Stern | 5933101 | 2007-11-20 16:28:55 -0500 | [diff] [blame] | 837 | dum->gadget.dev.driver = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 838 | dum->driver = NULL; | 
|  | 839 |  | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 840 | spin_lock_irqsave (&dum->lock, flags); | 
|  | 841 | dum->pullup = 0; | 
|  | 842 | set_link_state (dum); | 
|  | 843 | spin_unlock_irqrestore (&dum->lock, flags); | 
|  | 844 |  | 
| Alan Stern | 685eb93 | 2005-05-03 16:27:26 -0400 | [diff] [blame] | 845 | usb_hcd_poll_rh_status (dummy_to_hcd (dum)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 846 | return 0; | 
|  | 847 | } | 
|  | 848 | EXPORT_SYMBOL (usb_gadget_unregister_driver); | 
|  | 849 |  | 
|  | 850 | #undef is_enabled | 
|  | 851 |  | 
| Alan Stern | cc095b0 | 2005-05-10 15:28:38 -0400 | [diff] [blame] | 852 | /* just declare this in any driver that really need it */ | 
|  | 853 | extern int net2280_set_fifo_mode (struct usb_gadget *gadget, int mode); | 
|  | 854 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 855 | int net2280_set_fifo_mode (struct usb_gadget *gadget, int mode) | 
|  | 856 | { | 
|  | 857 | return -ENOSYS; | 
|  | 858 | } | 
|  | 859 | EXPORT_SYMBOL (net2280_set_fifo_mode); | 
|  | 860 |  | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 861 |  | 
|  | 862 | /* The gadget structure is stored inside the hcd structure and will be | 
|  | 863 | * released along with it. */ | 
|  | 864 | static void | 
|  | 865 | dummy_gadget_release (struct device *dev) | 
|  | 866 | { | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 867 | struct dummy	*dum = gadget_dev_to_dummy (dev); | 
|  | 868 |  | 
| Alan Stern | 1720058 | 2006-08-30 11:32:52 -0400 | [diff] [blame] | 869 | usb_put_hcd (dummy_to_hcd (dum)); | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 870 | } | 
|  | 871 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 872 | static int dummy_udc_probe (struct platform_device *pdev) | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 873 | { | 
|  | 874 | struct dummy	*dum = the_controller; | 
|  | 875 | int		rc; | 
|  | 876 |  | 
| Rahul Ruikar | 75d87cd | 2010-10-07 09:40:45 +0530 | [diff] [blame] | 877 | usb_get_hcd(dummy_to_hcd(dum)); | 
|  | 878 |  | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 879 | dum->gadget.name = gadget_name; | 
|  | 880 | dum->gadget.ops = &dummy_ops; | 
|  | 881 | dum->gadget.is_dualspeed = 1; | 
|  | 882 |  | 
|  | 883 | /* maybe claim OTG support, though we won't complete HNP */ | 
|  | 884 | dum->gadget.is_otg = (dummy_to_hcd(dum)->self.otg_port != 0); | 
|  | 885 |  | 
| Kay Sievers | 0031a06 | 2008-05-02 06:02:41 +0200 | [diff] [blame] | 886 | dev_set_name(&dum->gadget.dev, "gadget"); | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 887 | dum->gadget.dev.parent = &pdev->dev; | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 888 | dum->gadget.dev.release = dummy_gadget_release; | 
|  | 889 | rc = device_register (&dum->gadget.dev); | 
| Rahul Ruikar | 75d87cd | 2010-10-07 09:40:45 +0530 | [diff] [blame] | 890 | if (rc < 0) { | 
|  | 891 | put_device(&dum->gadget.dev); | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 892 | return rc; | 
| Rahul Ruikar | 75d87cd | 2010-10-07 09:40:45 +0530 | [diff] [blame] | 893 | } | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 894 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 895 | platform_set_drvdata (pdev, dum); | 
| Alan Stern | efd54a3 | 2006-09-25 11:55:56 -0400 | [diff] [blame] | 896 | rc = device_create_file (&dum->gadget.dev, &dev_attr_function); | 
|  | 897 | if (rc < 0) | 
|  | 898 | device_unregister (&dum->gadget.dev); | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 899 | return rc; | 
|  | 900 | } | 
|  | 901 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 902 | static int dummy_udc_remove (struct platform_device *pdev) | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 903 | { | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 904 | struct dummy	*dum = platform_get_drvdata (pdev); | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 905 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 906 | platform_set_drvdata (pdev, NULL); | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 907 | device_remove_file (&dum->gadget.dev, &dev_attr_function); | 
|  | 908 | device_unregister (&dum->gadget.dev); | 
|  | 909 | return 0; | 
|  | 910 | } | 
|  | 911 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 912 | static int dummy_udc_suspend (struct platform_device *pdev, pm_message_t state) | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 913 | { | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 914 | struct dummy	*dum = platform_get_drvdata(pdev); | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 915 |  | 
| Harvey Harrison | 441b62c | 2008-03-03 16:08:34 -0800 | [diff] [blame] | 916 | dev_dbg (&pdev->dev, "%s\n", __func__); | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 917 | spin_lock_irq (&dum->lock); | 
|  | 918 | dum->udc_suspended = 1; | 
|  | 919 | set_link_state (dum); | 
|  | 920 | spin_unlock_irq (&dum->lock); | 
|  | 921 |  | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 922 | usb_hcd_poll_rh_status (dummy_to_hcd (dum)); | 
|  | 923 | return 0; | 
|  | 924 | } | 
|  | 925 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 926 | static int dummy_udc_resume (struct platform_device *pdev) | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 927 | { | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 928 | struct dummy	*dum = platform_get_drvdata(pdev); | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 929 |  | 
| Harvey Harrison | 441b62c | 2008-03-03 16:08:34 -0800 | [diff] [blame] | 930 | dev_dbg (&pdev->dev, "%s\n", __func__); | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 931 | spin_lock_irq (&dum->lock); | 
|  | 932 | dum->udc_suspended = 0; | 
|  | 933 | set_link_state (dum); | 
|  | 934 | spin_unlock_irq (&dum->lock); | 
|  | 935 |  | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 936 | usb_hcd_poll_rh_status (dummy_to_hcd (dum)); | 
|  | 937 | return 0; | 
|  | 938 | } | 
|  | 939 |  | 
| Russell King | 3ae5eae | 2005-11-09 22:32:44 +0000 | [diff] [blame] | 940 | static struct platform_driver dummy_udc_driver = { | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 941 | .probe		= dummy_udc_probe, | 
|  | 942 | .remove		= dummy_udc_remove, | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 943 | .suspend	= dummy_udc_suspend, | 
|  | 944 | .resume		= dummy_udc_resume, | 
| Russell King | 3ae5eae | 2005-11-09 22:32:44 +0000 | [diff] [blame] | 945 | .driver		= { | 
|  | 946 | .name	= (char *) gadget_name, | 
|  | 947 | .owner	= THIS_MODULE, | 
|  | 948 | }, | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 949 | }; | 
|  | 950 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 951 | /*-------------------------------------------------------------------------*/ | 
|  | 952 |  | 
|  | 953 | /* MASTER/HOST SIDE DRIVER | 
|  | 954 | * | 
|  | 955 | * this uses the hcd framework to hook up to host side drivers. | 
|  | 956 | * its root hub will only have one device, otherwise it acts like | 
|  | 957 | * a normal host controller. | 
|  | 958 | * | 
|  | 959 | * when urbs are queued, they're just stuck on a list that we | 
|  | 960 | * scan in a timer callback.  that callback connects writes from | 
|  | 961 | * the host with reads from the device, and so on, based on the | 
|  | 962 | * usb 2.0 rules. | 
|  | 963 | */ | 
|  | 964 |  | 
|  | 965 | static int dummy_urb_enqueue ( | 
|  | 966 | struct usb_hcd			*hcd, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 967 | struct urb			*urb, | 
| Al Viro | 55016f1 | 2005-10-21 03:21:58 -0400 | [diff] [blame] | 968 | gfp_t				mem_flags | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 969 | ) { | 
|  | 970 | struct dummy	*dum; | 
|  | 971 | struct urbp	*urbp; | 
|  | 972 | unsigned long	flags; | 
| Alan Stern | e9df41c | 2007-08-08 11:48:02 -0400 | [diff] [blame] | 973 | int		rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 974 |  | 
|  | 975 | if (!urb->transfer_buffer && urb->transfer_buffer_length) | 
|  | 976 | return -EINVAL; | 
|  | 977 |  | 
|  | 978 | urbp = kmalloc (sizeof *urbp, mem_flags); | 
|  | 979 | if (!urbp) | 
|  | 980 | return -ENOMEM; | 
|  | 981 | urbp->urb = urb; | 
|  | 982 |  | 
|  | 983 | dum = hcd_to_dummy (hcd); | 
|  | 984 | spin_lock_irqsave (&dum->lock, flags); | 
| Alan Stern | e9df41c | 2007-08-08 11:48:02 -0400 | [diff] [blame] | 985 | rc = usb_hcd_link_urb_to_ep(hcd, urb); | 
|  | 986 | if (rc) { | 
|  | 987 | kfree(urbp); | 
|  | 988 | goto done; | 
|  | 989 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 990 |  | 
|  | 991 | if (!dum->udev) { | 
|  | 992 | dum->udev = urb->dev; | 
|  | 993 | usb_get_dev (dum->udev); | 
|  | 994 | } else if (unlikely (dum->udev != urb->dev)) | 
|  | 995 | dev_err (dummy_dev(dum), "usb_device address has changed!\n"); | 
|  | 996 |  | 
|  | 997 | list_add_tail (&urbp->urbp_list, &dum->urbp_list); | 
|  | 998 | urb->hcpriv = urbp; | 
|  | 999 | if (usb_pipetype (urb->pipe) == PIPE_CONTROL) | 
|  | 1000 | urb->error_count = 1;		/* mark as a new urb */ | 
|  | 1001 |  | 
|  | 1002 | /* kick the scheduler, it'll do the rest */ | 
|  | 1003 | if (!timer_pending (&dum->timer)) | 
|  | 1004 | mod_timer (&dum->timer, jiffies + 1); | 
|  | 1005 |  | 
| Alan Stern | e9df41c | 2007-08-08 11:48:02 -0400 | [diff] [blame] | 1006 | done: | 
| Alan Stern | 63f991b | 2007-09-04 09:53:24 -0400 | [diff] [blame] | 1007 | spin_unlock_irqrestore(&dum->lock, flags); | 
| Alan Stern | e9df41c | 2007-08-08 11:48:02 -0400 | [diff] [blame] | 1008 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1009 | } | 
|  | 1010 |  | 
| Alan Stern | e9df41c | 2007-08-08 11:48:02 -0400 | [diff] [blame] | 1011 | static int dummy_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1012 | { | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1013 | struct dummy	*dum; | 
|  | 1014 | unsigned long	flags; | 
| Alan Stern | e9df41c | 2007-08-08 11:48:02 -0400 | [diff] [blame] | 1015 | int		rc; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1016 |  | 
|  | 1017 | /* giveback happens automatically in timer callback, | 
|  | 1018 | * so make sure the callback happens */ | 
|  | 1019 | dum = hcd_to_dummy (hcd); | 
|  | 1020 | spin_lock_irqsave (&dum->lock, flags); | 
| Alan Stern | e9df41c | 2007-08-08 11:48:02 -0400 | [diff] [blame] | 1021 |  | 
|  | 1022 | rc = usb_hcd_check_unlink_urb(hcd, urb, status); | 
|  | 1023 | if (!rc && dum->rh_state != DUMMY_RH_RUNNING && | 
|  | 1024 | !list_empty(&dum->urbp_list)) | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1025 | mod_timer (&dum->timer, jiffies); | 
| Alan Stern | e9df41c | 2007-08-08 11:48:02 -0400 | [diff] [blame] | 1026 |  | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1027 | spin_unlock_irqrestore (&dum->lock, flags); | 
| Alan Stern | e9df41c | 2007-08-08 11:48:02 -0400 | [diff] [blame] | 1028 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1029 | } | 
|  | 1030 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1031 | /* transfer up to a frame's worth; caller must own lock */ | 
|  | 1032 | static int | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1033 | transfer(struct dummy *dum, struct urb *urb, struct dummy_ep *ep, int limit, | 
|  | 1034 | int *status) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1035 | { | 
|  | 1036 | struct dummy_request	*req; | 
|  | 1037 |  | 
|  | 1038 | top: | 
|  | 1039 | /* if there's no request queued, the device is NAKing; return */ | 
|  | 1040 | list_for_each_entry (req, &ep->queue, queue) { | 
|  | 1041 | unsigned	host_len, dev_len, len; | 
|  | 1042 | int		is_short, to_host; | 
|  | 1043 | int		rescan = 0; | 
|  | 1044 |  | 
|  | 1045 | /* 1..N packets of ep->ep.maxpacket each ... the last one | 
|  | 1046 | * may be short (including zero length). | 
|  | 1047 | * | 
|  | 1048 | * writer can send a zlp explicitly (length 0) or implicitly | 
|  | 1049 | * (length mod maxpacket zero, and 'zero' flag); they always | 
|  | 1050 | * terminate reads. | 
|  | 1051 | */ | 
|  | 1052 | host_len = urb->transfer_buffer_length - urb->actual_length; | 
|  | 1053 | dev_len = req->req.length - req->req.actual; | 
|  | 1054 | len = min (host_len, dev_len); | 
|  | 1055 |  | 
|  | 1056 | /* FIXME update emulated data toggle too */ | 
|  | 1057 |  | 
|  | 1058 | to_host = usb_pipein (urb->pipe); | 
|  | 1059 | if (unlikely (len == 0)) | 
|  | 1060 | is_short = 1; | 
|  | 1061 | else { | 
|  | 1062 | char		*ubuf, *rbuf; | 
|  | 1063 |  | 
|  | 1064 | /* not enough bandwidth left? */ | 
|  | 1065 | if (limit < ep->ep.maxpacket && limit < len) | 
|  | 1066 | break; | 
|  | 1067 | len = min (len, (unsigned) limit); | 
|  | 1068 | if (len == 0) | 
|  | 1069 | break; | 
|  | 1070 |  | 
|  | 1071 | /* use an extra pass for the final short packet */ | 
|  | 1072 | if (len > ep->ep.maxpacket) { | 
|  | 1073 | rescan = 1; | 
|  | 1074 | len -= (len % ep->ep.maxpacket); | 
|  | 1075 | } | 
|  | 1076 | is_short = (len % ep->ep.maxpacket) != 0; | 
|  | 1077 |  | 
|  | 1078 | /* else transfer packet(s) */ | 
|  | 1079 | ubuf = urb->transfer_buffer + urb->actual_length; | 
|  | 1080 | rbuf = req->req.buf + req->req.actual; | 
|  | 1081 | if (to_host) | 
|  | 1082 | memcpy (ubuf, rbuf, len); | 
|  | 1083 | else | 
|  | 1084 | memcpy (rbuf, ubuf, len); | 
|  | 1085 | ep->last_io = jiffies; | 
|  | 1086 |  | 
|  | 1087 | limit -= len; | 
|  | 1088 | urb->actual_length += len; | 
|  | 1089 | req->req.actual += len; | 
|  | 1090 | } | 
|  | 1091 |  | 
|  | 1092 | /* short packets terminate, maybe with overflow/underflow. | 
|  | 1093 | * it's only really an error to write too much. | 
|  | 1094 | * | 
|  | 1095 | * partially filling a buffer optionally blocks queue advances | 
|  | 1096 | * (so completion handlers can clean up the queue) but we don't | 
| Alan Stern | b0d9efb | 2007-08-21 15:39:21 -0400 | [diff] [blame] | 1097 | * need to emulate such data-in-flight. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1098 | */ | 
|  | 1099 | if (is_short) { | 
|  | 1100 | if (host_len == dev_len) { | 
|  | 1101 | req->req.status = 0; | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1102 | *status = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1103 | } else if (to_host) { | 
|  | 1104 | req->req.status = 0; | 
|  | 1105 | if (dev_len > host_len) | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1106 | *status = -EOVERFLOW; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1107 | else | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1108 | *status = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1109 | } else if (!to_host) { | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1110 | *status = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1111 | if (host_len > dev_len) | 
|  | 1112 | req->req.status = -EOVERFLOW; | 
|  | 1113 | else | 
|  | 1114 | req->req.status = 0; | 
|  | 1115 | } | 
|  | 1116 |  | 
|  | 1117 | /* many requests terminate without a short packet */ | 
|  | 1118 | } else { | 
|  | 1119 | if (req->req.length == req->req.actual | 
|  | 1120 | && !req->req.zero) | 
|  | 1121 | req->req.status = 0; | 
|  | 1122 | if (urb->transfer_buffer_length == urb->actual_length | 
|  | 1123 | && !(urb->transfer_flags | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1124 | & URB_ZERO_PACKET)) | 
|  | 1125 | *status = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1126 | } | 
|  | 1127 |  | 
|  | 1128 | /* device side completion --> continuable */ | 
|  | 1129 | if (req->req.status != -EINPROGRESS) { | 
|  | 1130 | list_del_init (&req->queue); | 
|  | 1131 |  | 
|  | 1132 | spin_unlock (&dum->lock); | 
|  | 1133 | req->req.complete (&ep->ep, &req->req); | 
|  | 1134 | spin_lock (&dum->lock); | 
|  | 1135 |  | 
|  | 1136 | /* requests might have been unlinked... */ | 
|  | 1137 | rescan = 1; | 
|  | 1138 | } | 
|  | 1139 |  | 
|  | 1140 | /* host side completion --> terminate */ | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1141 | if (*status != -EINPROGRESS) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1142 | break; | 
|  | 1143 |  | 
|  | 1144 | /* rescan to continue with any other queued i/o */ | 
|  | 1145 | if (rescan) | 
|  | 1146 | goto top; | 
|  | 1147 | } | 
|  | 1148 | return limit; | 
|  | 1149 | } | 
|  | 1150 |  | 
|  | 1151 | static int periodic_bytes (struct dummy *dum, struct dummy_ep *ep) | 
|  | 1152 | { | 
|  | 1153 | int	limit = ep->ep.maxpacket; | 
|  | 1154 |  | 
|  | 1155 | if (dum->gadget.speed == USB_SPEED_HIGH) { | 
|  | 1156 | int	tmp; | 
|  | 1157 |  | 
|  | 1158 | /* high bandwidth mode */ | 
|  | 1159 | tmp = le16_to_cpu(ep->desc->wMaxPacketSize); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1160 | tmp = (tmp >> 11) & 0x03; | 
|  | 1161 | tmp *= 8 /* applies to entire frame */; | 
|  | 1162 | limit += limit * tmp; | 
|  | 1163 | } | 
|  | 1164 | return limit; | 
|  | 1165 | } | 
|  | 1166 |  | 
|  | 1167 | #define is_active(dum)	((dum->port_status & \ | 
|  | 1168 | (USB_PORT_STAT_CONNECTION | USB_PORT_STAT_ENABLE | \ | 
|  | 1169 | USB_PORT_STAT_SUSPEND)) \ | 
|  | 1170 | == (USB_PORT_STAT_CONNECTION | USB_PORT_STAT_ENABLE)) | 
|  | 1171 |  | 
|  | 1172 | static struct dummy_ep *find_endpoint (struct dummy *dum, u8 address) | 
|  | 1173 | { | 
|  | 1174 | int		i; | 
|  | 1175 |  | 
|  | 1176 | if (!is_active (dum)) | 
|  | 1177 | return NULL; | 
|  | 1178 | if ((address & ~USB_DIR_IN) == 0) | 
|  | 1179 | return &dum->ep [0]; | 
|  | 1180 | for (i = 1; i < DUMMY_ENDPOINTS; i++) { | 
|  | 1181 | struct dummy_ep	*ep = &dum->ep [i]; | 
|  | 1182 |  | 
|  | 1183 | if (!ep->desc) | 
|  | 1184 | continue; | 
|  | 1185 | if (ep->desc->bEndpointAddress == address) | 
|  | 1186 | return ep; | 
|  | 1187 | } | 
|  | 1188 | return NULL; | 
|  | 1189 | } | 
|  | 1190 |  | 
|  | 1191 | #undef is_active | 
|  | 1192 |  | 
|  | 1193 | #define Dev_Request	(USB_TYPE_STANDARD | USB_RECIP_DEVICE) | 
|  | 1194 | #define Dev_InRequest	(Dev_Request | USB_DIR_IN) | 
|  | 1195 | #define Intf_Request	(USB_TYPE_STANDARD | USB_RECIP_INTERFACE) | 
|  | 1196 | #define Intf_InRequest	(Intf_Request | USB_DIR_IN) | 
|  | 1197 | #define Ep_Request	(USB_TYPE_STANDARD | USB_RECIP_ENDPOINT) | 
|  | 1198 | #define Ep_InRequest	(Ep_Request | USB_DIR_IN) | 
|  | 1199 |  | 
| Tatyana Brokhman | 8be8a9d | 2010-11-01 17:38:05 +0200 | [diff] [blame] | 1200 |  | 
|  | 1201 | /** | 
|  | 1202 | * handle_control_request() - handles all control transfers | 
|  | 1203 | * @dum: pointer to dummy (the_controller) | 
|  | 1204 | * @urb: the urb request to handle | 
|  | 1205 | * @setup: pointer to the setup data for a USB device control | 
|  | 1206 | *	 request | 
|  | 1207 | * @status: pointer to request handling status | 
|  | 1208 | * | 
|  | 1209 | * Return 0 - if the request was handled | 
|  | 1210 | *	  1 - if the request wasn't handles | 
|  | 1211 | *	  error code on error | 
|  | 1212 | */ | 
|  | 1213 | static int handle_control_request(struct dummy *dum, struct urb *urb, | 
|  | 1214 | struct usb_ctrlrequest *setup, | 
|  | 1215 | int *status) | 
|  | 1216 | { | 
|  | 1217 | struct dummy_ep		*ep2; | 
|  | 1218 | int			ret_val = 1; | 
|  | 1219 | unsigned	w_index; | 
|  | 1220 | unsigned	w_value; | 
|  | 1221 |  | 
|  | 1222 | w_index = le16_to_cpu(setup->wIndex); | 
|  | 1223 | w_value = le16_to_cpu(setup->wValue); | 
|  | 1224 | switch (setup->bRequest) { | 
|  | 1225 | case USB_REQ_SET_ADDRESS: | 
|  | 1226 | if (setup->bRequestType != Dev_Request) | 
|  | 1227 | break; | 
|  | 1228 | dum->address = w_value; | 
|  | 1229 | *status = 0; | 
|  | 1230 | dev_dbg(udc_dev(dum), "set_address = %d\n", | 
|  | 1231 | w_value); | 
|  | 1232 | ret_val = 0; | 
|  | 1233 | break; | 
|  | 1234 | case USB_REQ_SET_FEATURE: | 
|  | 1235 | if (setup->bRequestType == Dev_Request) { | 
|  | 1236 | ret_val = 0; | 
|  | 1237 | switch (w_value) { | 
|  | 1238 | case USB_DEVICE_REMOTE_WAKEUP: | 
|  | 1239 | break; | 
|  | 1240 | case USB_DEVICE_B_HNP_ENABLE: | 
|  | 1241 | dum->gadget.b_hnp_enable = 1; | 
|  | 1242 | break; | 
|  | 1243 | case USB_DEVICE_A_HNP_SUPPORT: | 
|  | 1244 | dum->gadget.a_hnp_support = 1; | 
|  | 1245 | break; | 
|  | 1246 | case USB_DEVICE_A_ALT_HNP_SUPPORT: | 
|  | 1247 | dum->gadget.a_alt_hnp_support = 1; | 
|  | 1248 | break; | 
|  | 1249 | default: | 
|  | 1250 | ret_val = -EOPNOTSUPP; | 
|  | 1251 | } | 
|  | 1252 | if (ret_val == 0) { | 
|  | 1253 | dum->devstatus |= (1 << w_value); | 
|  | 1254 | *status = 0; | 
|  | 1255 | } | 
|  | 1256 | } else if (setup->bRequestType == Ep_Request) { | 
|  | 1257 | /* endpoint halt */ | 
|  | 1258 | ep2 = find_endpoint(dum, w_index); | 
|  | 1259 | if (!ep2 || ep2->ep.name == ep0name) { | 
|  | 1260 | ret_val = -EOPNOTSUPP; | 
|  | 1261 | break; | 
|  | 1262 | } | 
|  | 1263 | ep2->halted = 1; | 
|  | 1264 | ret_val = 0; | 
|  | 1265 | *status = 0; | 
|  | 1266 | } | 
|  | 1267 | break; | 
|  | 1268 | case USB_REQ_CLEAR_FEATURE: | 
|  | 1269 | if (setup->bRequestType == Dev_Request) { | 
|  | 1270 | ret_val = 0; | 
|  | 1271 | switch (w_value) { | 
|  | 1272 | case USB_DEVICE_REMOTE_WAKEUP: | 
|  | 1273 | w_value = USB_DEVICE_REMOTE_WAKEUP; | 
|  | 1274 | break; | 
|  | 1275 | default: | 
|  | 1276 | ret_val = -EOPNOTSUPP; | 
|  | 1277 | break; | 
|  | 1278 | } | 
|  | 1279 | if (ret_val == 0) { | 
|  | 1280 | dum->devstatus &= ~(1 << w_value); | 
|  | 1281 | *status = 0; | 
|  | 1282 | } | 
|  | 1283 | } else if (setup->bRequestType == Ep_Request) { | 
|  | 1284 | /* endpoint halt */ | 
|  | 1285 | ep2 = find_endpoint(dum, w_index); | 
|  | 1286 | if (!ep2) { | 
|  | 1287 | ret_val = -EOPNOTSUPP; | 
|  | 1288 | break; | 
|  | 1289 | } | 
|  | 1290 | if (!ep2->wedged) | 
|  | 1291 | ep2->halted = 0; | 
|  | 1292 | ret_val = 0; | 
|  | 1293 | *status = 0; | 
|  | 1294 | } | 
|  | 1295 | break; | 
|  | 1296 | case USB_REQ_GET_STATUS: | 
|  | 1297 | if (setup->bRequestType == Dev_InRequest | 
|  | 1298 | || setup->bRequestType == Intf_InRequest | 
|  | 1299 | || setup->bRequestType == Ep_InRequest) { | 
|  | 1300 | char *buf; | 
|  | 1301 | /* | 
|  | 1302 | * device: remote wakeup, selfpowered | 
|  | 1303 | * interface: nothing | 
|  | 1304 | * endpoint: halt | 
|  | 1305 | */ | 
|  | 1306 | buf = (char *)urb->transfer_buffer; | 
|  | 1307 | if (urb->transfer_buffer_length > 0) { | 
|  | 1308 | if (setup->bRequestType == Ep_InRequest) { | 
|  | 1309 | ep2 = find_endpoint(dum, w_index); | 
|  | 1310 | if (!ep2) { | 
|  | 1311 | ret_val = -EOPNOTSUPP; | 
|  | 1312 | break; | 
|  | 1313 | } | 
|  | 1314 | buf[0] = ep2->halted; | 
|  | 1315 | } else if (setup->bRequestType == | 
|  | 1316 | Dev_InRequest) { | 
|  | 1317 | buf[0] = (u8)dum->devstatus; | 
|  | 1318 | } else | 
|  | 1319 | buf[0] = 0; | 
|  | 1320 | } | 
|  | 1321 | if (urb->transfer_buffer_length > 1) | 
|  | 1322 | buf[1] = 0; | 
|  | 1323 | urb->actual_length = min_t(u32, 2, | 
|  | 1324 | urb->transfer_buffer_length); | 
|  | 1325 | ret_val = 0; | 
|  | 1326 | *status = 0; | 
|  | 1327 | } | 
|  | 1328 | break; | 
|  | 1329 | } | 
|  | 1330 | return ret_val; | 
|  | 1331 | } | 
|  | 1332 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1333 | /* drive both sides of the transfers; looks like irq handlers to | 
|  | 1334 | * both drivers except the callbacks aren't in_irq(). | 
|  | 1335 | */ | 
|  | 1336 | static void dummy_timer (unsigned long _dum) | 
|  | 1337 | { | 
|  | 1338 | struct dummy		*dum = (struct dummy *) _dum; | 
|  | 1339 | struct urbp		*urbp, *tmp; | 
|  | 1340 | unsigned long		flags; | 
|  | 1341 | int			limit, total; | 
|  | 1342 | int			i; | 
|  | 1343 |  | 
|  | 1344 | /* simplistic model for one frame's bandwidth */ | 
|  | 1345 | switch (dum->gadget.speed) { | 
|  | 1346 | case USB_SPEED_LOW: | 
|  | 1347 | total = 8/*bytes*/ * 12/*packets*/; | 
|  | 1348 | break; | 
|  | 1349 | case USB_SPEED_FULL: | 
|  | 1350 | total = 64/*bytes*/ * 19/*packets*/; | 
|  | 1351 | break; | 
|  | 1352 | case USB_SPEED_HIGH: | 
|  | 1353 | total = 512/*bytes*/ * 13/*packets*/ * 8/*uframes*/; | 
|  | 1354 | break; | 
|  | 1355 | default: | 
|  | 1356 | dev_err (dummy_dev(dum), "bogus device speed\n"); | 
|  | 1357 | return; | 
|  | 1358 | } | 
|  | 1359 |  | 
|  | 1360 | /* FIXME if HZ != 1000 this will probably misbehave ... */ | 
|  | 1361 |  | 
|  | 1362 | /* look at each urb queued by the host side driver */ | 
|  | 1363 | spin_lock_irqsave (&dum->lock, flags); | 
|  | 1364 |  | 
|  | 1365 | if (!dum->udev) { | 
|  | 1366 | dev_err (dummy_dev(dum), | 
|  | 1367 | "timer fired with no URBs pending?\n"); | 
|  | 1368 | spin_unlock_irqrestore (&dum->lock, flags); | 
|  | 1369 | return; | 
|  | 1370 | } | 
|  | 1371 |  | 
|  | 1372 | for (i = 0; i < DUMMY_ENDPOINTS; i++) { | 
|  | 1373 | if (!ep_name [i]) | 
|  | 1374 | break; | 
|  | 1375 | dum->ep [i].already_seen = 0; | 
|  | 1376 | } | 
|  | 1377 |  | 
|  | 1378 | restart: | 
|  | 1379 | list_for_each_entry_safe (urbp, tmp, &dum->urbp_list, urbp_list) { | 
|  | 1380 | struct urb		*urb; | 
|  | 1381 | struct dummy_request	*req; | 
|  | 1382 | u8			address; | 
|  | 1383 | struct dummy_ep		*ep = NULL; | 
|  | 1384 | int			type; | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1385 | int			status = -EINPROGRESS; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1386 |  | 
|  | 1387 | urb = urbp->urb; | 
| Alan Stern | eb231054 | 2007-08-21 15:40:36 -0400 | [diff] [blame] | 1388 | if (urb->unlinked) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1389 | goto return_urb; | 
| Alan Stern | eb231054 | 2007-08-21 15:40:36 -0400 | [diff] [blame] | 1390 | else if (dum->rh_state != DUMMY_RH_RUNNING) | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1391 | continue; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1392 | type = usb_pipetype (urb->pipe); | 
|  | 1393 |  | 
|  | 1394 | /* used up this frame's non-periodic bandwidth? | 
|  | 1395 | * FIXME there's infinite bandwidth for control and | 
|  | 1396 | * periodic transfers ... unrealistic. | 
|  | 1397 | */ | 
|  | 1398 | if (total <= 0 && type == PIPE_BULK) | 
|  | 1399 | continue; | 
|  | 1400 |  | 
|  | 1401 | /* find the gadget's ep for this request (if configured) */ | 
|  | 1402 | address = usb_pipeendpoint (urb->pipe); | 
|  | 1403 | if (usb_pipein (urb->pipe)) | 
|  | 1404 | address |= USB_DIR_IN; | 
|  | 1405 | ep = find_endpoint(dum, address); | 
|  | 1406 | if (!ep) { | 
|  | 1407 | /* set_configuration() disagreement */ | 
|  | 1408 | dev_dbg (dummy_dev(dum), | 
|  | 1409 | "no ep configured for urb %p\n", | 
|  | 1410 | urb); | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1411 | status = -EPROTO; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1412 | goto return_urb; | 
|  | 1413 | } | 
|  | 1414 |  | 
|  | 1415 | if (ep->already_seen) | 
|  | 1416 | continue; | 
|  | 1417 | ep->already_seen = 1; | 
|  | 1418 | if (ep == &dum->ep [0] && urb->error_count) { | 
|  | 1419 | ep->setup_stage = 1;	/* a new urb */ | 
|  | 1420 | urb->error_count = 0; | 
|  | 1421 | } | 
|  | 1422 | if (ep->halted && !ep->setup_stage) { | 
|  | 1423 | /* NOTE: must not be iso! */ | 
|  | 1424 | dev_dbg (dummy_dev(dum), "ep %s halted, urb %p\n", | 
|  | 1425 | ep->ep.name, urb); | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1426 | status = -EPIPE; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1427 | goto return_urb; | 
|  | 1428 | } | 
|  | 1429 | /* FIXME make sure both ends agree on maxpacket */ | 
|  | 1430 |  | 
|  | 1431 | /* handle control requests */ | 
|  | 1432 | if (ep == &dum->ep [0] && ep->setup_stage) { | 
|  | 1433 | struct usb_ctrlrequest		setup; | 
|  | 1434 | int				value = 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1435 |  | 
|  | 1436 | setup = *(struct usb_ctrlrequest*) urb->setup_packet; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1437 | /* paranoia, in case of stale queued data */ | 
|  | 1438 | list_for_each_entry (req, &ep->queue, queue) { | 
|  | 1439 | list_del_init (&req->queue); | 
|  | 1440 | req->req.status = -EOVERFLOW; | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 1441 | dev_dbg (udc_dev(dum), "stale req = %p\n", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1442 | req); | 
|  | 1443 |  | 
|  | 1444 | spin_unlock (&dum->lock); | 
|  | 1445 | req->req.complete (&ep->ep, &req->req); | 
|  | 1446 | spin_lock (&dum->lock); | 
|  | 1447 | ep->already_seen = 0; | 
|  | 1448 | goto restart; | 
|  | 1449 | } | 
|  | 1450 |  | 
|  | 1451 | /* gadget driver never sees set_address or operations | 
|  | 1452 | * on standard feature flags.  some hardware doesn't | 
|  | 1453 | * even expose them. | 
|  | 1454 | */ | 
|  | 1455 | ep->last_io = jiffies; | 
|  | 1456 | ep->setup_stage = 0; | 
|  | 1457 | ep->halted = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1458 |  | 
| Tatyana Brokhman | 8be8a9d | 2010-11-01 17:38:05 +0200 | [diff] [blame] | 1459 | value = handle_control_request(dum, urb, &setup, | 
|  | 1460 | &status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1461 |  | 
|  | 1462 | /* gadget driver handles all other requests.  block | 
|  | 1463 | * until setup() returns; no reentrancy issues etc. | 
|  | 1464 | */ | 
|  | 1465 | if (value > 0) { | 
|  | 1466 | spin_unlock (&dum->lock); | 
|  | 1467 | value = dum->driver->setup (&dum->gadget, | 
|  | 1468 | &setup); | 
|  | 1469 | spin_lock (&dum->lock); | 
|  | 1470 |  | 
|  | 1471 | if (value >= 0) { | 
|  | 1472 | /* no delays (max 64KB data stage) */ | 
|  | 1473 | limit = 64*1024; | 
|  | 1474 | goto treat_control_like_bulk; | 
|  | 1475 | } | 
|  | 1476 | /* error, see below */ | 
|  | 1477 | } | 
|  | 1478 |  | 
|  | 1479 | if (value < 0) { | 
|  | 1480 | if (value != -EOPNOTSUPP) | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 1481 | dev_dbg (udc_dev(dum), | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1482 | "setup --> %d\n", | 
|  | 1483 | value); | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1484 | status = -EPIPE; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1485 | urb->actual_length = 0; | 
|  | 1486 | } | 
|  | 1487 |  | 
|  | 1488 | goto return_urb; | 
|  | 1489 | } | 
|  | 1490 |  | 
|  | 1491 | /* non-control requests */ | 
|  | 1492 | limit = total; | 
|  | 1493 | switch (usb_pipetype (urb->pipe)) { | 
|  | 1494 | case PIPE_ISOCHRONOUS: | 
|  | 1495 | /* FIXME is it urb->interval since the last xfer? | 
|  | 1496 | * use urb->iso_frame_desc[i]. | 
|  | 1497 | * complete whether or not ep has requests queued. | 
|  | 1498 | * report random errors, to debug drivers. | 
|  | 1499 | */ | 
|  | 1500 | limit = max (limit, periodic_bytes (dum, ep)); | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1501 | status = -ENOSYS; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1502 | break; | 
|  | 1503 |  | 
|  | 1504 | case PIPE_INTERRUPT: | 
|  | 1505 | /* FIXME is it urb->interval since the last xfer? | 
|  | 1506 | * this almost certainly polls too fast. | 
|  | 1507 | */ | 
|  | 1508 | limit = max (limit, periodic_bytes (dum, ep)); | 
|  | 1509 | /* FALLTHROUGH */ | 
|  | 1510 |  | 
|  | 1511 | // case PIPE_BULK:  case PIPE_CONTROL: | 
|  | 1512 | default: | 
|  | 1513 | treat_control_like_bulk: | 
|  | 1514 | ep->last_io = jiffies; | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1515 | total = transfer(dum, urb, ep, limit, &status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1516 | break; | 
|  | 1517 | } | 
|  | 1518 |  | 
|  | 1519 | /* incomplete transfer? */ | 
| Alan Stern | 4d2f110 | 2007-08-24 15:40:10 -0400 | [diff] [blame] | 1520 | if (status == -EINPROGRESS) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1521 | continue; | 
|  | 1522 |  | 
|  | 1523 | return_urb: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1524 | list_del (&urbp->urbp_list); | 
|  | 1525 | kfree (urbp); | 
|  | 1526 | if (ep) | 
|  | 1527 | ep->already_seen = ep->setup_stage = 0; | 
|  | 1528 |  | 
| Alan Stern | e9df41c | 2007-08-08 11:48:02 -0400 | [diff] [blame] | 1529 | usb_hcd_unlink_urb_from_ep(dummy_to_hcd(dum), urb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1530 | spin_unlock (&dum->lock); | 
| Alan Stern | 4a00027 | 2007-08-24 15:42:24 -0400 | [diff] [blame] | 1531 | usb_hcd_giveback_urb(dummy_to_hcd(dum), urb, status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1532 | spin_lock (&dum->lock); | 
|  | 1533 |  | 
|  | 1534 | goto restart; | 
|  | 1535 | } | 
|  | 1536 |  | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1537 | if (list_empty (&dum->urbp_list)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1538 | usb_put_dev (dum->udev); | 
|  | 1539 | dum->udev = NULL; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1540 | } else if (dum->rh_state == DUMMY_RH_RUNNING) { | 
|  | 1541 | /* want a 1 msec delay here */ | 
|  | 1542 | mod_timer (&dum->timer, jiffies + msecs_to_jiffies(1)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1543 | } | 
|  | 1544 |  | 
|  | 1545 | spin_unlock_irqrestore (&dum->lock, flags); | 
|  | 1546 | } | 
|  | 1547 |  | 
|  | 1548 | /*-------------------------------------------------------------------------*/ | 
|  | 1549 |  | 
|  | 1550 | #define PORT_C_MASK \ | 
| Alan Stern | c2db8b5 | 2005-04-29 16:30:48 -0400 | [diff] [blame] | 1551 | ((USB_PORT_STAT_C_CONNECTION \ | 
|  | 1552 | | USB_PORT_STAT_C_ENABLE \ | 
|  | 1553 | | USB_PORT_STAT_C_SUSPEND \ | 
|  | 1554 | | USB_PORT_STAT_C_OVERCURRENT \ | 
|  | 1555 | | USB_PORT_STAT_C_RESET) << 16) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1556 |  | 
|  | 1557 | static int dummy_hub_status (struct usb_hcd *hcd, char *buf) | 
|  | 1558 | { | 
|  | 1559 | struct dummy		*dum; | 
|  | 1560 | unsigned long		flags; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1561 | int			retval = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1562 |  | 
|  | 1563 | dum = hcd_to_dummy (hcd); | 
|  | 1564 |  | 
|  | 1565 | spin_lock_irqsave (&dum->lock, flags); | 
| Alan Stern | 541c7d4 | 2010-06-22 16:39:10 -0400 | [diff] [blame] | 1566 | if (!HCD_HW_ACCESSIBLE(hcd)) | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1567 | goto done; | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1568 |  | 
|  | 1569 | if (dum->resuming && time_after_eq (jiffies, dum->re_timeout)) { | 
|  | 1570 | dum->port_status |= (USB_PORT_STAT_C_SUSPEND << 16); | 
|  | 1571 | dum->port_status &= ~USB_PORT_STAT_SUSPEND; | 
|  | 1572 | set_link_state (dum); | 
|  | 1573 | } | 
|  | 1574 |  | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1575 | if ((dum->port_status & PORT_C_MASK) != 0) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1576 | *buf = (1 << 1); | 
|  | 1577 | dev_dbg (dummy_dev(dum), "port status 0x%08x has changes\n", | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1578 | dum->port_status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1579 | retval = 1; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1580 | if (dum->rh_state == DUMMY_RH_SUSPENDED) | 
|  | 1581 | usb_hcd_resume_root_hub (hcd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1582 | } | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1583 | done: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1584 | spin_unlock_irqrestore (&dum->lock, flags); | 
|  | 1585 | return retval; | 
|  | 1586 | } | 
|  | 1587 |  | 
|  | 1588 | static inline void | 
|  | 1589 | hub_descriptor (struct usb_hub_descriptor *desc) | 
|  | 1590 | { | 
|  | 1591 | memset (desc, 0, sizeof *desc); | 
|  | 1592 | desc->bDescriptorType = 0x29; | 
|  | 1593 | desc->bDescLength = 9; | 
| Al Viro | fd05e72 | 2008-04-28 07:00:16 +0100 | [diff] [blame] | 1594 | desc->wHubCharacteristics = cpu_to_le16(0x0001); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1595 | desc->bNbrPorts = 1; | 
|  | 1596 | desc->bitmap [0] = 0xff; | 
|  | 1597 | desc->bitmap [1] = 0xff; | 
|  | 1598 | } | 
|  | 1599 |  | 
|  | 1600 | static int dummy_hub_control ( | 
|  | 1601 | struct usb_hcd	*hcd, | 
|  | 1602 | u16		typeReq, | 
|  | 1603 | u16		wValue, | 
|  | 1604 | u16		wIndex, | 
|  | 1605 | char		*buf, | 
|  | 1606 | u16		wLength | 
|  | 1607 | ) { | 
|  | 1608 | struct dummy	*dum; | 
|  | 1609 | int		retval = 0; | 
|  | 1610 | unsigned long	flags; | 
|  | 1611 |  | 
| Alan Stern | 541c7d4 | 2010-06-22 16:39:10 -0400 | [diff] [blame] | 1612 | if (!HCD_HW_ACCESSIBLE(hcd)) | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1613 | return -ETIMEDOUT; | 
|  | 1614 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1615 | dum = hcd_to_dummy (hcd); | 
|  | 1616 | spin_lock_irqsave (&dum->lock, flags); | 
|  | 1617 | switch (typeReq) { | 
|  | 1618 | case ClearHubFeature: | 
|  | 1619 | break; | 
|  | 1620 | case ClearPortFeature: | 
|  | 1621 | switch (wValue) { | 
|  | 1622 | case USB_PORT_FEAT_SUSPEND: | 
| Alan Stern | c2db8b5 | 2005-04-29 16:30:48 -0400 | [diff] [blame] | 1623 | if (dum->port_status & USB_PORT_STAT_SUSPEND) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1624 | /* 20msec resume signaling */ | 
|  | 1625 | dum->resuming = 1; | 
|  | 1626 | dum->re_timeout = jiffies + | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1627 | msecs_to_jiffies(20); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1628 | } | 
|  | 1629 | break; | 
|  | 1630 | case USB_PORT_FEAT_POWER: | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1631 | if (dum->port_status & USB_PORT_STAT_POWER) | 
|  | 1632 | dev_dbg (dummy_dev(dum), "power-off\n"); | 
|  | 1633 | /* FALLS THROUGH */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1634 | default: | 
|  | 1635 | dum->port_status &= ~(1 << wValue); | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1636 | set_link_state (dum); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1637 | } | 
|  | 1638 | break; | 
|  | 1639 | case GetHubDescriptor: | 
|  | 1640 | hub_descriptor ((struct usb_hub_descriptor *) buf); | 
|  | 1641 | break; | 
|  | 1642 | case GetHubStatus: | 
| Harvey Harrison | 551509d | 2009-02-11 14:11:36 -0800 | [diff] [blame] | 1643 | *(__le32 *) buf = cpu_to_le32 (0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1644 | break; | 
|  | 1645 | case GetPortStatus: | 
|  | 1646 | if (wIndex != 1) | 
|  | 1647 | retval = -EPIPE; | 
|  | 1648 |  | 
|  | 1649 | /* whoever resets or resumes must GetPortStatus to | 
|  | 1650 | * complete it!! | 
|  | 1651 | */ | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1652 | if (dum->resuming && | 
|  | 1653 | time_after_eq (jiffies, dum->re_timeout)) { | 
| Alan Stern | c2db8b5 | 2005-04-29 16:30:48 -0400 | [diff] [blame] | 1654 | dum->port_status |= (USB_PORT_STAT_C_SUSPEND << 16); | 
|  | 1655 | dum->port_status &= ~USB_PORT_STAT_SUSPEND; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1656 | } | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1657 | if ((dum->port_status & USB_PORT_STAT_RESET) != 0 && | 
|  | 1658 | time_after_eq (jiffies, dum->re_timeout)) { | 
| Alan Stern | c2db8b5 | 2005-04-29 16:30:48 -0400 | [diff] [blame] | 1659 | dum->port_status |= (USB_PORT_STAT_C_RESET << 16); | 
|  | 1660 | dum->port_status &= ~USB_PORT_STAT_RESET; | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1661 | if (dum->pullup) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1662 | dum->port_status |= USB_PORT_STAT_ENABLE; | 
|  | 1663 | /* give it the best speed we agree on */ | 
|  | 1664 | dum->gadget.speed = dum->driver->speed; | 
|  | 1665 | dum->gadget.ep0->maxpacket = 64; | 
|  | 1666 | switch (dum->gadget.speed) { | 
|  | 1667 | case USB_SPEED_HIGH: | 
|  | 1668 | dum->port_status |= | 
|  | 1669 | USB_PORT_STAT_HIGH_SPEED; | 
|  | 1670 | break; | 
|  | 1671 | case USB_SPEED_LOW: | 
|  | 1672 | dum->gadget.ep0->maxpacket = 8; | 
|  | 1673 | dum->port_status |= | 
|  | 1674 | USB_PORT_STAT_LOW_SPEED; | 
|  | 1675 | break; | 
|  | 1676 | default: | 
|  | 1677 | dum->gadget.speed = USB_SPEED_FULL; | 
|  | 1678 | break; | 
|  | 1679 | } | 
|  | 1680 | } | 
|  | 1681 | } | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1682 | set_link_state (dum); | 
| Alan Stern | cc095b0 | 2005-05-10 15:28:38 -0400 | [diff] [blame] | 1683 | ((__le16 *) buf)[0] = cpu_to_le16 (dum->port_status); | 
|  | 1684 | ((__le16 *) buf)[1] = cpu_to_le16 (dum->port_status >> 16); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1685 | break; | 
|  | 1686 | case SetHubFeature: | 
|  | 1687 | retval = -EPIPE; | 
|  | 1688 | break; | 
|  | 1689 | case SetPortFeature: | 
|  | 1690 | switch (wValue) { | 
|  | 1691 | case USB_PORT_FEAT_SUSPEND: | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1692 | if (dum->active) { | 
| Alan Stern | c2db8b5 | 2005-04-29 16:30:48 -0400 | [diff] [blame] | 1693 | dum->port_status |= USB_PORT_STAT_SUSPEND; | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1694 |  | 
|  | 1695 | /* HNP would happen here; for now we | 
|  | 1696 | * assume b_bus_req is always true. | 
|  | 1697 | */ | 
|  | 1698 | set_link_state (dum); | 
|  | 1699 | if (((1 << USB_DEVICE_B_HNP_ENABLE) | 
|  | 1700 | & dum->devstatus) != 0) | 
|  | 1701 | dev_dbg (dummy_dev(dum), | 
| Alan Stern | 5742b0c | 2005-05-02 11:25:17 -0400 | [diff] [blame] | 1702 | "no HNP yet!\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1703 | } | 
|  | 1704 | break; | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1705 | case USB_PORT_FEAT_POWER: | 
|  | 1706 | dum->port_status |= USB_PORT_STAT_POWER; | 
|  | 1707 | set_link_state (dum); | 
|  | 1708 | break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1709 | case USB_PORT_FEAT_RESET: | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1710 | /* if it's already enabled, disable */ | 
|  | 1711 | dum->port_status &= ~(USB_PORT_STAT_ENABLE | 
|  | 1712 | | USB_PORT_STAT_LOW_SPEED | 
|  | 1713 | | USB_PORT_STAT_HIGH_SPEED); | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1714 | dum->devstatus = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1715 | /* 50msec reset signaling */ | 
|  | 1716 | dum->re_timeout = jiffies + msecs_to_jiffies(50); | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1717 | /* FALLS THROUGH */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1718 | default: | 
| Alan Stern | f1c39fa | 2005-05-03 16:24:04 -0400 | [diff] [blame] | 1719 | if ((dum->port_status & USB_PORT_STAT_POWER) != 0) { | 
|  | 1720 | dum->port_status |= (1 << wValue); | 
|  | 1721 | set_link_state (dum); | 
|  | 1722 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1723 | } | 
|  | 1724 | break; | 
|  | 1725 |  | 
|  | 1726 | default: | 
|  | 1727 | dev_dbg (dummy_dev(dum), | 
|  | 1728 | "hub control req%04x v%04x i%04x l%d\n", | 
|  | 1729 | typeReq, wValue, wIndex, wLength); | 
|  | 1730 |  | 
|  | 1731 | /* "protocol stall" on error */ | 
|  | 1732 | retval = -EPIPE; | 
|  | 1733 | } | 
|  | 1734 | spin_unlock_irqrestore (&dum->lock, flags); | 
| Alan Stern | 685eb93 | 2005-05-03 16:27:26 -0400 | [diff] [blame] | 1735 |  | 
|  | 1736 | if ((dum->port_status & PORT_C_MASK) != 0) | 
|  | 1737 | usb_hcd_poll_rh_status (hcd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1738 | return retval; | 
|  | 1739 | } | 
|  | 1740 |  | 
| Alan Stern | 0c0382e | 2005-10-13 17:08:02 -0400 | [diff] [blame] | 1741 | static int dummy_bus_suspend (struct usb_hcd *hcd) | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1742 | { | 
|  | 1743 | struct dummy *dum = hcd_to_dummy (hcd); | 
|  | 1744 |  | 
| Harvey Harrison | 441b62c | 2008-03-03 16:08:34 -0800 | [diff] [blame] | 1745 | dev_dbg (&hcd->self.root_hub->dev, "%s\n", __func__); | 
| Alan Stern | 3cf0a22 | 2005-11-29 12:08:15 -0500 | [diff] [blame] | 1746 |  | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1747 | spin_lock_irq (&dum->lock); | 
|  | 1748 | dum->rh_state = DUMMY_RH_SUSPENDED; | 
|  | 1749 | set_link_state (dum); | 
| Alan Stern | 3cf0a22 | 2005-11-29 12:08:15 -0500 | [diff] [blame] | 1750 | hcd->state = HC_STATE_SUSPENDED; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1751 | spin_unlock_irq (&dum->lock); | 
|  | 1752 | return 0; | 
|  | 1753 | } | 
|  | 1754 |  | 
| Alan Stern | 0c0382e | 2005-10-13 17:08:02 -0400 | [diff] [blame] | 1755 | static int dummy_bus_resume (struct usb_hcd *hcd) | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1756 | { | 
|  | 1757 | struct dummy *dum = hcd_to_dummy (hcd); | 
| Alan Stern | 3cf0a22 | 2005-11-29 12:08:15 -0500 | [diff] [blame] | 1758 | int rc = 0; | 
|  | 1759 |  | 
| Harvey Harrison | 441b62c | 2008-03-03 16:08:34 -0800 | [diff] [blame] | 1760 | dev_dbg (&hcd->self.root_hub->dev, "%s\n", __func__); | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1761 |  | 
|  | 1762 | spin_lock_irq (&dum->lock); | 
| Alan Stern | 541c7d4 | 2010-06-22 16:39:10 -0400 | [diff] [blame] | 1763 | if (!HCD_HW_ACCESSIBLE(hcd)) { | 
| Alan Stern | cfa59da | 2007-06-21 16:25:35 -0400 | [diff] [blame] | 1764 | rc = -ESHUTDOWN; | 
| Alan Stern | 3cf0a22 | 2005-11-29 12:08:15 -0500 | [diff] [blame] | 1765 | } else { | 
|  | 1766 | dum->rh_state = DUMMY_RH_RUNNING; | 
|  | 1767 | set_link_state (dum); | 
|  | 1768 | if (!list_empty(&dum->urbp_list)) | 
|  | 1769 | mod_timer (&dum->timer, jiffies); | 
|  | 1770 | hcd->state = HC_STATE_RUNNING; | 
|  | 1771 | } | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1772 | spin_unlock_irq (&dum->lock); | 
| Alan Stern | 3cf0a22 | 2005-11-29 12:08:15 -0500 | [diff] [blame] | 1773 | return rc; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1774 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1775 |  | 
|  | 1776 | /*-------------------------------------------------------------------------*/ | 
|  | 1777 |  | 
|  | 1778 | static inline ssize_t | 
|  | 1779 | show_urb (char *buf, size_t size, struct urb *urb) | 
|  | 1780 | { | 
|  | 1781 | int ep = usb_pipeendpoint (urb->pipe); | 
|  | 1782 |  | 
|  | 1783 | return snprintf (buf, size, | 
|  | 1784 | "urb/%p %s ep%d%s%s len %d/%d\n", | 
|  | 1785 | urb, | 
|  | 1786 | ({ char *s; | 
|  | 1787 | switch (urb->dev->speed) { | 
|  | 1788 | case USB_SPEED_LOW:	s = "ls"; break; | 
|  | 1789 | case USB_SPEED_FULL:	s = "fs"; break; | 
|  | 1790 | case USB_SPEED_HIGH:	s = "hs"; break; | 
|  | 1791 | default:		s = "?"; break; | 
|  | 1792 | }; s; }), | 
|  | 1793 | ep, ep ? (usb_pipein (urb->pipe) ? "in" : "out") : "", | 
|  | 1794 | ({ char *s; \ | 
|  | 1795 | switch (usb_pipetype (urb->pipe)) { \ | 
|  | 1796 | case PIPE_CONTROL:	s = ""; break; \ | 
|  | 1797 | case PIPE_BULK:	s = "-bulk"; break; \ | 
|  | 1798 | case PIPE_INTERRUPT:	s = "-int"; break; \ | 
|  | 1799 | default: 		s = "-iso"; break; \ | 
|  | 1800 | }; s;}), | 
|  | 1801 | urb->actual_length, urb->transfer_buffer_length); | 
|  | 1802 | } | 
|  | 1803 |  | 
|  | 1804 | static ssize_t | 
| Yani Ioannou | 10523b3 | 2005-05-17 06:43:37 -0400 | [diff] [blame] | 1805 | show_urbs (struct device *dev, struct device_attribute *attr, char *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1806 | { | 
|  | 1807 | struct usb_hcd		*hcd = dev_get_drvdata (dev); | 
|  | 1808 | struct dummy		*dum = hcd_to_dummy (hcd); | 
|  | 1809 | struct urbp		*urbp; | 
|  | 1810 | size_t			size = 0; | 
|  | 1811 | unsigned long		flags; | 
|  | 1812 |  | 
|  | 1813 | spin_lock_irqsave (&dum->lock, flags); | 
|  | 1814 | list_for_each_entry (urbp, &dum->urbp_list, urbp_list) { | 
|  | 1815 | size_t		temp; | 
|  | 1816 |  | 
|  | 1817 | temp = show_urb (buf, PAGE_SIZE - size, urbp->urb); | 
|  | 1818 | buf += temp; | 
|  | 1819 | size += temp; | 
|  | 1820 | } | 
|  | 1821 | spin_unlock_irqrestore (&dum->lock, flags); | 
|  | 1822 |  | 
|  | 1823 | return size; | 
|  | 1824 | } | 
|  | 1825 | static DEVICE_ATTR (urbs, S_IRUGO, show_urbs, NULL); | 
|  | 1826 |  | 
|  | 1827 | static int dummy_start (struct usb_hcd *hcd) | 
|  | 1828 | { | 
|  | 1829 | struct dummy		*dum; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1830 |  | 
|  | 1831 | dum = hcd_to_dummy (hcd); | 
|  | 1832 |  | 
|  | 1833 | /* | 
|  | 1834 | * MASTER side init ... we emulate a root hub that'll only ever | 
|  | 1835 | * talk to one device (the slave side).  Also appears in sysfs, | 
|  | 1836 | * just like more familiar pci-based HCDs. | 
|  | 1837 | */ | 
|  | 1838 | spin_lock_init (&dum->lock); | 
|  | 1839 | init_timer (&dum->timer); | 
|  | 1840 | dum->timer.function = dummy_timer; | 
|  | 1841 | dum->timer.data = (unsigned long) dum; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1842 | dum->rh_state = DUMMY_RH_RUNNING; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1843 |  | 
|  | 1844 | INIT_LIST_HEAD (&dum->urbp_list); | 
|  | 1845 |  | 
| Alan Stern | caf29f6 | 2007-12-06 11:10:39 -0500 | [diff] [blame] | 1846 | hcd->power_budget = POWER_BUDGET; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1847 | hcd->state = HC_STATE_RUNNING; | 
| Alan Stern | 685eb93 | 2005-05-03 16:27:26 -0400 | [diff] [blame] | 1848 | hcd->uses_new_polling = 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1849 |  | 
| Alan Stern | 5742b0c | 2005-05-02 11:25:17 -0400 | [diff] [blame] | 1850 | #ifdef CONFIG_USB_OTG | 
|  | 1851 | hcd->self.otg_port = 1; | 
|  | 1852 | #endif | 
|  | 1853 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1854 | /* FIXME 'urbs' should be a per-device thing, maybe in usbcore */ | 
| Alan Stern | efd54a3 | 2006-09-25 11:55:56 -0400 | [diff] [blame] | 1855 | return device_create_file (dummy_dev(dum), &dev_attr_urbs); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1856 | } | 
|  | 1857 |  | 
|  | 1858 | static void dummy_stop (struct usb_hcd *hcd) | 
|  | 1859 | { | 
|  | 1860 | struct dummy		*dum; | 
|  | 1861 |  | 
|  | 1862 | dum = hcd_to_dummy (hcd); | 
|  | 1863 |  | 
|  | 1864 | device_remove_file (dummy_dev(dum), &dev_attr_urbs); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1865 | usb_gadget_unregister_driver (dum->driver); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1866 | dev_info (dummy_dev(dum), "stopped\n"); | 
|  | 1867 | } | 
|  | 1868 |  | 
|  | 1869 | /*-------------------------------------------------------------------------*/ | 
|  | 1870 |  | 
|  | 1871 | static int dummy_h_get_frame (struct usb_hcd *hcd) | 
|  | 1872 | { | 
|  | 1873 | return dummy_g_get_frame (NULL); | 
|  | 1874 | } | 
|  | 1875 |  | 
|  | 1876 | static const struct hc_driver dummy_hcd = { | 
|  | 1877 | .description =		(char *) driver_name, | 
|  | 1878 | .product_desc =		"Dummy host controller", | 
|  | 1879 | .hcd_priv_size =	sizeof(struct dummy), | 
|  | 1880 |  | 
|  | 1881 | .flags =		HCD_USB2, | 
|  | 1882 |  | 
|  | 1883 | .start =		dummy_start, | 
|  | 1884 | .stop =			dummy_stop, | 
|  | 1885 |  | 
|  | 1886 | .urb_enqueue = 		dummy_urb_enqueue, | 
|  | 1887 | .urb_dequeue = 		dummy_urb_dequeue, | 
|  | 1888 |  | 
|  | 1889 | .get_frame_number = 	dummy_h_get_frame, | 
|  | 1890 |  | 
|  | 1891 | .hub_status_data = 	dummy_hub_status, | 
|  | 1892 | .hub_control = 		dummy_hub_control, | 
| Alan Stern | 0c0382e | 2005-10-13 17:08:02 -0400 | [diff] [blame] | 1893 | .bus_suspend =		dummy_bus_suspend, | 
|  | 1894 | .bus_resume =		dummy_bus_resume, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1895 | }; | 
|  | 1896 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 1897 | static int dummy_hcd_probe(struct platform_device *pdev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1898 | { | 
|  | 1899 | struct usb_hcd		*hcd; | 
|  | 1900 | int			retval; | 
|  | 1901 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 1902 | dev_info(&pdev->dev, "%s, driver " DRIVER_VERSION "\n", driver_desc); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1903 |  | 
| Kay Sievers | 7071a3c | 2008-05-02 06:02:41 +0200 | [diff] [blame] | 1904 | hcd = usb_create_hcd(&dummy_hcd, &pdev->dev, dev_name(&pdev->dev)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1905 | if (!hcd) | 
|  | 1906 | return -ENOMEM; | 
|  | 1907 | the_controller = hcd_to_dummy (hcd); | 
|  | 1908 |  | 
|  | 1909 | retval = usb_add_hcd(hcd, 0, 0); | 
|  | 1910 | if (retval != 0) { | 
|  | 1911 | usb_put_hcd (hcd); | 
|  | 1912 | the_controller = NULL; | 
|  | 1913 | } | 
|  | 1914 | return retval; | 
|  | 1915 | } | 
|  | 1916 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 1917 | static int dummy_hcd_remove (struct platform_device *pdev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1918 | { | 
|  | 1919 | struct usb_hcd		*hcd; | 
|  | 1920 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 1921 | hcd = platform_get_drvdata (pdev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1922 | usb_remove_hcd (hcd); | 
|  | 1923 | usb_put_hcd (hcd); | 
|  | 1924 | the_controller = NULL; | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 1925 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1926 | } | 
|  | 1927 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 1928 | static int dummy_hcd_suspend (struct platform_device *pdev, pm_message_t state) | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1929 | { | 
|  | 1930 | struct usb_hcd		*hcd; | 
| Alan Stern | 3cf0a22 | 2005-11-29 12:08:15 -0500 | [diff] [blame] | 1931 | struct dummy		*dum; | 
|  | 1932 | int			rc = 0; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1933 |  | 
| Harvey Harrison | 441b62c | 2008-03-03 16:08:34 -0800 | [diff] [blame] | 1934 | dev_dbg (&pdev->dev, "%s\n", __func__); | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1935 |  | 
| Alan Stern | 3cf0a22 | 2005-11-29 12:08:15 -0500 | [diff] [blame] | 1936 | hcd = platform_get_drvdata (pdev); | 
|  | 1937 | dum = hcd_to_dummy (hcd); | 
|  | 1938 | if (dum->rh_state == DUMMY_RH_RUNNING) { | 
|  | 1939 | dev_warn(&pdev->dev, "Root hub isn't suspended!\n"); | 
|  | 1940 | rc = -EBUSY; | 
|  | 1941 | } else | 
|  | 1942 | clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); | 
|  | 1943 | return rc; | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1944 | } | 
|  | 1945 |  | 
| Alan Stern | 8364d6b | 2005-11-14 12:16:30 -0500 | [diff] [blame] | 1946 | static int dummy_hcd_resume (struct platform_device *pdev) | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1947 | { | 
|  | 1948 | struct usb_hcd		*hcd; | 
|  | 1949 |  | 
| Harvey Harrison | 441b62c | 2008-03-03 16:08:34 -0800 | [diff] [blame] | 1950 | dev_dbg (&pdev->dev, "%s\n", __func__); | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1951 |  | 
| Alan Stern | 3cf0a22 | 2005-11-29 12:08:15 -0500 | [diff] [blame] | 1952 | hcd = platform_get_drvdata (pdev); | 
|  | 1953 | set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1954 | usb_hcd_poll_rh_status (hcd); | 
|  | 1955 | return 0; | 
|  | 1956 | } | 
|  | 1957 |  | 
| Russell King | 3ae5eae | 2005-11-09 22:32:44 +0000 | [diff] [blame] | 1958 | static struct platform_driver dummy_hcd_driver = { | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 1959 | .probe		= dummy_hcd_probe, | 
|  | 1960 | .remove		= dummy_hcd_remove, | 
| Alan Stern | 391eca9 | 2005-05-10 15:34:16 -0400 | [diff] [blame] | 1961 | .suspend	= dummy_hcd_suspend, | 
|  | 1962 | .resume		= dummy_hcd_resume, | 
| Russell King | 3ae5eae | 2005-11-09 22:32:44 +0000 | [diff] [blame] | 1963 | .driver		= { | 
|  | 1964 | .name	= (char *) driver_name, | 
|  | 1965 | .owner	= THIS_MODULE, | 
|  | 1966 | }, | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 1967 | }; | 
|  | 1968 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1969 | /*-------------------------------------------------------------------------*/ | 
|  | 1970 |  | 
| Alan Stern | a89a2cd | 2008-04-07 15:03:25 -0400 | [diff] [blame] | 1971 | static struct platform_device *the_udc_pdev; | 
|  | 1972 | static struct platform_device *the_hcd_pdev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1973 |  | 
|  | 1974 | static int __init init (void) | 
|  | 1975 | { | 
| Alan Stern | a89a2cd | 2008-04-07 15:03:25 -0400 | [diff] [blame] | 1976 | int	retval = -ENOMEM; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1977 |  | 
|  | 1978 | if (usb_disabled ()) | 
|  | 1979 | return -ENODEV; | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 1980 |  | 
| Alan Stern | a89a2cd | 2008-04-07 15:03:25 -0400 | [diff] [blame] | 1981 | the_hcd_pdev = platform_device_alloc(driver_name, -1); | 
|  | 1982 | if (!the_hcd_pdev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1983 | return retval; | 
| Alan Stern | a89a2cd | 2008-04-07 15:03:25 -0400 | [diff] [blame] | 1984 | the_udc_pdev = platform_device_alloc(gadget_name, -1); | 
|  | 1985 | if (!the_udc_pdev) | 
|  | 1986 | goto err_alloc_udc; | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 1987 |  | 
| Alan Stern | a89a2cd | 2008-04-07 15:03:25 -0400 | [diff] [blame] | 1988 | retval = platform_driver_register(&dummy_hcd_driver); | 
|  | 1989 | if (retval < 0) | 
|  | 1990 | goto err_register_hcd_driver; | 
|  | 1991 | retval = platform_driver_register(&dummy_udc_driver); | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 1992 | if (retval < 0) | 
|  | 1993 | goto err_register_udc_driver; | 
|  | 1994 |  | 
| Alan Stern | a89a2cd | 2008-04-07 15:03:25 -0400 | [diff] [blame] | 1995 | retval = platform_device_add(the_hcd_pdev); | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 1996 | if (retval < 0) | 
| Alan Stern | a89a2cd | 2008-04-07 15:03:25 -0400 | [diff] [blame] | 1997 | goto err_add_hcd; | 
|  | 1998 | retval = platform_device_add(the_udc_pdev); | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 1999 | if (retval < 0) | 
| Alan Stern | a89a2cd | 2008-04-07 15:03:25 -0400 | [diff] [blame] | 2000 | goto err_add_udc; | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 2001 | return retval; | 
|  | 2002 |  | 
| Alan Stern | a89a2cd | 2008-04-07 15:03:25 -0400 | [diff] [blame] | 2003 | err_add_udc: | 
|  | 2004 | platform_device_del(the_hcd_pdev); | 
|  | 2005 | err_add_hcd: | 
|  | 2006 | platform_driver_unregister(&dummy_udc_driver); | 
| Alan Stern | d9b7625 | 2005-05-03 16:15:43 -0400 | [diff] [blame] | 2007 | err_register_udc_driver: | 
| Alan Stern | a89a2cd | 2008-04-07 15:03:25 -0400 | [diff] [blame] | 2008 | platform_driver_unregister(&dummy_hcd_driver); | 
|  | 2009 | err_register_hcd_driver: | 
|  | 2010 | platform_device_put(the_udc_pdev); | 
|  | 2011 | err_alloc_udc: | 
|  | 2012 | platform_device_put(the_hcd_pdev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2013 | return retval; | 
|  | 2014 | } | 
|  | 2015 | module_init (init); | 
|  | 2016 |  | 
|  | 2017 | static void __exit cleanup (void) | 
|  | 2018 | { | 
| Alan Stern | a89a2cd | 2008-04-07 15:03:25 -0400 | [diff] [blame] | 2019 | platform_device_unregister(the_udc_pdev); | 
|  | 2020 | platform_device_unregister(the_hcd_pdev); | 
|  | 2021 | platform_driver_unregister(&dummy_udc_driver); | 
|  | 2022 | platform_driver_unregister(&dummy_hcd_driver); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2023 | } | 
|  | 2024 | module_exit (cleanup); |