| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 1 | /** | 
 | 2 |  * ep0.c - DesignWare USB3 DRD Controller Endpoint 0 Handling | 
 | 3 |  * | 
 | 4 |  * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 5 |  * | 
 | 6 |  * Authors: Felipe Balbi <balbi@ti.com>, | 
 | 7 |  *	    Sebastian Andrzej Siewior <bigeasy@linutronix.de> | 
 | 8 |  * | 
 | 9 |  * Redistribution and use in source and binary forms, with or without | 
 | 10 |  * modification, are permitted provided that the following conditions | 
 | 11 |  * are met: | 
 | 12 |  * 1. Redistributions of source code must retain the above copyright | 
 | 13 |  *    notice, this list of conditions, and the following disclaimer, | 
 | 14 |  *    without modification. | 
 | 15 |  * 2. Redistributions in binary form must reproduce the above copyright | 
 | 16 |  *    notice, this list of conditions and the following disclaimer in the | 
 | 17 |  *    documentation and/or other materials provided with the distribution. | 
 | 18 |  * 3. The names of the above-listed copyright holders may not be used | 
 | 19 |  *    to endorse or promote products derived from this software without | 
 | 20 |  *    specific prior written permission. | 
 | 21 |  * | 
 | 22 |  * ALTERNATIVELY, this software may be distributed under the terms of the | 
 | 23 |  * GNU General Public License ("GPL") version 2, as published by the Free | 
 | 24 |  * Software Foundation. | 
 | 25 |  * | 
 | 26 |  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS | 
 | 27 |  * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, | 
 | 28 |  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR | 
 | 29 |  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR | 
 | 30 |  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, | 
 | 31 |  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, | 
 | 32 |  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR | 
 | 33 |  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF | 
 | 34 |  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING | 
 | 35 |  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS | 
 | 36 |  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | 
 | 37 |  */ | 
 | 38 |  | 
 | 39 | #include <linux/kernel.h> | 
 | 40 | #include <linux/slab.h> | 
 | 41 | #include <linux/spinlock.h> | 
 | 42 | #include <linux/platform_device.h> | 
 | 43 | #include <linux/pm_runtime.h> | 
 | 44 | #include <linux/interrupt.h> | 
 | 45 | #include <linux/io.h> | 
 | 46 | #include <linux/list.h> | 
 | 47 | #include <linux/dma-mapping.h> | 
 | 48 |  | 
 | 49 | #include <linux/usb/ch9.h> | 
 | 50 | #include <linux/usb/gadget.h> | 
| Sebastian Andrzej Siewior | 5bdb1dc | 2011-11-02 13:30:45 +0100 | [diff] [blame] | 51 | #include <linux/usb/composite.h> | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 52 |  | 
 | 53 | #include "core.h" | 
 | 54 | #include "gadget.h" | 
 | 55 | #include "io.h" | 
 | 56 |  | 
| Sebastian Andrzej Siewior | 5bdb1dc | 2011-11-02 13:30:45 +0100 | [diff] [blame] | 57 | static void dwc3_ep0_do_control_status(struct dwc3 *dwc, u32 epnum); | 
 | 58 |  | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 59 | static const char *dwc3_ep0_state_string(enum dwc3_ep0_state state) | 
 | 60 | { | 
 | 61 | 	switch (state) { | 
 | 62 | 	case EP0_UNCONNECTED: | 
 | 63 | 		return "Unconnected"; | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 64 | 	case EP0_SETUP_PHASE: | 
 | 65 | 		return "Setup Phase"; | 
 | 66 | 	case EP0_DATA_PHASE: | 
 | 67 | 		return "Data Phase"; | 
 | 68 | 	case EP0_STATUS_PHASE: | 
 | 69 | 		return "Status Phase"; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 70 | 	default: | 
 | 71 | 		return "UNKNOWN"; | 
 | 72 | 	} | 
 | 73 | } | 
 | 74 |  | 
 | 75 | static int dwc3_ep0_start_trans(struct dwc3 *dwc, u8 epnum, dma_addr_t buf_dma, | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 76 | 		u32 len, u32 type) | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 77 | { | 
 | 78 | 	struct dwc3_gadget_ep_cmd_params params; | 
| Felipe Balbi | f6bafc6 | 2012-02-06 11:04:53 +0200 | [diff] [blame] | 79 | 	struct dwc3_trb			*trb; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 80 | 	struct dwc3_ep			*dep; | 
 | 81 |  | 
 | 82 | 	int				ret; | 
 | 83 |  | 
 | 84 | 	dep = dwc->eps[epnum]; | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 85 | 	if (dep->flags & DWC3_EP_BUSY) { | 
 | 86 | 		dev_vdbg(dwc->dev, "%s: still busy\n", dep->name); | 
 | 87 | 		return 0; | 
 | 88 | 	} | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 89 |  | 
| Felipe Balbi | f6bafc6 | 2012-02-06 11:04:53 +0200 | [diff] [blame] | 90 | 	trb = dwc->ep0_trb; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 91 |  | 
| Felipe Balbi | f6bafc6 | 2012-02-06 11:04:53 +0200 | [diff] [blame] | 92 | 	trb->bpl = lower_32_bits(buf_dma); | 
 | 93 | 	trb->bph = upper_32_bits(buf_dma); | 
 | 94 | 	trb->size = len; | 
 | 95 | 	trb->ctrl = type; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 96 |  | 
| Felipe Balbi | f6bafc6 | 2012-02-06 11:04:53 +0200 | [diff] [blame] | 97 | 	trb->ctrl |= (DWC3_TRB_CTRL_HWO | 
 | 98 | 			| DWC3_TRB_CTRL_LST | 
 | 99 | 			| DWC3_TRB_CTRL_IOC | 
 | 100 | 			| DWC3_TRB_CTRL_ISP_IMI); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 101 |  | 
 | 102 | 	memset(¶ms, 0, sizeof(params)); | 
| Felipe Balbi | dc1c70a | 2011-09-30 10:58:51 +0300 | [diff] [blame] | 103 | 	params.param0 = upper_32_bits(dwc->ep0_trb_addr); | 
 | 104 | 	params.param1 = lower_32_bits(dwc->ep0_trb_addr); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 105 |  | 
 | 106 | 	ret = dwc3_send_gadget_ep_cmd(dwc, dep->number, | 
 | 107 | 			DWC3_DEPCMD_STARTTRANSFER, ¶ms); | 
 | 108 | 	if (ret < 0) { | 
 | 109 | 		dev_dbg(dwc->dev, "failed to send STARTTRANSFER command\n"); | 
 | 110 | 		return ret; | 
 | 111 | 	} | 
 | 112 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 113 | 	dep->flags |= DWC3_EP_BUSY; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 114 | 	dep->res_trans_idx = dwc3_gadget_ep_get_transfer_index(dwc, | 
 | 115 | 			dep->number); | 
 | 116 |  | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 117 | 	dwc->ep0_next_event = DWC3_EP0_COMPLETE; | 
 | 118 |  | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 119 | 	return 0; | 
 | 120 | } | 
 | 121 |  | 
 | 122 | static int __dwc3_gadget_ep0_queue(struct dwc3_ep *dep, | 
 | 123 | 		struct dwc3_request *req) | 
 | 124 | { | 
| Sebastian Andrzej Siewior | 5bdb1dc | 2011-11-02 13:30:45 +0100 | [diff] [blame] | 125 | 	struct dwc3		*dwc = dep->dwc; | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 126 | 	int			ret = 0; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 127 |  | 
 | 128 | 	req->request.actual	= 0; | 
 | 129 | 	req->request.status	= -EINPROGRESS; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 130 | 	req->epnum		= dep->number; | 
 | 131 |  | 
 | 132 | 	list_add_tail(&req->list, &dep->request_list); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 133 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 134 | 	/* | 
 | 135 | 	 * Gadget driver might not be quick enough to queue a request | 
 | 136 | 	 * before we get a Transfer Not Ready event on this endpoint. | 
 | 137 | 	 * | 
 | 138 | 	 * In that case, we will set DWC3_EP_PENDING_REQUEST. When that | 
 | 139 | 	 * flag is set, it's telling us that as soon as Gadget queues the | 
 | 140 | 	 * required request, we should kick the transfer here because the | 
 | 141 | 	 * IRQ we were waiting for is long gone. | 
 | 142 | 	 */ | 
 | 143 | 	if (dep->flags & DWC3_EP_PENDING_REQUEST) { | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 144 | 		unsigned	direction; | 
| Felipe Balbi | a682970 | 2011-08-27 22:18:09 +0300 | [diff] [blame] | 145 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 146 | 		direction = !!(dep->flags & DWC3_EP0_DIR_IN); | 
| Felipe Balbi | a682970 | 2011-08-27 22:18:09 +0300 | [diff] [blame] | 147 |  | 
| Felipe Balbi | 68d8a78 | 2011-12-29 06:32:29 +0200 | [diff] [blame] | 148 | 		if (dwc->ep0state != EP0_DATA_PHASE) { | 
 | 149 | 			dev_WARN(dwc->dev, "Unexpected pending request\n"); | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 150 | 			return 0; | 
 | 151 | 		} | 
| Felipe Balbi | a682970 | 2011-08-27 22:18:09 +0300 | [diff] [blame] | 152 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 153 | 		ret = dwc3_ep0_start_trans(dwc, direction, | 
| Felipe Balbi | 68d8a78 | 2011-12-29 06:32:29 +0200 | [diff] [blame] | 154 | 				req->request.dma, req->request.length, | 
 | 155 | 				DWC3_TRBCTL_CONTROL_DATA); | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 156 | 		dep->flags &= ~(DWC3_EP_PENDING_REQUEST | | 
 | 157 | 				DWC3_EP0_DIR_IN); | 
| Felipe Balbi | 68d3e66 | 2011-12-08 13:56:27 +0200 | [diff] [blame] | 158 | 	} else if (dwc->delayed_status) { | 
| Sebastian Andrzej Siewior | 5bdb1dc | 2011-11-02 13:30:45 +0100 | [diff] [blame] | 159 | 		dwc->delayed_status = false; | 
| Felipe Balbi | 68d3e66 | 2011-12-08 13:56:27 +0200 | [diff] [blame] | 160 |  | 
 | 161 | 		if (dwc->ep0state == EP0_STATUS_PHASE) | 
 | 162 | 			dwc3_ep0_do_control_status(dwc, 1); | 
 | 163 | 		else | 
 | 164 | 			dev_dbg(dwc->dev, "too early for delayed status\n"); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 165 | 	} | 
 | 166 |  | 
 | 167 | 	return ret; | 
 | 168 | } | 
 | 169 |  | 
 | 170 | int dwc3_gadget_ep0_queue(struct usb_ep *ep, struct usb_request *request, | 
 | 171 | 		gfp_t gfp_flags) | 
 | 172 | { | 
 | 173 | 	struct dwc3_request		*req = to_dwc3_request(request); | 
 | 174 | 	struct dwc3_ep			*dep = to_dwc3_ep(ep); | 
 | 175 | 	struct dwc3			*dwc = dep->dwc; | 
 | 176 |  | 
 | 177 | 	unsigned long			flags; | 
 | 178 |  | 
 | 179 | 	int				ret; | 
 | 180 |  | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 181 | 	spin_lock_irqsave(&dwc->lock, flags); | 
 | 182 | 	if (!dep->desc) { | 
 | 183 | 		dev_dbg(dwc->dev, "trying to queue request %p to disabled %s\n", | 
 | 184 | 				request, dep->name); | 
 | 185 | 		ret = -ESHUTDOWN; | 
 | 186 | 		goto out; | 
 | 187 | 	} | 
 | 188 |  | 
 | 189 | 	/* we share one TRB for ep0/1 */ | 
| Sebastian Andrzej Siewior | c2da2ff | 2011-10-20 19:04:16 +0200 | [diff] [blame] | 190 | 	if (!list_empty(&dep->request_list)) { | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 191 | 		ret = -EBUSY; | 
 | 192 | 		goto out; | 
 | 193 | 	} | 
 | 194 |  | 
 | 195 | 	dev_vdbg(dwc->dev, "queueing request %p to %s length %d, state '%s'\n", | 
 | 196 | 			request, dep->name, request->length, | 
 | 197 | 			dwc3_ep0_state_string(dwc->ep0state)); | 
 | 198 |  | 
 | 199 | 	ret = __dwc3_gadget_ep0_queue(dep, req); | 
 | 200 |  | 
 | 201 | out: | 
 | 202 | 	spin_unlock_irqrestore(&dwc->lock, flags); | 
 | 203 |  | 
 | 204 | 	return ret; | 
 | 205 | } | 
 | 206 |  | 
 | 207 | static void dwc3_ep0_stall_and_restart(struct dwc3 *dwc) | 
 | 208 | { | 
| Felipe Balbi | d742220 | 2011-09-08 18:17:12 +0300 | [diff] [blame] | 209 | 	struct dwc3_ep		*dep = dwc->eps[0]; | 
 | 210 |  | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 211 | 	/* stall is always issued on EP0 */ | 
| Sebastian Andrzej Siewior | c2da2ff | 2011-10-20 19:04:16 +0200 | [diff] [blame] | 212 | 	__dwc3_gadget_ep_set_halt(dep, 1); | 
 | 213 | 	dep->flags = DWC3_EP_ENABLED; | 
| Sebastian Andrzej Siewior | 5bdb1dc | 2011-11-02 13:30:45 +0100 | [diff] [blame] | 214 | 	dwc->delayed_status = false; | 
| Felipe Balbi | d742220 | 2011-09-08 18:17:12 +0300 | [diff] [blame] | 215 |  | 
 | 216 | 	if (!list_empty(&dep->request_list)) { | 
 | 217 | 		struct dwc3_request	*req; | 
 | 218 |  | 
 | 219 | 		req = next_request(&dep->request_list); | 
 | 220 | 		dwc3_gadget_giveback(dep, req, -ECONNRESET); | 
 | 221 | 	} | 
 | 222 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 223 | 	dwc->ep0state = EP0_SETUP_PHASE; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 224 | 	dwc3_ep0_out_start(dwc); | 
 | 225 | } | 
 | 226 |  | 
 | 227 | void dwc3_ep0_out_start(struct dwc3 *dwc) | 
 | 228 | { | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 229 | 	int				ret; | 
 | 230 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 231 | 	ret = dwc3_ep0_start_trans(dwc, 0, dwc->ctrl_req_addr, 8, | 
 | 232 | 			DWC3_TRBCTL_CONTROL_SETUP); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 233 | 	WARN_ON(ret < 0); | 
 | 234 | } | 
 | 235 |  | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 236 | static struct dwc3_ep *dwc3_wIndex_to_dep(struct dwc3 *dwc, __le16 wIndex_le) | 
 | 237 | { | 
 | 238 | 	struct dwc3_ep		*dep; | 
 | 239 | 	u32			windex = le16_to_cpu(wIndex_le); | 
 | 240 | 	u32			epnum; | 
 | 241 |  | 
 | 242 | 	epnum = (windex & USB_ENDPOINT_NUMBER_MASK) << 1; | 
 | 243 | 	if ((windex & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN) | 
 | 244 | 		epnum |= 1; | 
 | 245 |  | 
 | 246 | 	dep = dwc->eps[epnum]; | 
 | 247 | 	if (dep->flags & DWC3_EP_ENABLED) | 
 | 248 | 		return dep; | 
 | 249 |  | 
 | 250 | 	return NULL; | 
 | 251 | } | 
 | 252 |  | 
| Sebastian Andrzej Siewior | 8ee6270 | 2011-10-18 19:13:29 +0200 | [diff] [blame] | 253 | static void dwc3_ep0_status_cmpl(struct usb_ep *ep, struct usb_request *req) | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 254 | { | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 255 | } | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 256 | /* | 
 | 257 |  * ch 9.4.5 | 
 | 258 |  */ | 
| Felipe Balbi | 25b8ff6 | 2011-11-04 12:32:47 +0200 | [diff] [blame] | 259 | static int dwc3_ep0_handle_status(struct dwc3 *dwc, | 
 | 260 | 		struct usb_ctrlrequest *ctrl) | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 261 | { | 
 | 262 | 	struct dwc3_ep		*dep; | 
 | 263 | 	u32			recip; | 
 | 264 | 	u16			usb_status = 0; | 
 | 265 | 	__le16			*response_pkt; | 
 | 266 |  | 
 | 267 | 	recip = ctrl->bRequestType & USB_RECIP_MASK; | 
 | 268 | 	switch (recip) { | 
 | 269 | 	case USB_RECIP_DEVICE: | 
 | 270 | 		/* | 
 | 271 | 		 * We are self-powered. U1/U2/LTM will be set later | 
 | 272 | 		 * once we handle this states. RemoteWakeup is 0 on SS | 
 | 273 | 		 */ | 
 | 274 | 		usb_status |= dwc->is_selfpowered << USB_DEVICE_SELF_POWERED; | 
 | 275 | 		break; | 
 | 276 |  | 
 | 277 | 	case USB_RECIP_INTERFACE: | 
 | 278 | 		/* | 
 | 279 | 		 * Function Remote Wake Capable	D0 | 
 | 280 | 		 * Function Remote Wakeup	D1 | 
 | 281 | 		 */ | 
 | 282 | 		break; | 
 | 283 |  | 
 | 284 | 	case USB_RECIP_ENDPOINT: | 
 | 285 | 		dep = dwc3_wIndex_to_dep(dwc, ctrl->wIndex); | 
 | 286 | 		if (!dep) | 
| Felipe Balbi | 25b8ff6 | 2011-11-04 12:32:47 +0200 | [diff] [blame] | 287 | 			return -EINVAL; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 288 |  | 
 | 289 | 		if (dep->flags & DWC3_EP_STALL) | 
 | 290 | 			usb_status = 1 << USB_ENDPOINT_HALT; | 
 | 291 | 		break; | 
 | 292 | 	default: | 
 | 293 | 		return -EINVAL; | 
 | 294 | 	}; | 
 | 295 |  | 
 | 296 | 	response_pkt = (__le16 *) dwc->setup_buf; | 
 | 297 | 	*response_pkt = cpu_to_le16(usb_status); | 
| Felipe Balbi | e261779 | 2011-11-29 10:35:47 +0200 | [diff] [blame] | 298 |  | 
 | 299 | 	dep = dwc->eps[0]; | 
 | 300 | 	dwc->ep0_usb_req.dep = dep; | 
| Sebastian Andrzej Siewior | e0ce0b0 | 2011-11-25 12:03:46 +0100 | [diff] [blame] | 301 | 	dwc->ep0_usb_req.request.length = sizeof(*response_pkt); | 
| Felipe Balbi | 0fc9a1b | 2011-12-19 11:32:34 +0200 | [diff] [blame] | 302 | 	dwc->ep0_usb_req.request.buf = dwc->setup_buf; | 
| Sebastian Andrzej Siewior | e0ce0b0 | 2011-11-25 12:03:46 +0100 | [diff] [blame] | 303 | 	dwc->ep0_usb_req.request.complete = dwc3_ep0_status_cmpl; | 
| Felipe Balbi | e261779 | 2011-11-29 10:35:47 +0200 | [diff] [blame] | 304 |  | 
 | 305 | 	return __dwc3_gadget_ep0_queue(dep, &dwc->ep0_usb_req); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 306 | } | 
 | 307 |  | 
 | 308 | static int dwc3_ep0_handle_feature(struct dwc3 *dwc, | 
 | 309 | 		struct usb_ctrlrequest *ctrl, int set) | 
 | 310 | { | 
 | 311 | 	struct dwc3_ep		*dep; | 
 | 312 | 	u32			recip; | 
 | 313 | 	u32			wValue; | 
 | 314 | 	u32			wIndex; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 315 | 	int			ret; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 316 |  | 
 | 317 | 	wValue = le16_to_cpu(ctrl->wValue); | 
 | 318 | 	wIndex = le16_to_cpu(ctrl->wIndex); | 
 | 319 | 	recip = ctrl->bRequestType & USB_RECIP_MASK; | 
 | 320 | 	switch (recip) { | 
 | 321 | 	case USB_RECIP_DEVICE: | 
 | 322 |  | 
 | 323 | 		/* | 
 | 324 | 		 * 9.4.1 says only only for SS, in AddressState only for | 
 | 325 | 		 * default control pipe | 
 | 326 | 		 */ | 
 | 327 | 		switch (wValue) { | 
 | 328 | 		case USB_DEVICE_U1_ENABLE: | 
 | 329 | 		case USB_DEVICE_U2_ENABLE: | 
 | 330 | 		case USB_DEVICE_LTM_ENABLE: | 
 | 331 | 			if (dwc->dev_state != DWC3_CONFIGURED_STATE) | 
 | 332 | 				return -EINVAL; | 
 | 333 | 			if (dwc->speed != DWC3_DSTS_SUPERSPEED) | 
 | 334 | 				return -EINVAL; | 
 | 335 | 		} | 
 | 336 |  | 
 | 337 | 		/* XXX add U[12] & LTM */ | 
 | 338 | 		switch (wValue) { | 
 | 339 | 		case USB_DEVICE_REMOTE_WAKEUP: | 
 | 340 | 			break; | 
 | 341 | 		case USB_DEVICE_U1_ENABLE: | 
 | 342 | 			break; | 
 | 343 | 		case USB_DEVICE_U2_ENABLE: | 
 | 344 | 			break; | 
 | 345 | 		case USB_DEVICE_LTM_ENABLE: | 
 | 346 | 			break; | 
 | 347 |  | 
 | 348 | 		case USB_DEVICE_TEST_MODE: | 
 | 349 | 			if ((wIndex & 0xff) != 0) | 
 | 350 | 				return -EINVAL; | 
 | 351 | 			if (!set) | 
 | 352 | 				return -EINVAL; | 
 | 353 |  | 
| Gerard Cauvy | 3b63736 | 2012-02-10 12:21:18 +0200 | [diff] [blame] | 354 | 			dwc->test_mode_nr = wIndex >> 8; | 
 | 355 | 			dwc->test_mode = true; | 
| Gerard Cauvy | ecb0779 | 2012-03-16 16:20:10 +0200 | [diff] [blame] | 356 | 			break; | 
 | 357 | 		default: | 
 | 358 | 			return -EINVAL; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 359 | 		} | 
 | 360 | 		break; | 
 | 361 |  | 
 | 362 | 	case USB_RECIP_INTERFACE: | 
 | 363 | 		switch (wValue) { | 
 | 364 | 		case USB_INTRF_FUNC_SUSPEND: | 
 | 365 | 			if (wIndex & USB_INTRF_FUNC_SUSPEND_LP) | 
 | 366 | 				/* XXX enable Low power suspend */ | 
 | 367 | 				; | 
 | 368 | 			if (wIndex & USB_INTRF_FUNC_SUSPEND_RW) | 
 | 369 | 				/* XXX enable remote wakeup */ | 
 | 370 | 				; | 
 | 371 | 			break; | 
 | 372 | 		default: | 
 | 373 | 			return -EINVAL; | 
 | 374 | 		} | 
 | 375 | 		break; | 
 | 376 |  | 
 | 377 | 	case USB_RECIP_ENDPOINT: | 
 | 378 | 		switch (wValue) { | 
 | 379 | 		case USB_ENDPOINT_HALT: | 
| Paul Zimmerman | 1d04679 | 2012-02-15 18:56:56 -0800 | [diff] [blame] | 380 | 			dep = dwc3_wIndex_to_dep(dwc, wIndex); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 381 | 			if (!dep) | 
 | 382 | 				return -EINVAL; | 
 | 383 | 			ret = __dwc3_gadget_ep_set_halt(dep, set); | 
 | 384 | 			if (ret) | 
 | 385 | 				return -EINVAL; | 
 | 386 | 			break; | 
 | 387 | 		default: | 
 | 388 | 			return -EINVAL; | 
 | 389 | 		} | 
 | 390 | 		break; | 
 | 391 |  | 
 | 392 | 	default: | 
 | 393 | 		return -EINVAL; | 
 | 394 | 	}; | 
 | 395 |  | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 396 | 	return 0; | 
 | 397 | } | 
 | 398 |  | 
 | 399 | static int dwc3_ep0_set_address(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl) | 
 | 400 | { | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 401 | 	u32 addr; | 
 | 402 | 	u32 reg; | 
 | 403 |  | 
 | 404 | 	addr = le16_to_cpu(ctrl->wValue); | 
| Felipe Balbi | f96a6ec | 2011-10-15 21:37:35 +0300 | [diff] [blame] | 405 | 	if (addr > 127) { | 
 | 406 | 		dev_dbg(dwc->dev, "invalid device address %d\n", addr); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 407 | 		return -EINVAL; | 
| Felipe Balbi | f96a6ec | 2011-10-15 21:37:35 +0300 | [diff] [blame] | 408 | 	} | 
 | 409 |  | 
 | 410 | 	if (dwc->dev_state == DWC3_CONFIGURED_STATE) { | 
 | 411 | 		dev_dbg(dwc->dev, "trying to set address when configured\n"); | 
 | 412 | 		return -EINVAL; | 
 | 413 | 	} | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 414 |  | 
| Felipe Balbi | 2646021 | 2011-09-30 10:58:36 +0300 | [diff] [blame] | 415 | 	reg = dwc3_readl(dwc->regs, DWC3_DCFG); | 
 | 416 | 	reg &= ~(DWC3_DCFG_DEVADDR_MASK); | 
 | 417 | 	reg |= DWC3_DCFG_DEVADDR(addr); | 
 | 418 | 	dwc3_writel(dwc->regs, DWC3_DCFG, reg); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 419 |  | 
| Felipe Balbi | 2646021 | 2011-09-30 10:58:36 +0300 | [diff] [blame] | 420 | 	if (addr) | 
 | 421 | 		dwc->dev_state = DWC3_ADDRESS_STATE; | 
 | 422 | 	else | 
 | 423 | 		dwc->dev_state = DWC3_DEFAULT_STATE; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 424 |  | 
| Felipe Balbi | 2646021 | 2011-09-30 10:58:36 +0300 | [diff] [blame] | 425 | 	return 0; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 426 | } | 
 | 427 |  | 
 | 428 | static int dwc3_ep0_delegate_req(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl) | 
 | 429 | { | 
 | 430 | 	int ret; | 
 | 431 |  | 
 | 432 | 	spin_unlock(&dwc->lock); | 
 | 433 | 	ret = dwc->gadget_driver->setup(&dwc->gadget, ctrl); | 
 | 434 | 	spin_lock(&dwc->lock); | 
 | 435 | 	return ret; | 
 | 436 | } | 
 | 437 |  | 
 | 438 | static int dwc3_ep0_set_config(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl) | 
 | 439 | { | 
 | 440 | 	u32 cfg; | 
 | 441 | 	int ret; | 
 | 442 |  | 
| Paul Zimmerman | b23c843 | 2011-09-30 10:58:42 +0300 | [diff] [blame] | 443 | 	dwc->start_config_issued = false; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 444 | 	cfg = le16_to_cpu(ctrl->wValue); | 
 | 445 |  | 
 | 446 | 	switch (dwc->dev_state) { | 
 | 447 | 	case DWC3_DEFAULT_STATE: | 
 | 448 | 		return -EINVAL; | 
 | 449 | 		break; | 
 | 450 |  | 
 | 451 | 	case DWC3_ADDRESS_STATE: | 
 | 452 | 		ret = dwc3_ep0_delegate_req(dwc, ctrl); | 
 | 453 | 		/* if the cfg matches and the cfg is non zero */ | 
| Felipe Balbi | 457e84b | 2012-01-18 18:04:09 +0200 | [diff] [blame] | 454 | 		if (cfg && (!ret || (ret == USB_GADGET_DELAYED_STATUS))) { | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 455 | 			dwc->dev_state = DWC3_CONFIGURED_STATE; | 
| Felipe Balbi | 457e84b | 2012-01-18 18:04:09 +0200 | [diff] [blame] | 456 | 			dwc->resize_fifos = true; | 
 | 457 | 			dev_dbg(dwc->dev, "resize fifos flag SET\n"); | 
 | 458 | 		} | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 459 | 		break; | 
 | 460 |  | 
 | 461 | 	case DWC3_CONFIGURED_STATE: | 
 | 462 | 		ret = dwc3_ep0_delegate_req(dwc, ctrl); | 
 | 463 | 		if (!cfg) | 
 | 464 | 			dwc->dev_state = DWC3_ADDRESS_STATE; | 
 | 465 | 		break; | 
| Sebastian Andrzej Siewior | 5bdb1dc | 2011-11-02 13:30:45 +0100 | [diff] [blame] | 466 | 	default: | 
 | 467 | 		ret = -EINVAL; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 468 | 	} | 
| Sebastian Andrzej Siewior | 5bdb1dc | 2011-11-02 13:30:45 +0100 | [diff] [blame] | 469 | 	return ret; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 470 | } | 
 | 471 |  | 
 | 472 | static int dwc3_ep0_std_request(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl) | 
 | 473 | { | 
 | 474 | 	int ret; | 
 | 475 |  | 
 | 476 | 	switch (ctrl->bRequest) { | 
 | 477 | 	case USB_REQ_GET_STATUS: | 
 | 478 | 		dev_vdbg(dwc->dev, "USB_REQ_GET_STATUS\n"); | 
 | 479 | 		ret = dwc3_ep0_handle_status(dwc, ctrl); | 
 | 480 | 		break; | 
 | 481 | 	case USB_REQ_CLEAR_FEATURE: | 
 | 482 | 		dev_vdbg(dwc->dev, "USB_REQ_CLEAR_FEATURE\n"); | 
 | 483 | 		ret = dwc3_ep0_handle_feature(dwc, ctrl, 0); | 
 | 484 | 		break; | 
 | 485 | 	case USB_REQ_SET_FEATURE: | 
 | 486 | 		dev_vdbg(dwc->dev, "USB_REQ_SET_FEATURE\n"); | 
 | 487 | 		ret = dwc3_ep0_handle_feature(dwc, ctrl, 1); | 
 | 488 | 		break; | 
 | 489 | 	case USB_REQ_SET_ADDRESS: | 
 | 490 | 		dev_vdbg(dwc->dev, "USB_REQ_SET_ADDRESS\n"); | 
 | 491 | 		ret = dwc3_ep0_set_address(dwc, ctrl); | 
 | 492 | 		break; | 
 | 493 | 	case USB_REQ_SET_CONFIGURATION: | 
 | 494 | 		dev_vdbg(dwc->dev, "USB_REQ_SET_CONFIGURATION\n"); | 
 | 495 | 		ret = dwc3_ep0_set_config(dwc, ctrl); | 
 | 496 | 		break; | 
 | 497 | 	default: | 
 | 498 | 		dev_vdbg(dwc->dev, "Forwarding to gadget driver\n"); | 
 | 499 | 		ret = dwc3_ep0_delegate_req(dwc, ctrl); | 
 | 500 | 		break; | 
 | 501 | 	}; | 
 | 502 |  | 
 | 503 | 	return ret; | 
 | 504 | } | 
 | 505 |  | 
 | 506 | static void dwc3_ep0_inspect_setup(struct dwc3 *dwc, | 
 | 507 | 		const struct dwc3_event_depevt *event) | 
 | 508 | { | 
 | 509 | 	struct usb_ctrlrequest *ctrl = dwc->ctrl_req; | 
 | 510 | 	int ret; | 
 | 511 | 	u32 len; | 
 | 512 |  | 
 | 513 | 	if (!dwc->gadget_driver) | 
 | 514 | 		goto err; | 
 | 515 |  | 
 | 516 | 	len = le16_to_cpu(ctrl->wLength); | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 517 | 	if (!len) { | 
| Felipe Balbi | d95b09b | 2011-09-30 10:58:37 +0300 | [diff] [blame] | 518 | 		dwc->three_stage_setup = false; | 
 | 519 | 		dwc->ep0_expect_in = false; | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 520 | 		dwc->ep0_next_event = DWC3_EP0_NRDY_STATUS; | 
 | 521 | 	} else { | 
| Felipe Balbi | d95b09b | 2011-09-30 10:58:37 +0300 | [diff] [blame] | 522 | 		dwc->three_stage_setup = true; | 
 | 523 | 		dwc->ep0_expect_in = !!(ctrl->bRequestType & USB_DIR_IN); | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 524 | 		dwc->ep0_next_event = DWC3_EP0_NRDY_DATA; | 
 | 525 | 	} | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 526 |  | 
 | 527 | 	if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) | 
 | 528 | 		ret = dwc3_ep0_std_request(dwc, ctrl); | 
 | 529 | 	else | 
 | 530 | 		ret = dwc3_ep0_delegate_req(dwc, ctrl); | 
 | 531 |  | 
| Sebastian Andrzej Siewior | 5bdb1dc | 2011-11-02 13:30:45 +0100 | [diff] [blame] | 532 | 	if (ret == USB_GADGET_DELAYED_STATUS) | 
 | 533 | 		dwc->delayed_status = true; | 
 | 534 |  | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 535 | 	if (ret >= 0) | 
 | 536 | 		return; | 
 | 537 |  | 
 | 538 | err: | 
 | 539 | 	dwc3_ep0_stall_and_restart(dwc); | 
 | 540 | } | 
 | 541 |  | 
 | 542 | static void dwc3_ep0_complete_data(struct dwc3 *dwc, | 
 | 543 | 		const struct dwc3_event_depevt *event) | 
 | 544 | { | 
 | 545 | 	struct dwc3_request	*r = NULL; | 
 | 546 | 	struct usb_request	*ur; | 
| Felipe Balbi | f6bafc6 | 2012-02-06 11:04:53 +0200 | [diff] [blame] | 547 | 	struct dwc3_trb		*trb; | 
| Sebastian Andrzej Siewior | c2da2ff | 2011-10-20 19:04:16 +0200 | [diff] [blame] | 548 | 	struct dwc3_ep		*ep0; | 
| Felipe Balbi | c611ccb | 2011-08-27 02:30:33 +0300 | [diff] [blame] | 549 | 	u32			transferred; | 
| Felipe Balbi | f6bafc6 | 2012-02-06 11:04:53 +0200 | [diff] [blame] | 550 | 	u32			length; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 551 | 	u8			epnum; | 
 | 552 |  | 
 | 553 | 	epnum = event->endpoint_number; | 
| Sebastian Andrzej Siewior | c2da2ff | 2011-10-20 19:04:16 +0200 | [diff] [blame] | 554 | 	ep0 = dwc->eps[0]; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 555 |  | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 556 | 	dwc->ep0_next_event = DWC3_EP0_NRDY_STATUS; | 
 | 557 |  | 
| Sebastian Andrzej Siewior | c2da2ff | 2011-10-20 19:04:16 +0200 | [diff] [blame] | 558 | 	r = next_request(&ep0->request_list); | 
| Sebastian Andrzej Siewior | 8ee6270 | 2011-10-18 19:13:29 +0200 | [diff] [blame] | 559 | 	ur = &r->request; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 560 |  | 
| Felipe Balbi | f6bafc6 | 2012-02-06 11:04:53 +0200 | [diff] [blame] | 561 | 	trb = dwc->ep0_trb; | 
 | 562 | 	length = trb->size & DWC3_TRB_SIZE_MASK; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 563 |  | 
| Felipe Balbi | a682970 | 2011-08-27 22:18:09 +0300 | [diff] [blame] | 564 | 	if (dwc->ep0_bounced) { | 
| Moiz Sonasath | 566ccdd | 2012-03-14 00:44:56 -0500 | [diff] [blame] | 565 | 		unsigned transfer_size = ur->length; | 
 | 566 | 		unsigned maxp = ep0->endpoint.maxpacket; | 
 | 567 |  | 
 | 568 | 		transfer_size += (maxp - (transfer_size % maxp)); | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 569 | 		transferred = min_t(u32, ur->length, | 
| Moiz Sonasath | 566ccdd | 2012-03-14 00:44:56 -0500 | [diff] [blame] | 570 | 				transfer_size - length); | 
| Felipe Balbi | a682970 | 2011-08-27 22:18:09 +0300 | [diff] [blame] | 571 | 		memcpy(ur->buf, dwc->ep0_bounce, transferred); | 
 | 572 | 		dwc->ep0_bounced = false; | 
 | 573 | 	} else { | 
| Felipe Balbi | f6bafc6 | 2012-02-06 11:04:53 +0200 | [diff] [blame] | 574 | 		transferred = ur->length - length; | 
| Felipe Balbi | a682970 | 2011-08-27 22:18:09 +0300 | [diff] [blame] | 575 | 	} | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 576 |  | 
| Felipe Balbi | cd423dd | 2012-03-21 11:44:00 +0200 | [diff] [blame] | 577 | 	ur->actual += transferred; | 
 | 578 |  | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 579 | 	if ((epnum & 1) && ur->actual < ur->length) { | 
 | 580 | 		/* for some reason we did not get everything out */ | 
 | 581 |  | 
 | 582 | 		dwc3_ep0_stall_and_restart(dwc); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 583 | 	} else { | 
 | 584 | 		/* | 
 | 585 | 		 * handle the case where we have to send a zero packet. This | 
 | 586 | 		 * seems to be case when req.length > maxpacket. Could it be? | 
 | 587 | 		 */ | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 588 | 		if (r) | 
| Sebastian Andrzej Siewior | c2da2ff | 2011-10-20 19:04:16 +0200 | [diff] [blame] | 589 | 			dwc3_gadget_giveback(ep0, r, 0); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 590 | 	} | 
 | 591 | } | 
 | 592 |  | 
 | 593 | static void dwc3_ep0_complete_req(struct dwc3 *dwc, | 
 | 594 | 		const struct dwc3_event_depevt *event) | 
 | 595 | { | 
 | 596 | 	struct dwc3_request	*r; | 
 | 597 | 	struct dwc3_ep		*dep; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 598 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 599 | 	dep = dwc->eps[0]; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 600 |  | 
 | 601 | 	if (!list_empty(&dep->request_list)) { | 
 | 602 | 		r = next_request(&dep->request_list); | 
 | 603 |  | 
 | 604 | 		dwc3_gadget_giveback(dep, r, 0); | 
 | 605 | 	} | 
 | 606 |  | 
| Gerard Cauvy | 3b63736 | 2012-02-10 12:21:18 +0200 | [diff] [blame] | 607 | 	if (dwc->test_mode) { | 
 | 608 | 		int ret; | 
 | 609 |  | 
 | 610 | 		ret = dwc3_gadget_set_test_mode(dwc, dwc->test_mode_nr); | 
 | 611 | 		if (ret < 0) { | 
 | 612 | 			dev_dbg(dwc->dev, "Invalid Test #%d\n", | 
 | 613 | 					dwc->test_mode_nr); | 
 | 614 | 			dwc3_ep0_stall_and_restart(dwc); | 
 | 615 | 		} | 
 | 616 | 	} | 
 | 617 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 618 | 	dwc->ep0state = EP0_SETUP_PHASE; | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 619 | 	dwc3_ep0_out_start(dwc); | 
 | 620 | } | 
 | 621 |  | 
 | 622 | static void dwc3_ep0_xfer_complete(struct dwc3 *dwc, | 
 | 623 | 			const struct dwc3_event_depevt *event) | 
 | 624 | { | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 625 | 	struct dwc3_ep		*dep = dwc->eps[event->endpoint_number]; | 
 | 626 |  | 
 | 627 | 	dep->flags &= ~DWC3_EP_BUSY; | 
| Paul Zimmerman | c2df85c | 2012-02-24 17:32:18 -0800 | [diff] [blame] | 628 | 	dep->res_trans_idx = 0; | 
| Felipe Balbi | df62df5 | 2011-10-14 15:11:49 +0300 | [diff] [blame] | 629 | 	dwc->setup_packet_pending = false; | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 630 |  | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 631 | 	switch (dwc->ep0state) { | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 632 | 	case EP0_SETUP_PHASE: | 
 | 633 | 		dev_vdbg(dwc->dev, "Inspecting Setup Bytes\n"); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 634 | 		dwc3_ep0_inspect_setup(dwc, event); | 
 | 635 | 		break; | 
 | 636 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 637 | 	case EP0_DATA_PHASE: | 
 | 638 | 		dev_vdbg(dwc->dev, "Data Phase\n"); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 639 | 		dwc3_ep0_complete_data(dwc, event); | 
 | 640 | 		break; | 
 | 641 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 642 | 	case EP0_STATUS_PHASE: | 
 | 643 | 		dev_vdbg(dwc->dev, "Status Phase\n"); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 644 | 		dwc3_ep0_complete_req(dwc, event); | 
 | 645 | 		break; | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 646 | 	default: | 
 | 647 | 		WARN(true, "UNKNOWN ep0state %d\n", dwc->ep0state); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 648 | 	} | 
 | 649 | } | 
 | 650 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 651 | static void dwc3_ep0_do_control_setup(struct dwc3 *dwc, | 
 | 652 | 		const struct dwc3_event_depevt *event) | 
 | 653 | { | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 654 | 	dwc3_ep0_out_start(dwc); | 
 | 655 | } | 
 | 656 |  | 
 | 657 | static void dwc3_ep0_do_control_data(struct dwc3 *dwc, | 
 | 658 | 		const struct dwc3_event_depevt *event) | 
 | 659 | { | 
 | 660 | 	struct dwc3_ep		*dep; | 
 | 661 | 	struct dwc3_request	*req; | 
 | 662 | 	int			ret; | 
 | 663 |  | 
 | 664 | 	dep = dwc->eps[0]; | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 665 |  | 
 | 666 | 	if (list_empty(&dep->request_list)) { | 
 | 667 | 		dev_vdbg(dwc->dev, "pending request for EP0 Data phase\n"); | 
 | 668 | 		dep->flags |= DWC3_EP_PENDING_REQUEST; | 
 | 669 |  | 
 | 670 | 		if (event->endpoint_number) | 
 | 671 | 			dep->flags |= DWC3_EP0_DIR_IN; | 
 | 672 | 		return; | 
 | 673 | 	} | 
 | 674 |  | 
 | 675 | 	req = next_request(&dep->request_list); | 
 | 676 | 	req->direction = !!event->endpoint_number; | 
 | 677 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 678 | 	if (req->request.length == 0) { | 
 | 679 | 		ret = dwc3_ep0_start_trans(dwc, event->endpoint_number, | 
 | 680 | 				dwc->ctrl_req_addr, 0, | 
 | 681 | 				DWC3_TRBCTL_CONTROL_DATA); | 
 | 682 | 	} else if ((req->request.length % dep->endpoint.maxpacket) | 
 | 683 | 			&& (event->endpoint_number == 0)) { | 
| Felipe Balbi | 0fc9a1b | 2011-12-19 11:32:34 +0200 | [diff] [blame] | 684 | 		ret = usb_gadget_map_request(&dwc->gadget, &req->request, | 
 | 685 | 				event->endpoint_number); | 
 | 686 | 		if (ret) { | 
 | 687 | 			dev_dbg(dwc->dev, "failed to map request\n"); | 
 | 688 | 			return; | 
 | 689 | 		} | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 690 |  | 
 | 691 | 		WARN_ON(req->request.length > dep->endpoint.maxpacket); | 
 | 692 |  | 
 | 693 | 		dwc->ep0_bounced = true; | 
 | 694 |  | 
 | 695 | 		/* | 
 | 696 | 		 * REVISIT in case request length is bigger than EP0 | 
 | 697 | 		 * wMaxPacketSize, we will need two chained TRBs to handle | 
 | 698 | 		 * the transfer. | 
 | 699 | 		 */ | 
 | 700 | 		ret = dwc3_ep0_start_trans(dwc, event->endpoint_number, | 
 | 701 | 				dwc->ep0_bounce_addr, dep->endpoint.maxpacket, | 
 | 702 | 				DWC3_TRBCTL_CONTROL_DATA); | 
 | 703 | 	} else { | 
| Felipe Balbi | 0fc9a1b | 2011-12-19 11:32:34 +0200 | [diff] [blame] | 704 | 		ret = usb_gadget_map_request(&dwc->gadget, &req->request, | 
 | 705 | 				event->endpoint_number); | 
 | 706 | 		if (ret) { | 
 | 707 | 			dev_dbg(dwc->dev, "failed to map request\n"); | 
 | 708 | 			return; | 
 | 709 | 		} | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 710 |  | 
 | 711 | 		ret = dwc3_ep0_start_trans(dwc, event->endpoint_number, | 
 | 712 | 				req->request.dma, req->request.length, | 
 | 713 | 				DWC3_TRBCTL_CONTROL_DATA); | 
 | 714 | 	} | 
 | 715 |  | 
 | 716 | 	WARN_ON(ret < 0); | 
 | 717 | } | 
 | 718 |  | 
| Sebastian Andrzej Siewior | f0f2b2a | 2011-11-02 13:30:44 +0100 | [diff] [blame] | 719 | static int dwc3_ep0_start_control_status(struct dwc3_ep *dep) | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 720 | { | 
| Sebastian Andrzej Siewior | f0f2b2a | 2011-11-02 13:30:44 +0100 | [diff] [blame] | 721 | 	struct dwc3		*dwc = dep->dwc; | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 722 | 	u32			type; | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 723 |  | 
 | 724 | 	type = dwc->three_stage_setup ? DWC3_TRBCTL_CONTROL_STATUS3 | 
 | 725 | 		: DWC3_TRBCTL_CONTROL_STATUS2; | 
 | 726 |  | 
| Sebastian Andrzej Siewior | f0f2b2a | 2011-11-02 13:30:44 +0100 | [diff] [blame] | 727 | 	return dwc3_ep0_start_trans(dwc, dep->number, | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 728 | 			dwc->ctrl_req_addr, 0, type); | 
| Sebastian Andrzej Siewior | f0f2b2a | 2011-11-02 13:30:44 +0100 | [diff] [blame] | 729 | } | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 730 |  | 
| Sebastian Andrzej Siewior | f0f2b2a | 2011-11-02 13:30:44 +0100 | [diff] [blame] | 731 | static void dwc3_ep0_do_control_status(struct dwc3 *dwc, u32 epnum) | 
 | 732 | { | 
 | 733 | 	struct dwc3_ep		*dep = dwc->eps[epnum]; | 
 | 734 |  | 
| Felipe Balbi | 457e84b | 2012-01-18 18:04:09 +0200 | [diff] [blame] | 735 | 	if (dwc->resize_fifos) { | 
 | 736 | 		dev_dbg(dwc->dev, "starting to resize fifos\n"); | 
 | 737 | 		dwc3_gadget_resize_tx_fifos(dwc); | 
 | 738 | 		dwc->resize_fifos = 0; | 
 | 739 | 	} | 
 | 740 |  | 
| Sebastian Andrzej Siewior | f0f2b2a | 2011-11-02 13:30:44 +0100 | [diff] [blame] | 741 | 	WARN_ON(dwc3_ep0_start_control_status(dep)); | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 742 | } | 
 | 743 |  | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 744 | static void dwc3_ep0_xfernotready(struct dwc3 *dwc, | 
 | 745 | 		const struct dwc3_event_depevt *event) | 
 | 746 | { | 
| Felipe Balbi | df62df5 | 2011-10-14 15:11:49 +0300 | [diff] [blame] | 747 | 	dwc->setup_packet_pending = true; | 
 | 748 |  | 
| Felipe Balbi | 9cc9bcd | 2011-10-18 18:00:26 +0300 | [diff] [blame] | 749 | 	/* | 
 | 750 | 	 * This part is very tricky: If we has just handled | 
 | 751 | 	 * XferNotReady(Setup) and we're now expecting a | 
 | 752 | 	 * XferComplete but, instead, we receive another | 
 | 753 | 	 * XferNotReady(Setup), we should STALL and restart | 
 | 754 | 	 * the state machine. | 
 | 755 | 	 * | 
 | 756 | 	 * In all other cases, we just continue waiting | 
 | 757 | 	 * for the XferComplete event. | 
 | 758 | 	 * | 
 | 759 | 	 * We are a little bit unsafe here because we're | 
 | 760 | 	 * not trying to ensure that last event was, indeed, | 
 | 761 | 	 * XferNotReady(Setup). | 
 | 762 | 	 * | 
 | 763 | 	 * Still, we don't expect any condition where that | 
 | 764 | 	 * should happen and, even if it does, it would be | 
 | 765 | 	 * another error condition. | 
 | 766 | 	 */ | 
 | 767 | 	if (dwc->ep0_next_event == DWC3_EP0_COMPLETE) { | 
 | 768 | 		switch (event->status) { | 
 | 769 | 		case DEPEVT_STATUS_CONTROL_SETUP: | 
 | 770 | 			dev_vdbg(dwc->dev, "Unexpected XferNotReady(Setup)\n"); | 
 | 771 | 			dwc3_ep0_stall_and_restart(dwc); | 
 | 772 | 			break; | 
 | 773 | 		case DEPEVT_STATUS_CONTROL_DATA: | 
 | 774 | 			/* FALLTHROUGH */ | 
 | 775 | 		case DEPEVT_STATUS_CONTROL_STATUS: | 
 | 776 | 			/* FALLTHROUGH */ | 
 | 777 | 		default: | 
 | 778 | 			dev_vdbg(dwc->dev, "waiting for XferComplete\n"); | 
 | 779 | 		} | 
 | 780 |  | 
 | 781 | 		return; | 
 | 782 | 	} | 
 | 783 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 784 | 	switch (event->status) { | 
 | 785 | 	case DEPEVT_STATUS_CONTROL_SETUP: | 
 | 786 | 		dev_vdbg(dwc->dev, "Control Setup\n"); | 
| Sebastian Andrzej Siewior | f0f2b2a | 2011-11-02 13:30:44 +0100 | [diff] [blame] | 787 |  | 
 | 788 | 		dwc->ep0state = EP0_SETUP_PHASE; | 
 | 789 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 790 | 		dwc3_ep0_do_control_setup(dwc, event); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 791 | 		break; | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 792 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 793 | 	case DEPEVT_STATUS_CONTROL_DATA: | 
 | 794 | 		dev_vdbg(dwc->dev, "Control Data\n"); | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 795 |  | 
| Sebastian Andrzej Siewior | f0f2b2a | 2011-11-02 13:30:44 +0100 | [diff] [blame] | 796 | 		dwc->ep0state = EP0_DATA_PHASE; | 
 | 797 |  | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 798 | 		if (dwc->ep0_next_event != DWC3_EP0_NRDY_DATA) { | 
 | 799 | 			dev_vdbg(dwc->dev, "Expected %d got %d\n", | 
| Felipe Balbi | 25355be | 2011-09-30 10:58:38 +0300 | [diff] [blame] | 800 | 					dwc->ep0_next_event, | 
 | 801 | 					DWC3_EP0_NRDY_DATA); | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 802 |  | 
 | 803 | 			dwc3_ep0_stall_and_restart(dwc); | 
 | 804 | 			return; | 
 | 805 | 		} | 
 | 806 |  | 
| Felipe Balbi | 55f3fba | 2011-09-08 18:27:33 +0300 | [diff] [blame] | 807 | 		/* | 
 | 808 | 		 * One of the possible error cases is when Host _does_ | 
 | 809 | 		 * request for Data Phase, but it does so on the wrong | 
 | 810 | 		 * direction. | 
 | 811 | 		 * | 
 | 812 | 		 * Here, we already know ep0_next_event is DATA (see above), | 
 | 813 | 		 * so we only need to check for direction. | 
 | 814 | 		 */ | 
 | 815 | 		if (dwc->ep0_expect_in != event->endpoint_number) { | 
 | 816 | 			dev_vdbg(dwc->dev, "Wrong direction for Data phase\n"); | 
 | 817 | 			dwc3_ep0_stall_and_restart(dwc); | 
 | 818 | 			return; | 
 | 819 | 		} | 
 | 820 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 821 | 		dwc3_ep0_do_control_data(dwc, event); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 822 | 		break; | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 823 |  | 
| Felipe Balbi | c7fcdeb | 2011-08-27 22:28:36 +0300 | [diff] [blame] | 824 | 	case DEPEVT_STATUS_CONTROL_STATUS: | 
 | 825 | 		dev_vdbg(dwc->dev, "Control Status\n"); | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 826 |  | 
| Sebastian Andrzej Siewior | f0f2b2a | 2011-11-02 13:30:44 +0100 | [diff] [blame] | 827 | 		dwc->ep0state = EP0_STATUS_PHASE; | 
 | 828 |  | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 829 | 		if (dwc->ep0_next_event != DWC3_EP0_NRDY_STATUS) { | 
 | 830 | 			dev_vdbg(dwc->dev, "Expected %d got %d\n", | 
| Felipe Balbi | 25355be | 2011-09-30 10:58:38 +0300 | [diff] [blame] | 831 | 					dwc->ep0_next_event, | 
 | 832 | 					DWC3_EP0_NRDY_STATUS); | 
| Felipe Balbi | 1ddcb21 | 2011-08-30 15:52:17 +0300 | [diff] [blame] | 833 |  | 
 | 834 | 			dwc3_ep0_stall_and_restart(dwc); | 
 | 835 | 			return; | 
 | 836 | 		} | 
| Sebastian Andrzej Siewior | 5bdb1dc | 2011-11-02 13:30:45 +0100 | [diff] [blame] | 837 |  | 
 | 838 | 		if (dwc->delayed_status) { | 
 | 839 | 			WARN_ON_ONCE(event->endpoint_number != 1); | 
 | 840 | 			dev_vdbg(dwc->dev, "Mass Storage delayed status\n"); | 
 | 841 | 			return; | 
 | 842 | 		} | 
 | 843 |  | 
| Sebastian Andrzej Siewior | f0f2b2a | 2011-11-02 13:30:44 +0100 | [diff] [blame] | 844 | 		dwc3_ep0_do_control_status(dwc, event->endpoint_number); | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 845 | 	} | 
 | 846 | } | 
 | 847 |  | 
 | 848 | void dwc3_ep0_interrupt(struct dwc3 *dwc, | 
| Felipe Balbi | 8becf27 | 2011-11-04 12:40:05 +0200 | [diff] [blame] | 849 | 		const struct dwc3_event_depevt *event) | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 850 | { | 
 | 851 | 	u8			epnum = event->endpoint_number; | 
 | 852 |  | 
 | 853 | 	dev_dbg(dwc->dev, "%s while ep%d%s in state '%s'\n", | 
 | 854 | 			dwc3_ep_event_string(event->endpoint_event), | 
| Sebastian Andrzej Siewior | b147f35 | 2011-09-30 10:58:40 +0300 | [diff] [blame] | 855 | 			epnum >> 1, (epnum & 1) ? "in" : "out", | 
| Felipe Balbi | 72246da | 2011-08-19 18:10:58 +0300 | [diff] [blame] | 856 | 			dwc3_ep0_state_string(dwc->ep0state)); | 
 | 857 |  | 
 | 858 | 	switch (event->endpoint_event) { | 
 | 859 | 	case DWC3_DEPEVT_XFERCOMPLETE: | 
 | 860 | 		dwc3_ep0_xfer_complete(dwc, event); | 
 | 861 | 		break; | 
 | 862 |  | 
 | 863 | 	case DWC3_DEPEVT_XFERNOTREADY: | 
 | 864 | 		dwc3_ep0_xfernotready(dwc, event); | 
 | 865 | 		break; | 
 | 866 |  | 
 | 867 | 	case DWC3_DEPEVT_XFERINPROGRESS: | 
 | 868 | 	case DWC3_DEPEVT_RXTXFIFOEVT: | 
 | 869 | 	case DWC3_DEPEVT_STREAMEVT: | 
 | 870 | 	case DWC3_DEPEVT_EPCMDCMPLT: | 
 | 871 | 		break; | 
 | 872 | 	} | 
 | 873 | } |