blob: 7e465ea6a2117df9da25fceb0253f76e74613961 [file] [log] [blame]
Felipe Balbi72246da2011-08-19 18:10:58 +03001/**
2 * gadget.c - DesignWare USB3 DRD Controller Gadget Framework Link
3 *
4 * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com
Felipe Balbi72246da2011-08-19 18:10:58 +03005 *
6 * Authors: Felipe Balbi <balbi@ti.com>,
7 * Sebastian Andrzej Siewior <bigeasy@linutronix.de>
8 *
Felipe Balbi5945f782013-06-30 14:15:11 +03009 * This program is free software: you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 of
11 * the License as published by the Free Software Foundation.
Felipe Balbi72246da2011-08-19 18:10:58 +030012 *
Felipe Balbi5945f782013-06-30 14:15:11 +030013 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
Felipe Balbi72246da2011-08-19 18:10:58 +030017 */
18
19#include <linux/kernel.h>
20#include <linux/delay.h>
21#include <linux/slab.h>
22#include <linux/spinlock.h>
23#include <linux/platform_device.h>
24#include <linux/pm_runtime.h>
25#include <linux/interrupt.h>
26#include <linux/io.h>
27#include <linux/list.h>
28#include <linux/dma-mapping.h>
29
30#include <linux/usb/ch9.h>
31#include <linux/usb/gadget.h>
32
Felipe Balbi80977dc2014-08-19 16:37:22 -050033#include "debug.h"
Felipe Balbi72246da2011-08-19 18:10:58 +030034#include "core.h"
35#include "gadget.h"
36#include "io.h"
37
Felipe Balbi04a9bfc2012-01-02 18:25:43 +020038/**
39 * dwc3_gadget_set_test_mode - Enables USB2 Test Modes
40 * @dwc: pointer to our context structure
41 * @mode: the mode to set (J, K SE0 NAK, Force Enable)
42 *
43 * Caller should take care of locking. This function will
44 * return 0 on success or -EINVAL if wrong Test Selector
45 * is passed
46 */
47int dwc3_gadget_set_test_mode(struct dwc3 *dwc, int mode)
48{
49 u32 reg;
50
51 reg = dwc3_readl(dwc->regs, DWC3_DCTL);
52 reg &= ~DWC3_DCTL_TSTCTRL_MASK;
53
54 switch (mode) {
55 case TEST_J:
56 case TEST_K:
57 case TEST_SE0_NAK:
58 case TEST_PACKET:
59 case TEST_FORCE_EN:
60 reg |= mode << 1;
61 break;
62 default:
63 return -EINVAL;
64 }
65
66 dwc3_writel(dwc->regs, DWC3_DCTL, reg);
67
68 return 0;
69}
70
Felipe Balbi8598bde2012-01-02 18:55:57 +020071/**
Paul Zimmerman911f1f82012-04-27 13:35:15 +030072 * dwc3_gadget_get_link_state - Gets current state of USB Link
73 * @dwc: pointer to our context structure
74 *
75 * Caller should take care of locking. This function will
76 * return the link state on success (>= 0) or -ETIMEDOUT.
77 */
78int dwc3_gadget_get_link_state(struct dwc3 *dwc)
79{
80 u32 reg;
81
82 reg = dwc3_readl(dwc->regs, DWC3_DSTS);
83
84 return DWC3_DSTS_USBLNKST(reg);
85}
86
87/**
Felipe Balbi8598bde2012-01-02 18:55:57 +020088 * dwc3_gadget_set_link_state - Sets USB Link to a particular State
89 * @dwc: pointer to our context structure
90 * @state: the state to put link into
91 *
92 * Caller should take care of locking. This function will
Paul Zimmermanaee63e32012-02-24 17:32:15 -080093 * return 0 on success or -ETIMEDOUT.
Felipe Balbi8598bde2012-01-02 18:55:57 +020094 */
95int dwc3_gadget_set_link_state(struct dwc3 *dwc, enum dwc3_link_state state)
96{
Paul Zimmermanaee63e32012-02-24 17:32:15 -080097 int retries = 10000;
Felipe Balbi8598bde2012-01-02 18:55:57 +020098 u32 reg;
99
Paul Zimmerman802fde92012-04-27 13:10:52 +0300100 /*
101 * Wait until device controller is ready. Only applies to 1.94a and
102 * later RTL.
103 */
104 if (dwc->revision >= DWC3_REVISION_194A) {
105 while (--retries) {
106 reg = dwc3_readl(dwc->regs, DWC3_DSTS);
107 if (reg & DWC3_DSTS_DCNRD)
108 udelay(5);
109 else
110 break;
111 }
112
113 if (retries <= 0)
114 return -ETIMEDOUT;
115 }
116
Felipe Balbi8598bde2012-01-02 18:55:57 +0200117 reg = dwc3_readl(dwc->regs, DWC3_DCTL);
118 reg &= ~DWC3_DCTL_ULSTCHNGREQ_MASK;
119
120 /* set requested state */
121 reg |= DWC3_DCTL_ULSTCHNGREQ(state);
122 dwc3_writel(dwc->regs, DWC3_DCTL, reg);
123
Paul Zimmerman802fde92012-04-27 13:10:52 +0300124 /*
125 * The following code is racy when called from dwc3_gadget_wakeup,
126 * and is not needed, at least on newer versions
127 */
128 if (dwc->revision >= DWC3_REVISION_194A)
129 return 0;
130
Felipe Balbi8598bde2012-01-02 18:55:57 +0200131 /* wait for a change in DSTS */
Paul Zimmermanaed430e2012-04-27 12:52:01 +0300132 retries = 10000;
Felipe Balbi8598bde2012-01-02 18:55:57 +0200133 while (--retries) {
134 reg = dwc3_readl(dwc->regs, DWC3_DSTS);
135
Felipe Balbi8598bde2012-01-02 18:55:57 +0200136 if (DWC3_DSTS_USBLNKST(reg) == state)
137 return 0;
138
Paul Zimmermanaee63e32012-02-24 17:32:15 -0800139 udelay(5);
Felipe Balbi8598bde2012-01-02 18:55:57 +0200140 }
141
Felipe Balbi8598bde2012-01-02 18:55:57 +0200142 return -ETIMEDOUT;
143}
144
John Youndca01192016-05-19 17:26:05 -0700145/**
146 * dwc3_ep_inc_trb() - Increment a TRB index.
147 * @index - Pointer to the TRB index to increment.
148 *
149 * The index should never point to the link TRB. After incrementing,
150 * if it is point to the link TRB, wrap around to the beginning. The
151 * link TRB is always at the last TRB entry.
152 */
153static void dwc3_ep_inc_trb(u8 *index)
154{
155 (*index)++;
156 if (*index == (DWC3_TRB_NUM - 1))
157 *index = 0;
158}
159
Felipe Balbief966b92016-04-05 13:09:51 +0300160static void dwc3_ep_inc_enq(struct dwc3_ep *dep)
Felipe Balbi457e84b2012-01-18 18:04:09 +0200161{
John Youndca01192016-05-19 17:26:05 -0700162 dwc3_ep_inc_trb(&dep->trb_enqueue);
Felipe Balbief966b92016-04-05 13:09:51 +0300163}
Felipe Balbi457e84b2012-01-18 18:04:09 +0200164
Felipe Balbief966b92016-04-05 13:09:51 +0300165static void dwc3_ep_inc_deq(struct dwc3_ep *dep)
166{
John Youndca01192016-05-19 17:26:05 -0700167 dwc3_ep_inc_trb(&dep->trb_dequeue);
Felipe Balbi457e84b2012-01-18 18:04:09 +0200168}
169
Felipe Balbi72246da2011-08-19 18:10:58 +0300170void dwc3_gadget_giveback(struct dwc3_ep *dep, struct dwc3_request *req,
171 int status)
172{
173 struct dwc3 *dwc = dep->dwc;
174
Felipe Balbi737f1ae2016-08-11 12:24:27 +0300175 req->started = false;
Felipe Balbi72246da2011-08-19 18:10:58 +0300176 list_del(&req->list);
Felipe Balbieeb720f2011-11-28 12:46:59 +0200177 req->trb = NULL;
Felipe Balbie62c5bc52016-10-25 13:47:21 +0300178 req->remaining = 0;
Felipe Balbi72246da2011-08-19 18:10:58 +0300179
180 if (req->request.status == -EINPROGRESS)
181 req->request.status = status;
182
Pratyush Anand0416e492012-08-10 13:42:16 +0530183 if (dwc->ep0_bounced && dep->number == 0)
184 dwc->ep0_bounced = false;
185 else
186 usb_gadget_unmap_request(&dwc->gadget, &req->request,
187 req->direction);
Felipe Balbi72246da2011-08-19 18:10:58 +0300188
Felipe Balbi2c4cbe6e52014-04-30 17:45:10 -0500189 trace_dwc3_gadget_giveback(req);
Felipe Balbi72246da2011-08-19 18:10:58 +0300190
191 spin_unlock(&dwc->lock);
Michal Sojka304f7e52014-09-24 22:43:19 +0200192 usb_gadget_giveback_request(&dep->endpoint, &req->request);
Felipe Balbi72246da2011-08-19 18:10:58 +0300193 spin_lock(&dwc->lock);
Felipe Balbifc8bb912016-05-16 13:14:48 +0300194
195 if (dep->number > 1)
196 pm_runtime_put(dwc->dev);
Felipe Balbi72246da2011-08-19 18:10:58 +0300197}
198
Felipe Balbi3ece0ec2014-09-05 09:47:44 -0500199int dwc3_send_gadget_generic_command(struct dwc3 *dwc, unsigned cmd, u32 param)
Felipe Balbib09bb642012-04-24 16:19:11 +0300200{
201 u32 timeout = 500;
Felipe Balbi71f7e702016-05-23 14:16:19 +0300202 int status = 0;
Felipe Balbi0fe886c2016-05-23 14:06:07 +0300203 int ret = 0;
Felipe Balbib09bb642012-04-24 16:19:11 +0300204 u32 reg;
205
206 dwc3_writel(dwc->regs, DWC3_DGCMDPAR, param);
207 dwc3_writel(dwc->regs, DWC3_DGCMD, cmd | DWC3_DGCMD_CMDACT);
208
209 do {
210 reg = dwc3_readl(dwc->regs, DWC3_DGCMD);
211 if (!(reg & DWC3_DGCMD_CMDACT)) {
Felipe Balbi71f7e702016-05-23 14:16:19 +0300212 status = DWC3_DGCMD_STATUS(reg);
213 if (status)
Felipe Balbi0fe886c2016-05-23 14:06:07 +0300214 ret = -EINVAL;
215 break;
Felipe Balbib09bb642012-04-24 16:19:11 +0300216 }
Janusz Dziedzice3aee482016-11-09 11:01:33 +0100217 } while (--timeout);
Felipe Balbi0fe886c2016-05-23 14:06:07 +0300218
219 if (!timeout) {
Felipe Balbi0fe886c2016-05-23 14:06:07 +0300220 ret = -ETIMEDOUT;
Felipe Balbi71f7e702016-05-23 14:16:19 +0300221 status = -ETIMEDOUT;
Felipe Balbi0fe886c2016-05-23 14:06:07 +0300222 }
223
Felipe Balbi71f7e702016-05-23 14:16:19 +0300224 trace_dwc3_gadget_generic_cmd(cmd, param, status);
225
Felipe Balbi0fe886c2016-05-23 14:06:07 +0300226 return ret;
Felipe Balbib09bb642012-04-24 16:19:11 +0300227}
228
Felipe Balbic36d8e92016-04-04 12:46:33 +0300229static int __dwc3_gadget_wakeup(struct dwc3 *dwc);
230
Felipe Balbi2cd47182016-04-12 16:42:43 +0300231int dwc3_send_gadget_ep_cmd(struct dwc3_ep *dep, unsigned cmd,
232 struct dwc3_gadget_ep_cmd_params *params)
Felipe Balbi72246da2011-08-19 18:10:58 +0300233{
Felipe Balbi8897a762016-09-22 10:56:08 +0300234 const struct usb_endpoint_descriptor *desc = dep->endpoint.desc;
Felipe Balbi2cd47182016-04-12 16:42:43 +0300235 struct dwc3 *dwc = dep->dwc;
Sebastian Andrzej Siewior61d58242011-08-29 16:46:38 +0200236 u32 timeout = 500;
Felipe Balbi72246da2011-08-19 18:10:58 +0300237 u32 reg;
238
Felipe Balbi0933df12016-05-23 14:02:33 +0300239 int cmd_status = 0;
Felipe Balbi2b0f11d2016-04-04 09:19:17 +0300240 int susphy = false;
Felipe Balbic0ca3242016-04-04 09:11:51 +0300241 int ret = -EINVAL;
Felipe Balbi72246da2011-08-19 18:10:58 +0300242
Felipe Balbi2b0f11d2016-04-04 09:19:17 +0300243 /*
244 * Synopsys Databook 2.60a states, on section 6.3.2.5.[1-8], that if
245 * we're issuing an endpoint command, we must check if
246 * GUSB2PHYCFG.SUSPHY bit is set. If it is, then we need to clear it.
247 *
248 * We will also set SUSPHY bit to what it was before returning as stated
249 * by the same section on Synopsys databook.
250 */
Felipe Balbiab2a92e2016-05-17 14:55:58 +0300251 if (dwc->gadget.speed <= USB_SPEED_HIGH) {
252 reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0));
253 if (unlikely(reg & DWC3_GUSB2PHYCFG_SUSPHY)) {
254 susphy = true;
255 reg &= ~DWC3_GUSB2PHYCFG_SUSPHY;
256 dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg);
257 }
Felipe Balbi2b0f11d2016-04-04 09:19:17 +0300258 }
259
Felipe Balbi59999142016-09-22 12:25:28 +0300260 if (DWC3_DEPCMD_CMD(cmd) == DWC3_DEPCMD_STARTTRANSFER) {
Felipe Balbic36d8e92016-04-04 12:46:33 +0300261 int needs_wakeup;
262
263 needs_wakeup = (dwc->link_state == DWC3_LINK_STATE_U1 ||
264 dwc->link_state == DWC3_LINK_STATE_U2 ||
265 dwc->link_state == DWC3_LINK_STATE_U3);
266
267 if (unlikely(needs_wakeup)) {
268 ret = __dwc3_gadget_wakeup(dwc);
269 dev_WARN_ONCE(dwc->dev, ret, "wakeup failed --> %d\n",
270 ret);
271 }
272 }
273
Felipe Balbi2eb88012016-04-12 16:53:39 +0300274 dwc3_writel(dep->regs, DWC3_DEPCMDPAR0, params->param0);
275 dwc3_writel(dep->regs, DWC3_DEPCMDPAR1, params->param1);
276 dwc3_writel(dep->regs, DWC3_DEPCMDPAR2, params->param2);
Felipe Balbi72246da2011-08-19 18:10:58 +0300277
Felipe Balbi8897a762016-09-22 10:56:08 +0300278 /*
279 * Synopsys Databook 2.60a states in section 6.3.2.5.6 of that if we're
280 * not relying on XferNotReady, we can make use of a special "No
281 * Response Update Transfer" command where we should clear both CmdAct
282 * and CmdIOC bits.
283 *
284 * With this, we don't need to wait for command completion and can
285 * straight away issue further commands to the endpoint.
286 *
287 * NOTICE: We're making an assumption that control endpoints will never
288 * make use of Update Transfer command. This is a safe assumption
289 * because we can never have more than one request at a time with
290 * Control Endpoints. If anybody changes that assumption, this chunk
291 * needs to be updated accordingly.
292 */
293 if (DWC3_DEPCMD_CMD(cmd) == DWC3_DEPCMD_UPDATETRANSFER &&
294 !usb_endpoint_xfer_isoc(desc))
295 cmd &= ~(DWC3_DEPCMD_CMDIOC | DWC3_DEPCMD_CMDACT);
296 else
297 cmd |= DWC3_DEPCMD_CMDACT;
298
299 dwc3_writel(dep->regs, DWC3_DEPCMD, cmd);
Felipe Balbi72246da2011-08-19 18:10:58 +0300300 do {
Felipe Balbi2eb88012016-04-12 16:53:39 +0300301 reg = dwc3_readl(dep->regs, DWC3_DEPCMD);
Felipe Balbi72246da2011-08-19 18:10:58 +0300302 if (!(reg & DWC3_DEPCMD_CMDACT)) {
Felipe Balbi0933df12016-05-23 14:02:33 +0300303 cmd_status = DWC3_DEPCMD_STATUS(reg);
Konrad Leszczynski7b9cc7a2016-02-12 15:21:46 +0000304
Konrad Leszczynski7b9cc7a2016-02-12 15:21:46 +0000305 switch (cmd_status) {
306 case 0:
307 ret = 0;
Felipe Balbic0ca3242016-04-04 09:11:51 +0300308 break;
Konrad Leszczynski7b9cc7a2016-02-12 15:21:46 +0000309 case DEPEVT_TRANSFER_NO_RESOURCE:
Konrad Leszczynski7b9cc7a2016-02-12 15:21:46 +0000310 ret = -EINVAL;
311 break;
312 case DEPEVT_TRANSFER_BUS_EXPIRY:
313 /*
314 * SW issues START TRANSFER command to
315 * isochronous ep with future frame interval. If
316 * future interval time has already passed when
317 * core receives the command, it will respond
318 * with an error status of 'Bus Expiry'.
319 *
320 * Instead of always returning -EINVAL, let's
321 * give a hint to the gadget driver that this is
322 * the case by returning -EAGAIN.
323 */
Konrad Leszczynski7b9cc7a2016-02-12 15:21:46 +0000324 ret = -EAGAIN;
325 break;
326 default:
327 dev_WARN(dwc->dev, "UNKNOWN cmd status\n");
328 }
329
Felipe Balbic0ca3242016-04-04 09:11:51 +0300330 break;
Felipe Balbi72246da2011-08-19 18:10:58 +0300331 }
Felipe Balbif6bb2252016-05-23 13:53:34 +0300332 } while (--timeout);
Felipe Balbi72246da2011-08-19 18:10:58 +0300333
Felipe Balbif6bb2252016-05-23 13:53:34 +0300334 if (timeout == 0) {
Felipe Balbif6bb2252016-05-23 13:53:34 +0300335 ret = -ETIMEDOUT;
Felipe Balbi0933df12016-05-23 14:02:33 +0300336 cmd_status = -ETIMEDOUT;
Felipe Balbif6bb2252016-05-23 13:53:34 +0300337 }
Felipe Balbic0ca3242016-04-04 09:11:51 +0300338
Felipe Balbi0933df12016-05-23 14:02:33 +0300339 trace_dwc3_gadget_ep_cmd(dep, cmd, params, cmd_status);
340
Felipe Balbi6cb2e4e2016-10-21 13:07:09 +0300341 if (ret == 0) {
342 switch (DWC3_DEPCMD_CMD(cmd)) {
343 case DWC3_DEPCMD_STARTTRANSFER:
344 dep->flags |= DWC3_EP_TRANSFER_STARTED;
345 break;
346 case DWC3_DEPCMD_ENDTRANSFER:
347 dep->flags &= ~DWC3_EP_TRANSFER_STARTED;
348 break;
349 default:
350 /* nothing */
351 break;
352 }
353 }
354
Felipe Balbi2b0f11d2016-04-04 09:19:17 +0300355 if (unlikely(susphy)) {
356 reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0));
357 reg |= DWC3_GUSB2PHYCFG_SUSPHY;
358 dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg);
359 }
360
Felipe Balbic0ca3242016-04-04 09:11:51 +0300361 return ret;
Felipe Balbi72246da2011-08-19 18:10:58 +0300362}
363
John Youn50c763f2016-05-31 17:49:56 -0700364static int dwc3_send_clear_stall_ep_cmd(struct dwc3_ep *dep)
365{
366 struct dwc3 *dwc = dep->dwc;
367 struct dwc3_gadget_ep_cmd_params params;
368 u32 cmd = DWC3_DEPCMD_CLEARSTALL;
369
370 /*
371 * As of core revision 2.60a the recommended programming model
372 * is to set the ClearPendIN bit when issuing a Clear Stall EP
373 * command for IN endpoints. This is to prevent an issue where
374 * some (non-compliant) hosts may not send ACK TPs for pending
375 * IN transfers due to a mishandled error condition. Synopsys
376 * STAR 9000614252.
377 */
Lu Baolu5e6c88d2016-09-09 12:51:27 +0800378 if (dep->direction && (dwc->revision >= DWC3_REVISION_260A) &&
379 (dwc->gadget.speed >= USB_SPEED_SUPER))
John Youn50c763f2016-05-31 17:49:56 -0700380 cmd |= DWC3_DEPCMD_CLEARPENDIN;
381
382 memset(&params, 0, sizeof(params));
383
Felipe Balbi2cd47182016-04-12 16:42:43 +0300384 return dwc3_send_gadget_ep_cmd(dep, cmd, &params);
John Youn50c763f2016-05-31 17:49:56 -0700385}
386
Felipe Balbi72246da2011-08-19 18:10:58 +0300387static dma_addr_t dwc3_trb_dma_offset(struct dwc3_ep *dep,
Felipe Balbif6bafc62012-02-06 11:04:53 +0200388 struct dwc3_trb *trb)
Felipe Balbi72246da2011-08-19 18:10:58 +0300389{
Paul Zimmermanc439ef82011-09-30 10:58:45 +0300390 u32 offset = (char *) trb - (char *) dep->trb_pool;
Felipe Balbi72246da2011-08-19 18:10:58 +0300391
392 return dep->trb_pool_dma + offset;
393}
394
395static int dwc3_alloc_trb_pool(struct dwc3_ep *dep)
396{
397 struct dwc3 *dwc = dep->dwc;
398
399 if (dep->trb_pool)
400 return 0;
401
Felipe Balbi72246da2011-08-19 18:10:58 +0300402 dep->trb_pool = dma_alloc_coherent(dwc->dev,
403 sizeof(struct dwc3_trb) * DWC3_TRB_NUM,
404 &dep->trb_pool_dma, GFP_KERNEL);
405 if (!dep->trb_pool) {
406 dev_err(dep->dwc->dev, "failed to allocate trb pool for %s\n",
407 dep->name);
408 return -ENOMEM;
409 }
410
411 return 0;
412}
413
414static void dwc3_free_trb_pool(struct dwc3_ep *dep)
415{
416 struct dwc3 *dwc = dep->dwc;
417
418 dma_free_coherent(dwc->dev, sizeof(struct dwc3_trb) * DWC3_TRB_NUM,
419 dep->trb_pool, dep->trb_pool_dma);
420
421 dep->trb_pool = NULL;
422 dep->trb_pool_dma = 0;
423}
424
John Younc4509602016-02-16 20:10:53 -0800425static int dwc3_gadget_set_xfer_resource(struct dwc3 *dwc, struct dwc3_ep *dep);
426
427/**
428 * dwc3_gadget_start_config - Configure EP resources
429 * @dwc: pointer to our controller context structure
430 * @dep: endpoint that is being enabled
431 *
432 * The assignment of transfer resources cannot perfectly follow the
433 * data book due to the fact that the controller driver does not have
434 * all knowledge of the configuration in advance. It is given this
435 * information piecemeal by the composite gadget framework after every
436 * SET_CONFIGURATION and SET_INTERFACE. Trying to follow the databook
437 * programming model in this scenario can cause errors. For two
438 * reasons:
439 *
440 * 1) The databook says to do DEPSTARTCFG for every SET_CONFIGURATION
441 * and SET_INTERFACE (8.1.5). This is incorrect in the scenario of
442 * multiple interfaces.
443 *
444 * 2) The databook does not mention doing more DEPXFERCFG for new
445 * endpoint on alt setting (8.1.6).
446 *
447 * The following simplified method is used instead:
448 *
449 * All hardware endpoints can be assigned a transfer resource and this
450 * setting will stay persistent until either a core reset or
451 * hibernation. So whenever we do a DEPSTARTCFG(0) we can go ahead and
452 * do DEPXFERCFG for every hardware endpoint as well. We are
453 * guaranteed that there are as many transfer resources as endpoints.
454 *
455 * This function is called for each endpoint when it is being enabled
456 * but is triggered only when called for EP0-out, which always happens
457 * first, and which should only happen in one of the above conditions.
458 */
Felipe Balbi72246da2011-08-19 18:10:58 +0300459static int dwc3_gadget_start_config(struct dwc3 *dwc, struct dwc3_ep *dep)
460{
461 struct dwc3_gadget_ep_cmd_params params;
462 u32 cmd;
John Younc4509602016-02-16 20:10:53 -0800463 int i;
464 int ret;
465
466 if (dep->number)
467 return 0;
Felipe Balbi72246da2011-08-19 18:10:58 +0300468
469 memset(&params, 0x00, sizeof(params));
John Younc4509602016-02-16 20:10:53 -0800470 cmd = DWC3_DEPCMD_DEPSTARTCFG;
Felipe Balbi72246da2011-08-19 18:10:58 +0300471
Felipe Balbi2cd47182016-04-12 16:42:43 +0300472 ret = dwc3_send_gadget_ep_cmd(dep, cmd, &params);
John Younc4509602016-02-16 20:10:53 -0800473 if (ret)
474 return ret;
Felipe Balbi72246da2011-08-19 18:10:58 +0300475
John Younc4509602016-02-16 20:10:53 -0800476 for (i = 0; i < DWC3_ENDPOINTS_NUM; i++) {
477 struct dwc3_ep *dep = dwc->eps[i];
478
479 if (!dep)
480 continue;
481
482 ret = dwc3_gadget_set_xfer_resource(dwc, dep);
483 if (ret)
484 return ret;
Felipe Balbi72246da2011-08-19 18:10:58 +0300485 }
486
487 return 0;
488}
489
490static int dwc3_gadget_set_ep_config(struct dwc3 *dwc, struct dwc3_ep *dep,
Felipe Balbic90bfae2011-11-29 13:11:21 +0200491 const struct usb_endpoint_descriptor *desc,
Felipe Balbi4b345c92012-07-16 14:08:16 +0300492 const struct usb_ss_ep_comp_descriptor *comp_desc,
Felipe Balbi21e64bf2016-06-02 12:37:31 +0300493 bool modify, bool restore)
Felipe Balbi72246da2011-08-19 18:10:58 +0300494{
495 struct dwc3_gadget_ep_cmd_params params;
496
Felipe Balbi21e64bf2016-06-02 12:37:31 +0300497 if (dev_WARN_ONCE(dwc->dev, modify && restore,
498 "Can't modify and restore\n"))
499 return -EINVAL;
500
Felipe Balbi72246da2011-08-19 18:10:58 +0300501 memset(&params, 0x00, sizeof(params));
502
Felipe Balbidc1c70a2011-09-30 10:58:51 +0300503 params.param0 = DWC3_DEPCFG_EP_TYPE(usb_endpoint_type(desc))
Chanho Parkd2e9a132012-08-31 16:54:07 +0900504 | DWC3_DEPCFG_MAX_PACKET_SIZE(usb_endpoint_maxp(desc));
505
506 /* Burst size is only needed in SuperSpeed mode */
John Younee5cd412016-02-05 17:08:45 -0800507 if (dwc->gadget.speed >= USB_SPEED_SUPER) {
Felipe Balbi676e3492016-04-26 10:49:07 +0300508 u32 burst = dep->endpoint.maxburst;
Felipe Balbi676e3492016-04-26 10:49:07 +0300509 params.param0 |= DWC3_DEPCFG_BURST_SIZE(burst - 1);
Chanho Parkd2e9a132012-08-31 16:54:07 +0900510 }
Felipe Balbi72246da2011-08-19 18:10:58 +0300511
Felipe Balbi21e64bf2016-06-02 12:37:31 +0300512 if (modify) {
513 params.param0 |= DWC3_DEPCFG_ACTION_MODIFY;
514 } else if (restore) {
Paul Zimmerman265b70a2013-12-19 12:38:49 -0600515 params.param0 |= DWC3_DEPCFG_ACTION_RESTORE;
516 params.param2 |= dep->saved_state;
Felipe Balbi21e64bf2016-06-02 12:37:31 +0300517 } else {
518 params.param0 |= DWC3_DEPCFG_ACTION_INIT;
Paul Zimmerman265b70a2013-12-19 12:38:49 -0600519 }
520
Felipe Balbi4bc48c92016-08-10 16:04:33 +0300521 if (usb_endpoint_xfer_control(desc))
522 params.param1 = DWC3_DEPCFG_XFER_COMPLETE_EN;
Felipe Balbi13fa2e62016-05-30 13:40:00 +0300523
524 if (dep->number <= 1 || usb_endpoint_xfer_isoc(desc))
525 params.param1 |= DWC3_DEPCFG_XFER_NOT_READY_EN;
Felipe Balbi72246da2011-08-19 18:10:58 +0300526
Felipe Balbi18b7ede2012-01-02 13:35:41 +0200527 if (usb_ss_max_streams(comp_desc) && usb_endpoint_xfer_bulk(desc)) {
Felipe Balbidc1c70a2011-09-30 10:58:51 +0300528 params.param1 |= DWC3_DEPCFG_STREAM_CAPABLE
529 | DWC3_DEPCFG_STREAM_EVENT_EN;
Felipe Balbi879631a2011-09-30 10:58:47 +0300530 dep->stream_capable = true;
531 }
532
Felipe Balbi0b93a4c2014-09-04 10:28:10 -0500533 if (!usb_endpoint_xfer_control(desc))
Felipe Balbidc1c70a2011-09-30 10:58:51 +0300534 params.param1 |= DWC3_DEPCFG_XFER_IN_PROGRESS_EN;
Felipe Balbi72246da2011-08-19 18:10:58 +0300535
536 /*
537 * We are doing 1:1 mapping for endpoints, meaning
538 * Physical Endpoints 2 maps to Logical Endpoint 2 and
539 * so on. We consider the direction bit as part of the physical
540 * endpoint number. So USB endpoint 0x81 is 0x03.
541 */
Felipe Balbidc1c70a2011-09-30 10:58:51 +0300542 params.param1 |= DWC3_DEPCFG_EP_NUMBER(dep->number);
Felipe Balbi72246da2011-08-19 18:10:58 +0300543
544 /*
545 * We must use the lower 16 TX FIFOs even though
546 * HW might have more
547 */
548 if (dep->direction)
Felipe Balbidc1c70a2011-09-30 10:58:51 +0300549 params.param0 |= DWC3_DEPCFG_FIFO_NUMBER(dep->number >> 1);
Felipe Balbi72246da2011-08-19 18:10:58 +0300550
551 if (desc->bInterval) {
Felipe Balbidc1c70a2011-09-30 10:58:51 +0300552 params.param1 |= DWC3_DEPCFG_BINTERVAL_M1(desc->bInterval - 1);
Felipe Balbi72246da2011-08-19 18:10:58 +0300553 dep->interval = 1 << (desc->bInterval - 1);
554 }
555
Felipe Balbi2cd47182016-04-12 16:42:43 +0300556 return dwc3_send_gadget_ep_cmd(dep, DWC3_DEPCMD_SETEPCONFIG, &params);
Felipe Balbi72246da2011-08-19 18:10:58 +0300557}
558
559static int dwc3_gadget_set_xfer_resource(struct dwc3 *dwc, struct dwc3_ep *dep)
560{
561 struct dwc3_gadget_ep_cmd_params params;
562
563 memset(&params, 0x00, sizeof(params));
564
Felipe Balbidc1c70a2011-09-30 10:58:51 +0300565 params.param0 = DWC3_DEPXFERCFG_NUM_XFER_RES(1);
Felipe Balbi72246da2011-08-19 18:10:58 +0300566
Felipe Balbi2cd47182016-04-12 16:42:43 +0300567 return dwc3_send_gadget_ep_cmd(dep, DWC3_DEPCMD_SETTRANSFRESOURCE,
568 &params);
Felipe Balbi72246da2011-08-19 18:10:58 +0300569}
570
571/**
572 * __dwc3_gadget_ep_enable - Initializes a HW endpoint
573 * @dep: endpoint to be initialized
574 * @desc: USB Endpoint Descriptor
575 *
576 * Caller should take care of locking
577 */
578static int __dwc3_gadget_ep_enable(struct dwc3_ep *dep,
Felipe Balbic90bfae2011-11-29 13:11:21 +0200579 const struct usb_endpoint_descriptor *desc,
Felipe Balbi4b345c92012-07-16 14:08:16 +0300580 const struct usb_ss_ep_comp_descriptor *comp_desc,
Felipe Balbi21e64bf2016-06-02 12:37:31 +0300581 bool modify, bool restore)
Felipe Balbi72246da2011-08-19 18:10:58 +0300582{
583 struct dwc3 *dwc = dep->dwc;
584 u32 reg;
Andy Shevchenkob09e99e2014-05-15 15:53:32 +0300585 int ret;
Felipe Balbi72246da2011-08-19 18:10:58 +0300586
587 if (!(dep->flags & DWC3_EP_ENABLED)) {
588 ret = dwc3_gadget_start_config(dwc, dep);
589 if (ret)
590 return ret;
591 }
592
Felipe Balbi21e64bf2016-06-02 12:37:31 +0300593 ret = dwc3_gadget_set_ep_config(dwc, dep, desc, comp_desc, modify,
Paul Zimmerman265b70a2013-12-19 12:38:49 -0600594 restore);
Felipe Balbi72246da2011-08-19 18:10:58 +0300595 if (ret)
596 return ret;
597
598 if (!(dep->flags & DWC3_EP_ENABLED)) {
Felipe Balbif6bafc62012-02-06 11:04:53 +0200599 struct dwc3_trb *trb_st_hw;
600 struct dwc3_trb *trb_link;
Felipe Balbi72246da2011-08-19 18:10:58 +0300601
Ido Shayevitz16e78db2012-03-12 20:25:24 +0200602 dep->endpoint.desc = desc;
Felipe Balbic90bfae2011-11-29 13:11:21 +0200603 dep->comp_desc = comp_desc;
Felipe Balbi72246da2011-08-19 18:10:58 +0300604 dep->type = usb_endpoint_type(desc);
605 dep->flags |= DWC3_EP_ENABLED;
Baolin Wang76a638f2016-10-31 19:38:36 +0800606 dep->flags &= ~DWC3_EP_END_TRANSFER_PENDING;
Felipe Balbi72246da2011-08-19 18:10:58 +0300607
608 reg = dwc3_readl(dwc->regs, DWC3_DALEPENA);
609 reg |= DWC3_DALEPENA_EP(dep->number);
610 dwc3_writel(dwc->regs, DWC3_DALEPENA, reg);
611
Baolin Wang76a638f2016-10-31 19:38:36 +0800612 init_waitqueue_head(&dep->wait_end_transfer);
613
Felipe Balbi36b68aa2016-04-05 13:24:36 +0300614 if (usb_endpoint_xfer_control(desc))
Felipe Balbi2870e502016-11-03 13:53:29 +0200615 goto out;
Felipe Balbi72246da2011-08-19 18:10:58 +0300616
John Youn0d257442016-05-19 17:26:08 -0700617 /* Initialize the TRB ring */
618 dep->trb_dequeue = 0;
619 dep->trb_enqueue = 0;
620 memset(dep->trb_pool, 0,
621 sizeof(struct dwc3_trb) * DWC3_TRB_NUM);
622
Felipe Balbi36b68aa2016-04-05 13:24:36 +0300623 /* Link TRB. The HWO bit is never reset */
Felipe Balbi72246da2011-08-19 18:10:58 +0300624 trb_st_hw = &dep->trb_pool[0];
625
Felipe Balbif6bafc62012-02-06 11:04:53 +0200626 trb_link = &dep->trb_pool[DWC3_TRB_NUM - 1];
Felipe Balbif6bafc62012-02-06 11:04:53 +0200627 trb_link->bpl = lower_32_bits(dwc3_trb_dma_offset(dep, trb_st_hw));
628 trb_link->bph = upper_32_bits(dwc3_trb_dma_offset(dep, trb_st_hw));
629 trb_link->ctrl |= DWC3_TRBCTL_LINK_TRB;
630 trb_link->ctrl |= DWC3_TRB_CTRL_HWO;
Felipe Balbi72246da2011-08-19 18:10:58 +0300631 }
632
Felipe Balbia97ea992016-09-29 16:28:56 +0300633 /*
634 * Issue StartTransfer here with no-op TRB so we can always rely on No
635 * Response Update Transfer command.
636 */
637 if (usb_endpoint_xfer_bulk(desc)) {
638 struct dwc3_gadget_ep_cmd_params params;
639 struct dwc3_trb *trb;
640 dma_addr_t trb_dma;
641 u32 cmd;
642
643 memset(&params, 0, sizeof(params));
644 trb = &dep->trb_pool[0];
645 trb_dma = dwc3_trb_dma_offset(dep, trb);
646
647 params.param0 = upper_32_bits(trb_dma);
648 params.param1 = lower_32_bits(trb_dma);
649
650 cmd = DWC3_DEPCMD_STARTTRANSFER;
651
652 ret = dwc3_send_gadget_ep_cmd(dep, cmd, &params);
653 if (ret < 0)
654 return ret;
655
656 dep->flags |= DWC3_EP_BUSY;
657
658 dep->resource_index = dwc3_gadget_ep_get_transfer_index(dep);
659 WARN_ON_ONCE(!dep->resource_index);
660 }
661
Felipe Balbi2870e502016-11-03 13:53:29 +0200662
663out:
664 trace_dwc3_gadget_ep_enable(dep);
665
Felipe Balbi72246da2011-08-19 18:10:58 +0300666 return 0;
667}
668
Paul Zimmermanb992e682012-04-27 14:17:35 +0300669static void dwc3_stop_active_transfer(struct dwc3 *dwc, u32 epnum, bool force);
Sebastian Andrzej Siewior624407f2011-08-29 13:56:37 +0200670static void dwc3_remove_requests(struct dwc3 *dwc, struct dwc3_ep *dep)
Felipe Balbi72246da2011-08-19 18:10:58 +0300671{
672 struct dwc3_request *req;
673
Felipe Balbi0e146022016-06-21 10:32:02 +0300674 dwc3_stop_active_transfer(dwc, dep->number, true);
Felipe Balbi69450c42016-05-30 13:37:02 +0300675
Felipe Balbi0e146022016-06-21 10:32:02 +0300676 /* - giveback all requests to gadget driver */
677 while (!list_empty(&dep->started_list)) {
678 req = next_request(&dep->started_list);
Sebastian Andrzej Siewior624407f2011-08-29 13:56:37 +0200679
Felipe Balbi0e146022016-06-21 10:32:02 +0300680 dwc3_gadget_giveback(dep, req, -ESHUTDOWN);
Felipe Balbiea53b882012-02-17 12:10:04 +0200681 }
682
Felipe Balbiaa3342c2016-03-14 11:01:31 +0200683 while (!list_empty(&dep->pending_list)) {
684 req = next_request(&dep->pending_list);
Felipe Balbi72246da2011-08-19 18:10:58 +0300685
Sebastian Andrzej Siewior624407f2011-08-29 13:56:37 +0200686 dwc3_gadget_giveback(dep, req, -ESHUTDOWN);
Felipe Balbi72246da2011-08-19 18:10:58 +0300687 }
Felipe Balbi72246da2011-08-19 18:10:58 +0300688}
689
690/**
691 * __dwc3_gadget_ep_disable - Disables a HW endpoint
692 * @dep: the endpoint to disable
693 *
Sebastian Andrzej Siewior624407f2011-08-29 13:56:37 +0200694 * This function also removes requests which are currently processed ny the
695 * hardware and those which are not yet scheduled.
696 * Caller should take care of locking.
Felipe Balbi72246da2011-08-19 18:10:58 +0300697 */
Felipe Balbi72246da2011-08-19 18:10:58 +0300698static int __dwc3_gadget_ep_disable(struct dwc3_ep *dep)
699{
700 struct dwc3 *dwc = dep->dwc;
701 u32 reg;
702
Felipe Balbi2870e502016-11-03 13:53:29 +0200703 trace_dwc3_gadget_ep_disable(dep);
Felipe Balbi7eaeac52015-07-20 14:46:15 -0500704
Sebastian Andrzej Siewior624407f2011-08-29 13:56:37 +0200705 dwc3_remove_requests(dwc, dep);
Felipe Balbi72246da2011-08-19 18:10:58 +0300706
Felipe Balbi687ef982014-04-16 10:30:33 -0500707 /* make sure HW endpoint isn't stalled */
708 if (dep->flags & DWC3_EP_STALL)
Felipe Balbi7a608552014-09-24 14:19:52 -0500709 __dwc3_gadget_ep_set_halt(dep, 0, false);
Felipe Balbi687ef982014-04-16 10:30:33 -0500710
Felipe Balbi72246da2011-08-19 18:10:58 +0300711 reg = dwc3_readl(dwc->regs, DWC3_DALEPENA);
712 reg &= ~DWC3_DALEPENA_EP(dep->number);
713 dwc3_writel(dwc->regs, DWC3_DALEPENA, reg);
714
Felipe Balbi879631a2011-09-30 10:58:47 +0300715 dep->stream_capable = false;
Ido Shayevitzf9c56cd2012-02-08 13:56:48 +0200716 dep->endpoint.desc = NULL;
Felipe Balbic90bfae2011-11-29 13:11:21 +0200717 dep->comp_desc = NULL;
Felipe Balbi72246da2011-08-19 18:10:58 +0300718 dep->type = 0;
Baolin Wang76a638f2016-10-31 19:38:36 +0800719 dep->flags &= DWC3_EP_END_TRANSFER_PENDING;
Felipe Balbi72246da2011-08-19 18:10:58 +0300720
721 return 0;
722}
723
724/* -------------------------------------------------------------------------- */
725
726static int dwc3_gadget_ep0_enable(struct usb_ep *ep,
727 const struct usb_endpoint_descriptor *desc)
728{
729 return -EINVAL;
730}
731
732static int dwc3_gadget_ep0_disable(struct usb_ep *ep)
733{
734 return -EINVAL;
735}
736
737/* -------------------------------------------------------------------------- */
738
739static int dwc3_gadget_ep_enable(struct usb_ep *ep,
740 const struct usb_endpoint_descriptor *desc)
741{
742 struct dwc3_ep *dep;
743 struct dwc3 *dwc;
744 unsigned long flags;
745 int ret;
746
747 if (!ep || !desc || desc->bDescriptorType != USB_DT_ENDPOINT) {
748 pr_debug("dwc3: invalid parameters\n");
749 return -EINVAL;
750 }
751
752 if (!desc->wMaxPacketSize) {
753 pr_debug("dwc3: missing wMaxPacketSize\n");
754 return -EINVAL;
755 }
756
757 dep = to_dwc3_ep(ep);
758 dwc = dep->dwc;
759
Felipe Balbi95ca9612015-12-10 13:08:20 -0600760 if (dev_WARN_ONCE(dwc->dev, dep->flags & DWC3_EP_ENABLED,
761 "%s is already enabled\n",
762 dep->name))
Felipe Balbic6f83f32012-08-15 12:28:29 +0300763 return 0;
Felipe Balbic6f83f32012-08-15 12:28:29 +0300764
Felipe Balbi72246da2011-08-19 18:10:58 +0300765 spin_lock_irqsave(&dwc->lock, flags);
Paul Zimmerman265b70a2013-12-19 12:38:49 -0600766 ret = __dwc3_gadget_ep_enable(dep, desc, ep->comp_desc, false, false);
Felipe Balbi72246da2011-08-19 18:10:58 +0300767 spin_unlock_irqrestore(&dwc->lock, flags);
768
769 return ret;
770}
771
772static int dwc3_gadget_ep_disable(struct usb_ep *ep)
773{
774 struct dwc3_ep *dep;
775 struct dwc3 *dwc;
776 unsigned long flags;
777 int ret;
778
779 if (!ep) {
780 pr_debug("dwc3: invalid parameters\n");
781 return -EINVAL;
782 }
783
784 dep = to_dwc3_ep(ep);
785 dwc = dep->dwc;
786
Felipe Balbi95ca9612015-12-10 13:08:20 -0600787 if (dev_WARN_ONCE(dwc->dev, !(dep->flags & DWC3_EP_ENABLED),
788 "%s is already disabled\n",
789 dep->name))
Felipe Balbi72246da2011-08-19 18:10:58 +0300790 return 0;
Felipe Balbi72246da2011-08-19 18:10:58 +0300791
Felipe Balbi72246da2011-08-19 18:10:58 +0300792 spin_lock_irqsave(&dwc->lock, flags);
793 ret = __dwc3_gadget_ep_disable(dep);
794 spin_unlock_irqrestore(&dwc->lock, flags);
795
796 return ret;
797}
798
799static struct usb_request *dwc3_gadget_ep_alloc_request(struct usb_ep *ep,
800 gfp_t gfp_flags)
801{
802 struct dwc3_request *req;
803 struct dwc3_ep *dep = to_dwc3_ep(ep);
Felipe Balbi72246da2011-08-19 18:10:58 +0300804
805 req = kzalloc(sizeof(*req), gfp_flags);
Jingoo Han734d5a52014-07-17 12:45:11 +0900806 if (!req)
Felipe Balbi72246da2011-08-19 18:10:58 +0300807 return NULL;
Felipe Balbi72246da2011-08-19 18:10:58 +0300808
809 req->epnum = dep->number;
810 req->dep = dep;
Felipe Balbi72246da2011-08-19 18:10:58 +0300811
Felipe Balbi68d34c82016-05-30 13:34:58 +0300812 dep->allocated_requests++;
813
Felipe Balbi2c4cbe6e52014-04-30 17:45:10 -0500814 trace_dwc3_alloc_request(req);
815
Felipe Balbi72246da2011-08-19 18:10:58 +0300816 return &req->request;
817}
818
819static void dwc3_gadget_ep_free_request(struct usb_ep *ep,
820 struct usb_request *request)
821{
822 struct dwc3_request *req = to_dwc3_request(request);
Felipe Balbi68d34c82016-05-30 13:34:58 +0300823 struct dwc3_ep *dep = to_dwc3_ep(ep);
Felipe Balbi72246da2011-08-19 18:10:58 +0300824
Felipe Balbi68d34c82016-05-30 13:34:58 +0300825 dep->allocated_requests--;
Felipe Balbi2c4cbe6e52014-04-30 17:45:10 -0500826 trace_dwc3_free_request(req);
Felipe Balbi72246da2011-08-19 18:10:58 +0300827 kfree(req);
828}
829
Felipe Balbi2c78c022016-08-12 13:13:10 +0300830static u32 dwc3_calc_trbs_left(struct dwc3_ep *dep);
831
Felipe Balbic71fc372011-11-22 11:37:34 +0200832/**
833 * dwc3_prepare_one_trb - setup one TRB from one request
834 * @dep: endpoint for which this request is prepared
835 * @req: dwc3_request pointer
836 */
Felipe Balbi68e823e2011-11-28 12:25:01 +0200837static void dwc3_prepare_one_trb(struct dwc3_ep *dep,
Felipe Balbieeb720f2011-11-28 12:46:59 +0200838 struct dwc3_request *req, dma_addr_t dma,
Felipe Balbi4bc48c92016-08-10 16:04:33 +0300839 unsigned length, unsigned chain, unsigned node)
Felipe Balbic71fc372011-11-22 11:37:34 +0200840{
Felipe Balbif6bafc62012-02-06 11:04:53 +0200841 struct dwc3_trb *trb;
Felipe Balbi6b9018d2016-09-22 11:01:01 +0300842 struct dwc3 *dwc = dep->dwc;
843 struct usb_gadget *gadget = &dwc->gadget;
844 enum usb_device_speed speed = gadget->speed;
Felipe Balbic71fc372011-11-22 11:37:34 +0200845
Felipe Balbi4faf7552016-04-05 13:14:31 +0300846 trb = &dep->trb_pool[dep->trb_enqueue];
Felipe Balbic71fc372011-11-22 11:37:34 +0200847
Felipe Balbieeb720f2011-11-28 12:46:59 +0200848 if (!req->trb) {
Felipe Balbiaa3342c2016-03-14 11:01:31 +0200849 dwc3_gadget_move_started_request(req);
Felipe Balbif6bafc62012-02-06 11:04:53 +0200850 req->trb = trb;
851 req->trb_dma = dwc3_trb_dma_offset(dep, trb);
Felipe Balbia9c3ca52016-10-05 14:24:37 +0300852 dep->queued_requests++;
Felipe Balbieeb720f2011-11-28 12:46:59 +0200853 }
Felipe Balbic71fc372011-11-22 11:37:34 +0200854
Felipe Balbief966b92016-04-05 13:09:51 +0300855 dwc3_ep_inc_enq(dep);
Pratyush Anande5ba5ec2013-01-14 15:59:37 +0530856
Felipe Balbif6bafc62012-02-06 11:04:53 +0200857 trb->size = DWC3_TRB_SIZE_LENGTH(length);
858 trb->bpl = lower_32_bits(dma);
859 trb->bph = upper_32_bits(dma);
Felipe Balbic71fc372011-11-22 11:37:34 +0200860
Ido Shayevitz16e78db2012-03-12 20:25:24 +0200861 switch (usb_endpoint_type(dep->endpoint.desc)) {
Felipe Balbic71fc372011-11-22 11:37:34 +0200862 case USB_ENDPOINT_XFER_CONTROL:
Felipe Balbif6bafc62012-02-06 11:04:53 +0200863 trb->ctrl = DWC3_TRBCTL_CONTROL_SETUP;
Felipe Balbic71fc372011-11-22 11:37:34 +0200864 break;
865
866 case USB_ENDPOINT_XFER_ISOC:
Felipe Balbi6b9018d2016-09-22 11:01:01 +0300867 if (!node) {
Pratyush Anande5ba5ec2013-01-14 15:59:37 +0530868 trb->ctrl = DWC3_TRBCTL_ISOCHRONOUS_FIRST;
Felipe Balbi6b9018d2016-09-22 11:01:01 +0300869
870 if (speed == USB_SPEED_HIGH) {
871 struct usb_ep *ep = &dep->endpoint;
872 trb->size |= DWC3_TRB_SIZE_PCM1(ep->mult - 1);
873 }
874 } else {
Pratyush Anande5ba5ec2013-01-14 15:59:37 +0530875 trb->ctrl = DWC3_TRBCTL_ISOCHRONOUS;
Felipe Balbi6b9018d2016-09-22 11:01:01 +0300876 }
Felipe Balbica4d44e2016-03-10 13:53:27 +0200877
878 /* always enable Interrupt on Missed ISOC */
879 trb->ctrl |= DWC3_TRB_CTRL_ISP_IMI;
Felipe Balbic71fc372011-11-22 11:37:34 +0200880 break;
881
882 case USB_ENDPOINT_XFER_BULK:
883 case USB_ENDPOINT_XFER_INT:
Felipe Balbif6bafc62012-02-06 11:04:53 +0200884 trb->ctrl = DWC3_TRBCTL_NORMAL;
Felipe Balbic71fc372011-11-22 11:37:34 +0200885 break;
886 default:
887 /*
888 * This is only possible with faulty memory because we
889 * checked it already :)
890 */
Felipe Balbi0a695d42016-10-07 11:20:01 +0300891 dev_WARN(dwc->dev, "Unknown endpoint type %d\n",
892 usb_endpoint_type(dep->endpoint.desc));
Felipe Balbic71fc372011-11-22 11:37:34 +0200893 }
894
Felipe Balbica4d44e2016-03-10 13:53:27 +0200895 /* always enable Continue on Short Packet */
Felipe Balbic9508c82016-10-05 14:26:23 +0300896 if (usb_endpoint_dir_out(dep->endpoint.desc)) {
Felipe Balbi58f29032016-10-06 17:10:39 +0300897 trb->ctrl |= DWC3_TRB_CTRL_CSP;
Felipe Balbif3af3652013-12-13 14:19:33 -0600898
Felipe Balbic9508c82016-10-05 14:26:23 +0300899 if (req->request.short_not_ok)
900 trb->ctrl |= DWC3_TRB_CTRL_ISP_IMI;
901 }
902
Felipe Balbi2c78c022016-08-12 13:13:10 +0300903 if ((!req->request.no_interrupt && !chain) ||
904 (dwc3_calc_trbs_left(dep) == 0))
Felipe Balbic9508c82016-10-05 14:26:23 +0300905 trb->ctrl |= DWC3_TRB_CTRL_IOC;
Felipe Balbica4d44e2016-03-10 13:53:27 +0200906
Pratyush Anande5ba5ec2013-01-14 15:59:37 +0530907 if (chain)
908 trb->ctrl |= DWC3_TRB_CTRL_CHN;
909
Ido Shayevitz16e78db2012-03-12 20:25:24 +0200910 if (usb_endpoint_xfer_bulk(dep->endpoint.desc) && dep->stream_capable)
Felipe Balbif6bafc62012-02-06 11:04:53 +0200911 trb->ctrl |= DWC3_TRB_CTRL_SID_SOFN(req->request.stream_id);
912
913 trb->ctrl |= DWC3_TRB_CTRL_HWO;
Felipe Balbi2c4cbe6e52014-04-30 17:45:10 -0500914
915 trace_dwc3_prepare_trb(dep, trb);
Felipe Balbic71fc372011-11-22 11:37:34 +0200916}
917
John Youn361572b2016-05-19 17:26:17 -0700918/**
919 * dwc3_ep_prev_trb() - Returns the previous TRB in the ring
920 * @dep: The endpoint with the TRB ring
921 * @index: The index of the current TRB in the ring
922 *
923 * Returns the TRB prior to the one pointed to by the index. If the
924 * index is 0, we will wrap backwards, skip the link TRB, and return
925 * the one just before that.
926 */
927static struct dwc3_trb *dwc3_ep_prev_trb(struct dwc3_ep *dep, u8 index)
928{
Felipe Balbi45438a02016-08-11 12:26:59 +0300929 u8 tmp = index;
John Youn361572b2016-05-19 17:26:17 -0700930
Felipe Balbi45438a02016-08-11 12:26:59 +0300931 if (!tmp)
932 tmp = DWC3_TRB_NUM - 1;
933
934 return &dep->trb_pool[tmp - 1];
John Youn361572b2016-05-19 17:26:17 -0700935}
936
Felipe Balbic4233572016-05-12 14:08:34 +0300937static u32 dwc3_calc_trbs_left(struct dwc3_ep *dep)
938{
939 struct dwc3_trb *tmp;
Janusz Dziedzicf2694a92016-11-09 11:01:35 +0100940 struct dwc3 *dwc = dep->dwc;
John Youn32db3d92016-05-19 17:26:12 -0700941 u8 trbs_left;
Felipe Balbic4233572016-05-12 14:08:34 +0300942
943 /*
944 * If enqueue & dequeue are equal than it is either full or empty.
945 *
946 * One way to know for sure is if the TRB right before us has HWO bit
947 * set or not. If it has, then we're definitely full and can't fit any
948 * more transfers in our ring.
949 */
950 if (dep->trb_enqueue == dep->trb_dequeue) {
John Youn361572b2016-05-19 17:26:17 -0700951 tmp = dwc3_ep_prev_trb(dep, dep->trb_enqueue);
Janusz Dziedzicf2694a92016-11-09 11:01:35 +0100952 if (dev_WARN_ONCE(dwc->dev, tmp->ctrl & DWC3_TRB_CTRL_HWO,
953 "%s No TRBS left\n", dep->name))
John Youn361572b2016-05-19 17:26:17 -0700954 return 0;
Felipe Balbic4233572016-05-12 14:08:34 +0300955
956 return DWC3_TRB_NUM - 1;
957 }
958
John Youn9d7aba72016-08-26 18:43:01 -0700959 trbs_left = dep->trb_dequeue - dep->trb_enqueue;
John Youn3de2685f2016-05-23 11:32:45 -0700960 trbs_left &= (DWC3_TRB_NUM - 1);
John Youn32db3d92016-05-19 17:26:12 -0700961
John Youn9d7aba72016-08-26 18:43:01 -0700962 if (dep->trb_dequeue < dep->trb_enqueue)
963 trbs_left--;
964
John Youn32db3d92016-05-19 17:26:12 -0700965 return trbs_left;
Felipe Balbic4233572016-05-12 14:08:34 +0300966}
967
Felipe Balbi5ee85d82016-05-13 12:42:44 +0300968static void dwc3_prepare_one_trb_sg(struct dwc3_ep *dep,
Felipe Balbi7ae7df42016-08-24 14:37:22 +0300969 struct dwc3_request *req)
Felipe Balbi5ee85d82016-05-13 12:42:44 +0300970{
Felipe Balbi1f512112016-08-12 13:17:27 +0300971 struct scatterlist *sg = req->sg;
Felipe Balbi5ee85d82016-05-13 12:42:44 +0300972 struct scatterlist *s;
Felipe Balbi5ee85d82016-05-13 12:42:44 +0300973 unsigned int length;
974 dma_addr_t dma;
975 int i;
976
Felipe Balbi1f512112016-08-12 13:17:27 +0300977 for_each_sg(sg, s, req->num_pending_sgs, i) {
Felipe Balbi5ee85d82016-05-13 12:42:44 +0300978 unsigned chain = true;
979
980 length = sg_dma_len(s);
981 dma = sg_dma_address(s);
982
Felipe Balbi4bc48c92016-08-10 16:04:33 +0300983 if (sg_is_last(s))
Felipe Balbi5ee85d82016-05-13 12:42:44 +0300984 chain = false;
985
986 dwc3_prepare_one_trb(dep, req, dma, length,
Felipe Balbi4bc48c92016-08-10 16:04:33 +0300987 chain, i);
Felipe Balbi5ee85d82016-05-13 12:42:44 +0300988
Felipe Balbi7ae7df42016-08-24 14:37:22 +0300989 if (!dwc3_calc_trbs_left(dep))
Felipe Balbi5ee85d82016-05-13 12:42:44 +0300990 break;
991 }
992}
993
994static void dwc3_prepare_one_trb_linear(struct dwc3_ep *dep,
Felipe Balbi7ae7df42016-08-24 14:37:22 +0300995 struct dwc3_request *req)
Felipe Balbi5ee85d82016-05-13 12:42:44 +0300996{
Felipe Balbi5ee85d82016-05-13 12:42:44 +0300997 unsigned int length;
998 dma_addr_t dma;
999
1000 dma = req->request.dma;
1001 length = req->request.length;
1002
Felipe Balbi5ee85d82016-05-13 12:42:44 +03001003 dwc3_prepare_one_trb(dep, req, dma, length,
Felipe Balbi4bc48c92016-08-10 16:04:33 +03001004 false, 0);
Felipe Balbi5ee85d82016-05-13 12:42:44 +03001005}
1006
Felipe Balbi72246da2011-08-19 18:10:58 +03001007/*
1008 * dwc3_prepare_trbs - setup TRBs from requests
1009 * @dep: endpoint for which requests are being prepared
Felipe Balbi72246da2011-08-19 18:10:58 +03001010 *
Paul Zimmerman1d046792012-02-15 18:56:56 -08001011 * The function goes through the requests list and sets up TRBs for the
1012 * transfers. The function returns once there are no more TRBs available or
1013 * it runs out of requests.
Felipe Balbi72246da2011-08-19 18:10:58 +03001014 */
Felipe Balbic4233572016-05-12 14:08:34 +03001015static void dwc3_prepare_trbs(struct dwc3_ep *dep)
Felipe Balbi72246da2011-08-19 18:10:58 +03001016{
Felipe Balbi68e823e2011-11-28 12:25:01 +02001017 struct dwc3_request *req, *n;
Felipe Balbi72246da2011-08-19 18:10:58 +03001018
1019 BUILD_BUG_ON_NOT_POWER_OF_2(DWC3_TRB_NUM);
1020
Felipe Balbi7ae7df42016-08-24 14:37:22 +03001021 if (!dwc3_calc_trbs_left(dep))
John Youn89bc8562016-05-19 17:26:10 -07001022 return;
Felipe Balbi72246da2011-08-19 18:10:58 +03001023
Felipe Balbid86c5a62016-10-25 13:48:52 +03001024 /*
1025 * We can get in a situation where there's a request in the started list
1026 * but there weren't enough TRBs to fully kick it in the first time
1027 * around, so it has been waiting for more TRBs to be freed up.
1028 *
1029 * In that case, we should check if we have a request with pending_sgs
1030 * in the started list and prepare TRBs for that request first,
1031 * otherwise we will prepare TRBs completely out of order and that will
1032 * break things.
1033 */
1034 list_for_each_entry(req, &dep->started_list, list) {
1035 if (req->num_pending_sgs > 0)
1036 dwc3_prepare_one_trb_sg(dep, req);
1037
1038 if (!dwc3_calc_trbs_left(dep))
1039 return;
1040 }
1041
Felipe Balbiaa3342c2016-03-14 11:01:31 +02001042 list_for_each_entry_safe(req, n, &dep->pending_list, list) {
Felipe Balbi1f512112016-08-12 13:17:27 +03001043 if (req->num_pending_sgs > 0)
Felipe Balbi7ae7df42016-08-24 14:37:22 +03001044 dwc3_prepare_one_trb_sg(dep, req);
Felipe Balbi5ee85d82016-05-13 12:42:44 +03001045 else
Felipe Balbi7ae7df42016-08-24 14:37:22 +03001046 dwc3_prepare_one_trb_linear(dep, req);
Felipe Balbi72246da2011-08-19 18:10:58 +03001047
Felipe Balbi7ae7df42016-08-24 14:37:22 +03001048 if (!dwc3_calc_trbs_left(dep))
Felipe Balbi5ee85d82016-05-13 12:42:44 +03001049 return;
Felipe Balbi72246da2011-08-19 18:10:58 +03001050 }
Felipe Balbi72246da2011-08-19 18:10:58 +03001051}
1052
Felipe Balbi4fae2e32016-05-12 16:53:59 +03001053static int __dwc3_gadget_kick_transfer(struct dwc3_ep *dep, u16 cmd_param)
Felipe Balbi72246da2011-08-19 18:10:58 +03001054{
1055 struct dwc3_gadget_ep_cmd_params params;
1056 struct dwc3_request *req;
Felipe Balbi4fae2e32016-05-12 16:53:59 +03001057 int starting;
Felipe Balbi72246da2011-08-19 18:10:58 +03001058 int ret;
1059 u32 cmd;
1060
Felipe Balbi4fae2e32016-05-12 16:53:59 +03001061 starting = !(dep->flags & DWC3_EP_BUSY);
Felipe Balbi72246da2011-08-19 18:10:58 +03001062
Felipe Balbi4fae2e32016-05-12 16:53:59 +03001063 dwc3_prepare_trbs(dep);
1064 req = next_request(&dep->started_list);
Felipe Balbi72246da2011-08-19 18:10:58 +03001065 if (!req) {
1066 dep->flags |= DWC3_EP_PENDING_REQUEST;
1067 return 0;
1068 }
1069
1070 memset(&params, 0, sizeof(params));
Felipe Balbi72246da2011-08-19 18:10:58 +03001071
Felipe Balbi4fae2e32016-05-12 16:53:59 +03001072 if (starting) {
Pratyush Anand1877d6c2013-01-14 15:59:36 +05301073 params.param0 = upper_32_bits(req->trb_dma);
1074 params.param1 = lower_32_bits(req->trb_dma);
Felipe Balbib6b1c6d2016-05-30 13:29:35 +03001075 cmd = DWC3_DEPCMD_STARTTRANSFER |
1076 DWC3_DEPCMD_PARAM(cmd_param);
Pratyush Anand1877d6c2013-01-14 15:59:36 +05301077 } else {
Felipe Balbib6b1c6d2016-05-30 13:29:35 +03001078 cmd = DWC3_DEPCMD_UPDATETRANSFER |
1079 DWC3_DEPCMD_PARAM(dep->resource_index);
Pratyush Anand1877d6c2013-01-14 15:59:36 +05301080 }
Felipe Balbi72246da2011-08-19 18:10:58 +03001081
Felipe Balbi2cd47182016-04-12 16:42:43 +03001082 ret = dwc3_send_gadget_ep_cmd(dep, cmd, &params);
Felipe Balbi72246da2011-08-19 18:10:58 +03001083 if (ret < 0) {
Felipe Balbi72246da2011-08-19 18:10:58 +03001084 /*
1085 * FIXME we need to iterate over the list of requests
1086 * here and stop, unmap, free and del each of the linked
Paul Zimmerman1d046792012-02-15 18:56:56 -08001087 * requests instead of what we do now.
Felipe Balbi72246da2011-08-19 18:10:58 +03001088 */
Janusz Dziedzicce3fc8b2016-11-09 11:01:32 +01001089 if (req->trb)
1090 memset(req->trb, 0, sizeof(struct dwc3_trb));
Janusz Dziedzic8ab89da2016-11-09 11:01:31 +01001091 dep->queued_requests--;
Felipe Balbi15b8d932016-09-22 10:59:12 +03001092 dwc3_gadget_giveback(dep, req, ret);
Felipe Balbi72246da2011-08-19 18:10:58 +03001093 return ret;
1094 }
1095
1096 dep->flags |= DWC3_EP_BUSY;
Felipe Balbi25b8ff62011-11-04 12:32:47 +02001097
Felipe Balbi4fae2e32016-05-12 16:53:59 +03001098 if (starting) {
Felipe Balbi2eb88012016-04-12 16:53:39 +03001099 dep->resource_index = dwc3_gadget_ep_get_transfer_index(dep);
Felipe Balbib4996a82012-06-06 12:04:13 +03001100 WARN_ON_ONCE(!dep->resource_index);
Paul Zimmermanf898ae02012-03-29 18:16:54 +00001101 }
Felipe Balbi25b8ff62011-11-04 12:32:47 +02001102
Felipe Balbi72246da2011-08-19 18:10:58 +03001103 return 0;
1104}
1105
Felipe Balbi6cb2e4e2016-10-21 13:07:09 +03001106static int __dwc3_gadget_get_frame(struct dwc3 *dwc)
1107{
1108 u32 reg;
1109
1110 reg = dwc3_readl(dwc->regs, DWC3_DSTS);
1111 return DWC3_DSTS_SOFFN(reg);
1112}
1113
Pratyush Anandd6d6ec72012-05-25 18:54:56 +05301114static void __dwc3_gadget_start_isoc(struct dwc3 *dwc,
1115 struct dwc3_ep *dep, u32 cur_uf)
1116{
1117 u32 uf;
1118
Felipe Balbiaa3342c2016-03-14 11:01:31 +02001119 if (list_empty(&dep->pending_list)) {
Felipe Balbi5eb30ce2016-11-03 14:07:51 +02001120 dev_info(dwc->dev, "%s: ran out of requests\n",
Felipe Balbi73815282015-01-27 13:48:14 -06001121 dep->name);
Pratyush Anandf4a53c52012-08-30 12:21:43 +05301122 dep->flags |= DWC3_EP_PENDING_REQUEST;
Pratyush Anandd6d6ec72012-05-25 18:54:56 +05301123 return;
1124 }
1125
1126 /* 4 micro frames in the future */
1127 uf = cur_uf + dep->interval * 4;
1128
Felipe Balbi4fae2e32016-05-12 16:53:59 +03001129 __dwc3_gadget_kick_transfer(dep, uf);
Pratyush Anandd6d6ec72012-05-25 18:54:56 +05301130}
1131
1132static void dwc3_gadget_start_isoc(struct dwc3 *dwc,
1133 struct dwc3_ep *dep, const struct dwc3_event_depevt *event)
1134{
1135 u32 cur_uf, mask;
1136
1137 mask = ~(dep->interval - 1);
1138 cur_uf = event->parameters & mask;
1139
1140 __dwc3_gadget_start_isoc(dwc, dep, cur_uf);
1141}
1142
Felipe Balbi72246da2011-08-19 18:10:58 +03001143static int __dwc3_gadget_ep_queue(struct dwc3_ep *dep, struct dwc3_request *req)
1144{
Felipe Balbi0fc9a1b2011-12-19 11:32:34 +02001145 struct dwc3 *dwc = dep->dwc;
1146 int ret;
1147
Felipe Balbibb423982015-11-16 15:31:21 -06001148 if (!dep->endpoint.desc) {
Felipe Balbi5eb30ce2016-11-03 14:07:51 +02001149 dev_err(dwc->dev, "%s: can't queue to disabled endpoint\n",
1150 dep->name);
Felipe Balbibb423982015-11-16 15:31:21 -06001151 return -ESHUTDOWN;
1152 }
1153
1154 if (WARN(req->dep != dep, "request %p belongs to '%s'\n",
1155 &req->request, req->dep->name)) {
Felipe Balbi5eb30ce2016-11-03 14:07:51 +02001156 dev_err(dwc->dev, "%s: request %p belongs to '%s'\n",
1157 dep->name, &req->request, req->dep->name);
Felipe Balbibb423982015-11-16 15:31:21 -06001158 return -EINVAL;
1159 }
1160
Felipe Balbifc8bb912016-05-16 13:14:48 +03001161 pm_runtime_get(dwc->dev);
1162
Felipe Balbi72246da2011-08-19 18:10:58 +03001163 req->request.actual = 0;
1164 req->request.status = -EINPROGRESS;
1165 req->direction = dep->direction;
1166 req->epnum = dep->number;
1167
Felipe Balbife84f522015-09-01 09:01:38 -05001168 trace_dwc3_ep_queue(req);
1169
Felipe Balbi0fc9a1b2011-12-19 11:32:34 +02001170 ret = usb_gadget_map_request(&dwc->gadget, &req->request,
1171 dep->direction);
1172 if (ret)
1173 return ret;
1174
Felipe Balbi1f512112016-08-12 13:17:27 +03001175 req->sg = req->request.sg;
1176 req->num_pending_sgs = req->request.num_mapped_sgs;
1177
Felipe Balbiaa3342c2016-03-14 11:01:31 +02001178 list_add_tail(&req->list, &dep->pending_list);
Felipe Balbi72246da2011-08-19 18:10:58 +03001179
Felipe Balbid889c232016-09-29 15:44:29 +03001180 /*
1181 * NOTICE: Isochronous endpoints should NEVER be prestarted. We must
1182 * wait for a XferNotReady event so we will know what's the current
1183 * (micro-)frame number.
1184 *
1185 * Without this trick, we are very, very likely gonna get Bus Expiry
1186 * errors which will force us issue EndTransfer command.
1187 */
1188 if (usb_endpoint_xfer_isoc(dep->endpoint.desc)) {
Felipe Balbi6cb2e4e2016-10-21 13:07:09 +03001189 if ((dep->flags & DWC3_EP_PENDING_REQUEST)) {
1190 if (dep->flags & DWC3_EP_TRANSFER_STARTED) {
1191 dwc3_stop_active_transfer(dwc, dep->number, true);
1192 dep->flags = DWC3_EP_ENABLED;
1193 } else {
1194 u32 cur_uf;
1195
1196 cur_uf = __dwc3_gadget_get_frame(dwc);
1197 __dwc3_gadget_start_isoc(dwc, dep, cur_uf);
Janusz Dziedzic87aba102016-11-09 11:01:34 +01001198 dep->flags &= ~DWC3_EP_PENDING_REQUEST;
Felipe Balbi6cb2e4e2016-10-21 13:07:09 +03001199 }
Felipe Balbi08a36b52016-08-11 14:27:52 +03001200 }
1201 return 0;
Felipe Balbib511e5e2012-06-06 12:00:50 +03001202 }
1203
Felipe Balbi594e1212016-08-24 14:38:10 +03001204 if (!dwc3_calc_trbs_left(dep))
1205 return 0;
Felipe Balbib997ada2012-07-26 13:26:50 +03001206
Felipe Balbi08a36b52016-08-11 14:27:52 +03001207 ret = __dwc3_gadget_kick_transfer(dep, 0);
Felipe Balbia8f32812015-09-16 10:40:07 -05001208 if (ret == -EBUSY)
1209 ret = 0;
1210
1211 return ret;
Felipe Balbi72246da2011-08-19 18:10:58 +03001212}
1213
Felipe Balbi04c03d12015-12-02 10:06:45 -06001214static void __dwc3_gadget_ep_zlp_complete(struct usb_ep *ep,
1215 struct usb_request *request)
1216{
1217 dwc3_gadget_ep_free_request(ep, request);
1218}
1219
1220static int __dwc3_gadget_ep_queue_zlp(struct dwc3 *dwc, struct dwc3_ep *dep)
1221{
1222 struct dwc3_request *req;
1223 struct usb_request *request;
1224 struct usb_ep *ep = &dep->endpoint;
1225
Felipe Balbi04c03d12015-12-02 10:06:45 -06001226 request = dwc3_gadget_ep_alloc_request(ep, GFP_ATOMIC);
1227 if (!request)
1228 return -ENOMEM;
1229
1230 request->length = 0;
1231 request->buf = dwc->zlp_buf;
1232 request->complete = __dwc3_gadget_ep_zlp_complete;
1233
1234 req = to_dwc3_request(request);
1235
1236 return __dwc3_gadget_ep_queue(dep, req);
1237}
1238
Felipe Balbi72246da2011-08-19 18:10:58 +03001239static int dwc3_gadget_ep_queue(struct usb_ep *ep, struct usb_request *request,
1240 gfp_t gfp_flags)
1241{
1242 struct dwc3_request *req = to_dwc3_request(request);
1243 struct dwc3_ep *dep = to_dwc3_ep(ep);
1244 struct dwc3 *dwc = dep->dwc;
1245
1246 unsigned long flags;
1247
1248 int ret;
1249
Zhuang Jin Canfdee4eb2014-09-03 14:26:34 +08001250 spin_lock_irqsave(&dwc->lock, flags);
Felipe Balbi72246da2011-08-19 18:10:58 +03001251 ret = __dwc3_gadget_ep_queue(dep, req);
Felipe Balbi04c03d12015-12-02 10:06:45 -06001252
1253 /*
1254 * Okay, here's the thing, if gadget driver has requested for a ZLP by
1255 * setting request->zero, instead of doing magic, we will just queue an
1256 * extra usb_request ourselves so that it gets handled the same way as
1257 * any other request.
1258 */
John Yound92618982015-12-22 12:23:20 -08001259 if (ret == 0 && request->zero && request->length &&
1260 (request->length % ep->maxpacket == 0))
Felipe Balbi04c03d12015-12-02 10:06:45 -06001261 ret = __dwc3_gadget_ep_queue_zlp(dwc, dep);
1262
Felipe Balbi72246da2011-08-19 18:10:58 +03001263 spin_unlock_irqrestore(&dwc->lock, flags);
1264
1265 return ret;
1266}
1267
1268static int dwc3_gadget_ep_dequeue(struct usb_ep *ep,
1269 struct usb_request *request)
1270{
1271 struct dwc3_request *req = to_dwc3_request(request);
1272 struct dwc3_request *r = NULL;
1273
1274 struct dwc3_ep *dep = to_dwc3_ep(ep);
1275 struct dwc3 *dwc = dep->dwc;
1276
1277 unsigned long flags;
1278 int ret = 0;
1279
Felipe Balbi2c4cbe6e52014-04-30 17:45:10 -05001280 trace_dwc3_ep_dequeue(req);
1281
Felipe Balbi72246da2011-08-19 18:10:58 +03001282 spin_lock_irqsave(&dwc->lock, flags);
1283
Felipe Balbiaa3342c2016-03-14 11:01:31 +02001284 list_for_each_entry(r, &dep->pending_list, list) {
Felipe Balbi72246da2011-08-19 18:10:58 +03001285 if (r == req)
1286 break;
1287 }
1288
1289 if (r != req) {
Felipe Balbiaa3342c2016-03-14 11:01:31 +02001290 list_for_each_entry(r, &dep->started_list, list) {
Felipe Balbi72246da2011-08-19 18:10:58 +03001291 if (r == req)
1292 break;
1293 }
1294 if (r == req) {
1295 /* wait until it is processed */
Paul Zimmermanb992e682012-04-27 14:17:35 +03001296 dwc3_stop_active_transfer(dwc, dep->number, true);
Pratyush Anande8d4e8b2012-06-15 11:54:00 +05301297 goto out1;
Felipe Balbi72246da2011-08-19 18:10:58 +03001298 }
1299 dev_err(dwc->dev, "request %p was not queued to %s\n",
1300 request, ep->name);
1301 ret = -EINVAL;
1302 goto out0;
1303 }
1304
Pratyush Anande8d4e8b2012-06-15 11:54:00 +05301305out1:
Felipe Balbi72246da2011-08-19 18:10:58 +03001306 /* giveback the request */
1307 dwc3_gadget_giveback(dep, req, -ECONNRESET);
1308
1309out0:
1310 spin_unlock_irqrestore(&dwc->lock, flags);
1311
1312 return ret;
1313}
1314
Felipe Balbi7a608552014-09-24 14:19:52 -05001315int __dwc3_gadget_ep_set_halt(struct dwc3_ep *dep, int value, int protocol)
Felipe Balbi72246da2011-08-19 18:10:58 +03001316{
1317 struct dwc3_gadget_ep_cmd_params params;
1318 struct dwc3 *dwc = dep->dwc;
1319 int ret;
1320
Felipe Balbi5ad02fb2014-09-24 10:48:26 -05001321 if (usb_endpoint_xfer_isoc(dep->endpoint.desc)) {
1322 dev_err(dwc->dev, "%s is of Isochronous type\n", dep->name);
1323 return -EINVAL;
1324 }
1325
Felipe Balbi72246da2011-08-19 18:10:58 +03001326 memset(&params, 0x00, sizeof(params));
1327
1328 if (value) {
Felipe Balbi69450c42016-05-30 13:37:02 +03001329 struct dwc3_trb *trb;
1330
1331 unsigned transfer_in_flight;
1332 unsigned started;
1333
1334 if (dep->number > 1)
1335 trb = dwc3_ep_prev_trb(dep, dep->trb_enqueue);
1336 else
1337 trb = &dwc->ep0_trb[dep->trb_enqueue];
1338
1339 transfer_in_flight = trb->ctrl & DWC3_TRB_CTRL_HWO;
1340 started = !list_empty(&dep->started_list);
1341
1342 if (!protocol && ((dep->direction && transfer_in_flight) ||
1343 (!dep->direction && started))) {
Felipe Balbi7a608552014-09-24 14:19:52 -05001344 return -EAGAIN;
1345 }
1346
Felipe Balbi2cd47182016-04-12 16:42:43 +03001347 ret = dwc3_send_gadget_ep_cmd(dep, DWC3_DEPCMD_SETSTALL,
1348 &params);
Felipe Balbi72246da2011-08-19 18:10:58 +03001349 if (ret)
Dan Carpenter3f892042014-03-07 14:20:22 +03001350 dev_err(dwc->dev, "failed to set STALL on %s\n",
Felipe Balbi72246da2011-08-19 18:10:58 +03001351 dep->name);
1352 else
1353 dep->flags |= DWC3_EP_STALL;
1354 } else {
Felipe Balbi2cd47182016-04-12 16:42:43 +03001355
John Youn50c763f2016-05-31 17:49:56 -07001356 ret = dwc3_send_clear_stall_ep_cmd(dep);
Felipe Balbi72246da2011-08-19 18:10:58 +03001357 if (ret)
Dan Carpenter3f892042014-03-07 14:20:22 +03001358 dev_err(dwc->dev, "failed to clear STALL on %s\n",
Felipe Balbi72246da2011-08-19 18:10:58 +03001359 dep->name);
1360 else
Alan Sterna535d812013-11-01 12:05:12 -04001361 dep->flags &= ~(DWC3_EP_STALL | DWC3_EP_WEDGE);
Felipe Balbi72246da2011-08-19 18:10:58 +03001362 }
Paul Zimmerman52754552011-09-30 10:58:44 +03001363
Felipe Balbi72246da2011-08-19 18:10:58 +03001364 return ret;
1365}
1366
1367static int dwc3_gadget_ep_set_halt(struct usb_ep *ep, int value)
1368{
1369 struct dwc3_ep *dep = to_dwc3_ep(ep);
1370 struct dwc3 *dwc = dep->dwc;
1371
1372 unsigned long flags;
1373
1374 int ret;
1375
1376 spin_lock_irqsave(&dwc->lock, flags);
Felipe Balbi7a608552014-09-24 14:19:52 -05001377 ret = __dwc3_gadget_ep_set_halt(dep, value, false);
Felipe Balbi72246da2011-08-19 18:10:58 +03001378 spin_unlock_irqrestore(&dwc->lock, flags);
1379
1380 return ret;
1381}
1382
1383static int dwc3_gadget_ep_set_wedge(struct usb_ep *ep)
1384{
1385 struct dwc3_ep *dep = to_dwc3_ep(ep);
Paul Zimmerman249a4562012-02-24 17:32:16 -08001386 struct dwc3 *dwc = dep->dwc;
1387 unsigned long flags;
Felipe Balbi95aa4e82014-09-24 10:50:14 -05001388 int ret;
Felipe Balbi72246da2011-08-19 18:10:58 +03001389
Paul Zimmerman249a4562012-02-24 17:32:16 -08001390 spin_lock_irqsave(&dwc->lock, flags);
Felipe Balbi72246da2011-08-19 18:10:58 +03001391 dep->flags |= DWC3_EP_WEDGE;
1392
Pratyush Anand08f0d962012-06-25 22:40:43 +05301393 if (dep->number == 0 || dep->number == 1)
Felipe Balbi95aa4e82014-09-24 10:50:14 -05001394 ret = __dwc3_gadget_ep0_set_halt(ep, 1);
Pratyush Anand08f0d962012-06-25 22:40:43 +05301395 else
Felipe Balbi7a608552014-09-24 14:19:52 -05001396 ret = __dwc3_gadget_ep_set_halt(dep, 1, false);
Felipe Balbi95aa4e82014-09-24 10:50:14 -05001397 spin_unlock_irqrestore(&dwc->lock, flags);
1398
1399 return ret;
Felipe Balbi72246da2011-08-19 18:10:58 +03001400}
1401
1402/* -------------------------------------------------------------------------- */
1403
1404static struct usb_endpoint_descriptor dwc3_gadget_ep0_desc = {
1405 .bLength = USB_DT_ENDPOINT_SIZE,
1406 .bDescriptorType = USB_DT_ENDPOINT,
1407 .bmAttributes = USB_ENDPOINT_XFER_CONTROL,
1408};
1409
1410static const struct usb_ep_ops dwc3_gadget_ep0_ops = {
1411 .enable = dwc3_gadget_ep0_enable,
1412 .disable = dwc3_gadget_ep0_disable,
1413 .alloc_request = dwc3_gadget_ep_alloc_request,
1414 .free_request = dwc3_gadget_ep_free_request,
1415 .queue = dwc3_gadget_ep0_queue,
1416 .dequeue = dwc3_gadget_ep_dequeue,
Pratyush Anand08f0d962012-06-25 22:40:43 +05301417 .set_halt = dwc3_gadget_ep0_set_halt,
Felipe Balbi72246da2011-08-19 18:10:58 +03001418 .set_wedge = dwc3_gadget_ep_set_wedge,
1419};
1420
1421static const struct usb_ep_ops dwc3_gadget_ep_ops = {
1422 .enable = dwc3_gadget_ep_enable,
1423 .disable = dwc3_gadget_ep_disable,
1424 .alloc_request = dwc3_gadget_ep_alloc_request,
1425 .free_request = dwc3_gadget_ep_free_request,
1426 .queue = dwc3_gadget_ep_queue,
1427 .dequeue = dwc3_gadget_ep_dequeue,
1428 .set_halt = dwc3_gadget_ep_set_halt,
1429 .set_wedge = dwc3_gadget_ep_set_wedge,
1430};
1431
1432/* -------------------------------------------------------------------------- */
1433
1434static int dwc3_gadget_get_frame(struct usb_gadget *g)
1435{
1436 struct dwc3 *dwc = gadget_to_dwc(g);
Felipe Balbi72246da2011-08-19 18:10:58 +03001437
Felipe Balbi6cb2e4e2016-10-21 13:07:09 +03001438 return __dwc3_gadget_get_frame(dwc);
Felipe Balbi72246da2011-08-19 18:10:58 +03001439}
1440
Felipe Balbi218ef7b2016-04-04 11:24:04 +03001441static int __dwc3_gadget_wakeup(struct dwc3 *dwc)
Felipe Balbi72246da2011-08-19 18:10:58 +03001442{
Nicolas Saenz Julienned6011f62016-08-16 10:22:38 +01001443 int retries;
Felipe Balbi72246da2011-08-19 18:10:58 +03001444
Felipe Balbi218ef7b2016-04-04 11:24:04 +03001445 int ret;
Felipe Balbi72246da2011-08-19 18:10:58 +03001446 u32 reg;
1447
Felipe Balbi72246da2011-08-19 18:10:58 +03001448 u8 link_state;
1449 u8 speed;
1450
Felipe Balbi72246da2011-08-19 18:10:58 +03001451 /*
1452 * According to the Databook Remote wakeup request should
1453 * be issued only when the device is in early suspend state.
1454 *
1455 * We can check that via USB Link State bits in DSTS register.
1456 */
1457 reg = dwc3_readl(dwc->regs, DWC3_DSTS);
1458
1459 speed = reg & DWC3_DSTS_CONNECTSPD;
John Younee5cd412016-02-05 17:08:45 -08001460 if ((speed == DWC3_DSTS_SUPERSPEED) ||
Felipe Balbi5eb30ce2016-11-03 14:07:51 +02001461 (speed == DWC3_DSTS_SUPERSPEED_PLUS))
Felipe Balbi6b742892016-05-13 10:19:42 +03001462 return 0;
Felipe Balbi72246da2011-08-19 18:10:58 +03001463
1464 link_state = DWC3_DSTS_USBLNKST(reg);
1465
1466 switch (link_state) {
1467 case DWC3_LINK_STATE_RX_DET: /* in HS, means Early Suspend */
1468 case DWC3_LINK_STATE_U3: /* in HS, means SUSPEND */
1469 break;
1470 default:
Felipe Balbi218ef7b2016-04-04 11:24:04 +03001471 return -EINVAL;
Felipe Balbi72246da2011-08-19 18:10:58 +03001472 }
1473
Felipe Balbi8598bde2012-01-02 18:55:57 +02001474 ret = dwc3_gadget_set_link_state(dwc, DWC3_LINK_STATE_RECOV);
1475 if (ret < 0) {
1476 dev_err(dwc->dev, "failed to put link in Recovery\n");
Felipe Balbi218ef7b2016-04-04 11:24:04 +03001477 return ret;
Felipe Balbi8598bde2012-01-02 18:55:57 +02001478 }
Felipe Balbi72246da2011-08-19 18:10:58 +03001479
Paul Zimmerman802fde92012-04-27 13:10:52 +03001480 /* Recent versions do this automatically */
1481 if (dwc->revision < DWC3_REVISION_194A) {
1482 /* write zeroes to Link Change Request */
Felipe Balbifcc023c2012-05-24 10:27:56 +03001483 reg = dwc3_readl(dwc->regs, DWC3_DCTL);
Paul Zimmerman802fde92012-04-27 13:10:52 +03001484 reg &= ~DWC3_DCTL_ULSTCHNGREQ_MASK;
1485 dwc3_writel(dwc->regs, DWC3_DCTL, reg);
1486 }
Felipe Balbi72246da2011-08-19 18:10:58 +03001487
Paul Zimmerman1d046792012-02-15 18:56:56 -08001488 /* poll until Link State changes to ON */
Nicolas Saenz Julienned6011f62016-08-16 10:22:38 +01001489 retries = 20000;
Felipe Balbi72246da2011-08-19 18:10:58 +03001490
Nicolas Saenz Julienned6011f62016-08-16 10:22:38 +01001491 while (retries--) {
Felipe Balbi72246da2011-08-19 18:10:58 +03001492 reg = dwc3_readl(dwc->regs, DWC3_DSTS);
1493
1494 /* in HS, means ON */
1495 if (DWC3_DSTS_USBLNKST(reg) == DWC3_LINK_STATE_U0)
1496 break;
1497 }
1498
1499 if (DWC3_DSTS_USBLNKST(reg) != DWC3_LINK_STATE_U0) {
1500 dev_err(dwc->dev, "failed to send remote wakeup\n");
Felipe Balbi218ef7b2016-04-04 11:24:04 +03001501 return -EINVAL;
Felipe Balbi72246da2011-08-19 18:10:58 +03001502 }
1503
Felipe Balbi218ef7b2016-04-04 11:24:04 +03001504 return 0;
1505}
1506
1507static int dwc3_gadget_wakeup(struct usb_gadget *g)
1508{
1509 struct dwc3 *dwc = gadget_to_dwc(g);
1510 unsigned long flags;
1511 int ret;
1512
1513 spin_lock_irqsave(&dwc->lock, flags);
1514 ret = __dwc3_gadget_wakeup(dwc);
Felipe Balbi72246da2011-08-19 18:10:58 +03001515 spin_unlock_irqrestore(&dwc->lock, flags);
1516
1517 return ret;
1518}
1519
1520static int dwc3_gadget_set_selfpowered(struct usb_gadget *g,
1521 int is_selfpowered)
1522{
1523 struct dwc3 *dwc = gadget_to_dwc(g);
Paul Zimmerman249a4562012-02-24 17:32:16 -08001524 unsigned long flags;
Felipe Balbi72246da2011-08-19 18:10:58 +03001525
Paul Zimmerman249a4562012-02-24 17:32:16 -08001526 spin_lock_irqsave(&dwc->lock, flags);
Peter Chenbcdea502015-01-28 16:32:40 +08001527 g->is_selfpowered = !!is_selfpowered;
Paul Zimmerman249a4562012-02-24 17:32:16 -08001528 spin_unlock_irqrestore(&dwc->lock, flags);
Felipe Balbi72246da2011-08-19 18:10:58 +03001529
1530 return 0;
1531}
1532
Felipe Balbi7b2a0362013-12-19 13:43:19 -06001533static int dwc3_gadget_run_stop(struct dwc3 *dwc, int is_on, int suspend)
Felipe Balbi72246da2011-08-19 18:10:58 +03001534{
1535 u32 reg;
Sebastian Andrzej Siewior61d58242011-08-29 16:46:38 +02001536 u32 timeout = 500;
Felipe Balbi72246da2011-08-19 18:10:58 +03001537
Felipe Balbifc8bb912016-05-16 13:14:48 +03001538 if (pm_runtime_suspended(dwc->dev))
1539 return 0;
1540
Felipe Balbi72246da2011-08-19 18:10:58 +03001541 reg = dwc3_readl(dwc->regs, DWC3_DCTL);
Felipe Balbi8db7ed12012-01-18 18:32:29 +02001542 if (is_on) {
Paul Zimmerman802fde92012-04-27 13:10:52 +03001543 if (dwc->revision <= DWC3_REVISION_187A) {
1544 reg &= ~DWC3_DCTL_TRGTULST_MASK;
1545 reg |= DWC3_DCTL_TRGTULST_RX_DET;
1546 }
1547
1548 if (dwc->revision >= DWC3_REVISION_194A)
1549 reg &= ~DWC3_DCTL_KEEP_CONNECT;
1550 reg |= DWC3_DCTL_RUN_STOP;
Felipe Balbi7b2a0362013-12-19 13:43:19 -06001551
1552 if (dwc->has_hibernation)
1553 reg |= DWC3_DCTL_KEEP_CONNECT;
1554
Felipe Balbi9fcb3bd2013-02-08 17:55:58 +02001555 dwc->pullups_connected = true;
Felipe Balbi8db7ed12012-01-18 18:32:29 +02001556 } else {
Felipe Balbi72246da2011-08-19 18:10:58 +03001557 reg &= ~DWC3_DCTL_RUN_STOP;
Felipe Balbi7b2a0362013-12-19 13:43:19 -06001558
1559 if (dwc->has_hibernation && !suspend)
1560 reg &= ~DWC3_DCTL_KEEP_CONNECT;
1561
Felipe Balbi9fcb3bd2013-02-08 17:55:58 +02001562 dwc->pullups_connected = false;
Felipe Balbi8db7ed12012-01-18 18:32:29 +02001563 }
Felipe Balbi72246da2011-08-19 18:10:58 +03001564
1565 dwc3_writel(dwc->regs, DWC3_DCTL, reg);
1566
1567 do {
1568 reg = dwc3_readl(dwc->regs, DWC3_DSTS);
Felipe Balbib6d4e162016-06-09 16:47:05 +03001569 reg &= DWC3_DSTS_DEVCTRLHLT;
1570 } while (--timeout && !(!is_on ^ !reg));
Felipe Balbif2df6792016-06-09 16:31:34 +03001571
1572 if (!timeout)
1573 return -ETIMEDOUT;
Felipe Balbi72246da2011-08-19 18:10:58 +03001574
Pratyush Anand6f17f742012-07-02 10:21:55 +05301575 return 0;
Felipe Balbi72246da2011-08-19 18:10:58 +03001576}
1577
1578static int dwc3_gadget_pullup(struct usb_gadget *g, int is_on)
1579{
1580 struct dwc3 *dwc = gadget_to_dwc(g);
1581 unsigned long flags;
Pratyush Anand6f17f742012-07-02 10:21:55 +05301582 int ret;
Felipe Balbi72246da2011-08-19 18:10:58 +03001583
1584 is_on = !!is_on;
1585
Baolin Wangbb014732016-10-14 17:11:33 +08001586 /*
1587 * Per databook, when we want to stop the gadget, if a control transfer
1588 * is still in process, complete it and get the core into setup phase.
1589 */
1590 if (!is_on && dwc->ep0state != EP0_SETUP_PHASE) {
1591 reinit_completion(&dwc->ep0_in_setup);
1592
1593 ret = wait_for_completion_timeout(&dwc->ep0_in_setup,
1594 msecs_to_jiffies(DWC3_PULL_UP_TIMEOUT));
1595 if (ret == 0) {
1596 dev_err(dwc->dev, "timed out waiting for SETUP phase\n");
1597 return -ETIMEDOUT;
1598 }
1599 }
1600
Felipe Balbi72246da2011-08-19 18:10:58 +03001601 spin_lock_irqsave(&dwc->lock, flags);
Felipe Balbi7b2a0362013-12-19 13:43:19 -06001602 ret = dwc3_gadget_run_stop(dwc, is_on, false);
Felipe Balbi72246da2011-08-19 18:10:58 +03001603 spin_unlock_irqrestore(&dwc->lock, flags);
1604
Pratyush Anand6f17f742012-07-02 10:21:55 +05301605 return ret;
Felipe Balbi72246da2011-08-19 18:10:58 +03001606}
1607
Felipe Balbi8698e2a2013-02-08 15:24:04 +02001608static void dwc3_gadget_enable_irq(struct dwc3 *dwc)
1609{
1610 u32 reg;
1611
1612 /* Enable all but Start and End of Frame IRQs */
1613 reg = (DWC3_DEVTEN_VNDRDEVTSTRCVEDEN |
1614 DWC3_DEVTEN_EVNTOVERFLOWEN |
1615 DWC3_DEVTEN_CMDCMPLTEN |
1616 DWC3_DEVTEN_ERRTICERREN |
1617 DWC3_DEVTEN_WKUPEVTEN |
Felipe Balbi8698e2a2013-02-08 15:24:04 +02001618 DWC3_DEVTEN_CONNECTDONEEN |
1619 DWC3_DEVTEN_USBRSTEN |
1620 DWC3_DEVTEN_DISCONNEVTEN);
1621
Felipe Balbi799e9dc2016-09-23 11:20:40 +03001622 if (dwc->revision < DWC3_REVISION_250A)
1623 reg |= DWC3_DEVTEN_ULSTCNGEN;
1624
Felipe Balbi8698e2a2013-02-08 15:24:04 +02001625 dwc3_writel(dwc->regs, DWC3_DEVTEN, reg);
1626}
1627
1628static void dwc3_gadget_disable_irq(struct dwc3 *dwc)
1629{
1630 /* mask all interrupts */
1631 dwc3_writel(dwc->regs, DWC3_DEVTEN, 0x00);
1632}
1633
1634static irqreturn_t dwc3_interrupt(int irq, void *_dwc);
Felipe Balbib15a7622011-06-30 16:57:15 +03001635static irqreturn_t dwc3_thread_interrupt(int irq, void *_dwc);
Felipe Balbi8698e2a2013-02-08 15:24:04 +02001636
Felipe Balbi4e994722016-05-13 14:09:59 +03001637/**
1638 * dwc3_gadget_setup_nump - Calculate and initialize NUMP field of DCFG
1639 * dwc: pointer to our context structure
1640 *
1641 * The following looks like complex but it's actually very simple. In order to
1642 * calculate the number of packets we can burst at once on OUT transfers, we're
1643 * gonna use RxFIFO size.
1644 *
1645 * To calculate RxFIFO size we need two numbers:
1646 * MDWIDTH = size, in bits, of the internal memory bus
1647 * RAM2_DEPTH = depth, in MDWIDTH, of internal RAM2 (where RxFIFO sits)
1648 *
1649 * Given these two numbers, the formula is simple:
1650 *
1651 * RxFIFO Size = (RAM2_DEPTH * MDWIDTH / 8) - 24 - 16;
1652 *
1653 * 24 bytes is for 3x SETUP packets
1654 * 16 bytes is a clock domain crossing tolerance
1655 *
1656 * Given RxFIFO Size, NUMP = RxFIFOSize / 1024;
1657 */
1658static void dwc3_gadget_setup_nump(struct dwc3 *dwc)
1659{
1660 u32 ram2_depth;
1661 u32 mdwidth;
1662 u32 nump;
1663 u32 reg;
1664
1665 ram2_depth = DWC3_GHWPARAMS7_RAM2_DEPTH(dwc->hwparams.hwparams7);
1666 mdwidth = DWC3_GHWPARAMS0_MDWIDTH(dwc->hwparams.hwparams0);
1667
1668 nump = ((ram2_depth * mdwidth / 8) - 24 - 16) / 1024;
1669 nump = min_t(u32, nump, 16);
1670
1671 /* update NumP */
1672 reg = dwc3_readl(dwc->regs, DWC3_DCFG);
1673 reg &= ~DWC3_DCFG_NUMP_MASK;
1674 reg |= nump << DWC3_DCFG_NUMP_SHIFT;
1675 dwc3_writel(dwc->regs, DWC3_DCFG, reg);
1676}
1677
Felipe Balbid7be2952016-05-04 15:49:37 +03001678static int __dwc3_gadget_start(struct dwc3 *dwc)
Felipe Balbi72246da2011-08-19 18:10:58 +03001679{
Felipe Balbi72246da2011-08-19 18:10:58 +03001680 struct dwc3_ep *dep;
Felipe Balbi72246da2011-08-19 18:10:58 +03001681 int ret = 0;
1682 u32 reg;
1683
Felipe Balbi72246da2011-08-19 18:10:58 +03001684 reg = dwc3_readl(dwc->regs, DWC3_DCFG);
1685 reg &= ~(DWC3_DCFG_SPEED_MASK);
Felipe Balbi07e7f472012-03-23 12:20:31 +02001686
1687 /**
1688 * WORKAROUND: DWC3 revision < 2.20a have an issue
1689 * which would cause metastability state on Run/Stop
1690 * bit if we try to force the IP to USB2-only mode.
1691 *
1692 * Because of that, we cannot configure the IP to any
1693 * speed other than the SuperSpeed
1694 *
1695 * Refers to:
1696 *
1697 * STAR#9000525659: Clock Domain Crossing on DCTL in
1698 * USB 2.0 Mode
1699 */
Felipe Balbif7e846f2013-06-30 14:29:51 +03001700 if (dwc->revision < DWC3_REVISION_220A) {
Felipe Balbi07e7f472012-03-23 12:20:31 +02001701 reg |= DWC3_DCFG_SUPERSPEED;
Felipe Balbif7e846f2013-06-30 14:29:51 +03001702 } else {
1703 switch (dwc->maximum_speed) {
1704 case USB_SPEED_LOW:
John Youn2da9ad72016-05-20 16:34:26 -07001705 reg |= DWC3_DCFG_LOWSPEED;
Felipe Balbif7e846f2013-06-30 14:29:51 +03001706 break;
1707 case USB_SPEED_FULL:
John Youn2da9ad72016-05-20 16:34:26 -07001708 reg |= DWC3_DCFG_FULLSPEED1;
Felipe Balbif7e846f2013-06-30 14:29:51 +03001709 break;
1710 case USB_SPEED_HIGH:
John Youn2da9ad72016-05-20 16:34:26 -07001711 reg |= DWC3_DCFG_HIGHSPEED;
Felipe Balbif7e846f2013-06-30 14:29:51 +03001712 break;
John Youn75808622016-02-05 17:09:13 -08001713 case USB_SPEED_SUPER_PLUS:
John Youn2da9ad72016-05-20 16:34:26 -07001714 reg |= DWC3_DCFG_SUPERSPEED_PLUS;
John Youn75808622016-02-05 17:09:13 -08001715 break;
Felipe Balbif7e846f2013-06-30 14:29:51 +03001716 default:
John Youn77966eb2016-02-19 17:31:01 -08001717 dev_err(dwc->dev, "invalid dwc->maximum_speed (%d)\n",
1718 dwc->maximum_speed);
1719 /* fall through */
1720 case USB_SPEED_SUPER:
1721 reg |= DWC3_DCFG_SUPERSPEED;
1722 break;
Felipe Balbif7e846f2013-06-30 14:29:51 +03001723 }
1724 }
Felipe Balbi72246da2011-08-19 18:10:58 +03001725 dwc3_writel(dwc->regs, DWC3_DCFG, reg);
1726
Felipe Balbi2a58f9c2016-04-28 10:56:28 +03001727 /*
1728 * We are telling dwc3 that we want to use DCFG.NUMP as ACK TP's NUMP
1729 * field instead of letting dwc3 itself calculate that automatically.
1730 *
1731 * This way, we maximize the chances that we'll be able to get several
1732 * bursts of data without going through any sort of endpoint throttling.
1733 */
1734 reg = dwc3_readl(dwc->regs, DWC3_GRXTHRCFG);
1735 reg &= ~DWC3_GRXTHRCFG_PKTCNTSEL;
1736 dwc3_writel(dwc->regs, DWC3_GRXTHRCFG, reg);
1737
Felipe Balbi4e994722016-05-13 14:09:59 +03001738 dwc3_gadget_setup_nump(dwc);
1739
Felipe Balbi72246da2011-08-19 18:10:58 +03001740 /* Start with SuperSpeed Default */
1741 dwc3_gadget_ep0_desc.wMaxPacketSize = cpu_to_le16(512);
1742
1743 dep = dwc->eps[0];
Paul Zimmerman265b70a2013-12-19 12:38:49 -06001744 ret = __dwc3_gadget_ep_enable(dep, &dwc3_gadget_ep0_desc, NULL, false,
1745 false);
Felipe Balbi72246da2011-08-19 18:10:58 +03001746 if (ret) {
1747 dev_err(dwc->dev, "failed to enable %s\n", dep->name);
Felipe Balbid7be2952016-05-04 15:49:37 +03001748 goto err0;
Felipe Balbi72246da2011-08-19 18:10:58 +03001749 }
1750
1751 dep = dwc->eps[1];
Paul Zimmerman265b70a2013-12-19 12:38:49 -06001752 ret = __dwc3_gadget_ep_enable(dep, &dwc3_gadget_ep0_desc, NULL, false,
1753 false);
Felipe Balbi72246da2011-08-19 18:10:58 +03001754 if (ret) {
1755 dev_err(dwc->dev, "failed to enable %s\n", dep->name);
Felipe Balbid7be2952016-05-04 15:49:37 +03001756 goto err1;
Felipe Balbi72246da2011-08-19 18:10:58 +03001757 }
1758
1759 /* begin to receive SETUP packets */
Felipe Balbic7fcdeb2011-08-27 22:28:36 +03001760 dwc->ep0state = EP0_SETUP_PHASE;
Felipe Balbi72246da2011-08-19 18:10:58 +03001761 dwc3_ep0_out_start(dwc);
1762
Felipe Balbi8698e2a2013-02-08 15:24:04 +02001763 dwc3_gadget_enable_irq(dwc);
1764
Felipe Balbid7be2952016-05-04 15:49:37 +03001765 return 0;
1766
1767err1:
1768 __dwc3_gadget_ep_disable(dwc->eps[0]);
1769
1770err0:
1771 return ret;
1772}
1773
1774static int dwc3_gadget_start(struct usb_gadget *g,
1775 struct usb_gadget_driver *driver)
1776{
1777 struct dwc3 *dwc = gadget_to_dwc(g);
1778 unsigned long flags;
1779 int ret = 0;
1780 int irq;
1781
Roger Quadros9522def2016-06-10 14:48:38 +03001782 irq = dwc->irq_gadget;
Felipe Balbid7be2952016-05-04 15:49:37 +03001783 ret = request_threaded_irq(irq, dwc3_interrupt, dwc3_thread_interrupt,
1784 IRQF_SHARED, "dwc3", dwc->ev_buf);
1785 if (ret) {
1786 dev_err(dwc->dev, "failed to request irq #%d --> %d\n",
1787 irq, ret);
1788 goto err0;
1789 }
1790
1791 spin_lock_irqsave(&dwc->lock, flags);
1792 if (dwc->gadget_driver) {
1793 dev_err(dwc->dev, "%s is already bound to %s\n",
1794 dwc->gadget.name,
1795 dwc->gadget_driver->driver.name);
1796 ret = -EBUSY;
1797 goto err1;
1798 }
1799
1800 dwc->gadget_driver = driver;
1801
Felipe Balbifc8bb912016-05-16 13:14:48 +03001802 if (pm_runtime_active(dwc->dev))
1803 __dwc3_gadget_start(dwc);
1804
Felipe Balbi72246da2011-08-19 18:10:58 +03001805 spin_unlock_irqrestore(&dwc->lock, flags);
1806
1807 return 0;
1808
Felipe Balbib0d7ffd2013-06-27 10:00:18 +03001809err1:
Felipe Balbi72246da2011-08-19 18:10:58 +03001810 spin_unlock_irqrestore(&dwc->lock, flags);
Felipe Balbid7be2952016-05-04 15:49:37 +03001811 free_irq(irq, dwc);
Felipe Balbib0d7ffd2013-06-27 10:00:18 +03001812
1813err0:
Felipe Balbi72246da2011-08-19 18:10:58 +03001814 return ret;
1815}
1816
Felipe Balbid7be2952016-05-04 15:49:37 +03001817static void __dwc3_gadget_stop(struct dwc3 *dwc)
1818{
1819 dwc3_gadget_disable_irq(dwc);
1820 __dwc3_gadget_ep_disable(dwc->eps[0]);
1821 __dwc3_gadget_ep_disable(dwc->eps[1]);
1822}
1823
Felipe Balbi22835b82014-10-17 12:05:12 -05001824static int dwc3_gadget_stop(struct usb_gadget *g)
Felipe Balbi72246da2011-08-19 18:10:58 +03001825{
1826 struct dwc3 *dwc = gadget_to_dwc(g);
1827 unsigned long flags;
Baolin Wang76a638f2016-10-31 19:38:36 +08001828 int epnum;
Felipe Balbi72246da2011-08-19 18:10:58 +03001829
1830 spin_lock_irqsave(&dwc->lock, flags);
Baolin Wang76a638f2016-10-31 19:38:36 +08001831
1832 if (pm_runtime_suspended(dwc->dev))
1833 goto out;
1834
Felipe Balbid7be2952016-05-04 15:49:37 +03001835 __dwc3_gadget_stop(dwc);
Baolin Wang76a638f2016-10-31 19:38:36 +08001836
1837 for (epnum = 2; epnum < DWC3_ENDPOINTS_NUM; epnum++) {
1838 struct dwc3_ep *dep = dwc->eps[epnum];
1839
1840 if (!dep)
1841 continue;
1842
1843 if (!(dep->flags & DWC3_EP_END_TRANSFER_PENDING))
1844 continue;
1845
1846 wait_event_lock_irq(dep->wait_end_transfer,
1847 !(dep->flags & DWC3_EP_END_TRANSFER_PENDING),
1848 dwc->lock);
1849 }
1850
1851out:
Felipe Balbi72246da2011-08-19 18:10:58 +03001852 dwc->gadget_driver = NULL;
Felipe Balbi72246da2011-08-19 18:10:58 +03001853 spin_unlock_irqrestore(&dwc->lock, flags);
1854
Felipe Balbi3f308d12016-05-16 14:17:06 +03001855 free_irq(dwc->irq_gadget, dwc->ev_buf);
Felipe Balbib0d7ffd2013-06-27 10:00:18 +03001856
Felipe Balbi72246da2011-08-19 18:10:58 +03001857 return 0;
1858}
Paul Zimmerman802fde92012-04-27 13:10:52 +03001859
Felipe Balbi72246da2011-08-19 18:10:58 +03001860static const struct usb_gadget_ops dwc3_gadget_ops = {
1861 .get_frame = dwc3_gadget_get_frame,
1862 .wakeup = dwc3_gadget_wakeup,
1863 .set_selfpowered = dwc3_gadget_set_selfpowered,
1864 .pullup = dwc3_gadget_pullup,
1865 .udc_start = dwc3_gadget_start,
1866 .udc_stop = dwc3_gadget_stop,
1867};
1868
1869/* -------------------------------------------------------------------------- */
1870
Felipe Balbi6a1e3ef2011-05-05 16:21:59 +03001871static int dwc3_gadget_init_hw_endpoints(struct dwc3 *dwc,
1872 u8 num, u32 direction)
Felipe Balbi72246da2011-08-19 18:10:58 +03001873{
1874 struct dwc3_ep *dep;
Felipe Balbi6a1e3ef2011-05-05 16:21:59 +03001875 u8 i;
Felipe Balbi72246da2011-08-19 18:10:58 +03001876
Felipe Balbi6a1e3ef2011-05-05 16:21:59 +03001877 for (i = 0; i < num; i++) {
John Yound07fa662016-05-23 11:32:43 -07001878 u8 epnum = (i << 1) | (direction ? 1 : 0);
Felipe Balbi72246da2011-08-19 18:10:58 +03001879
Felipe Balbi72246da2011-08-19 18:10:58 +03001880 dep = kzalloc(sizeof(*dep), GFP_KERNEL);
Jingoo Han734d5a52014-07-17 12:45:11 +09001881 if (!dep)
Felipe Balbi72246da2011-08-19 18:10:58 +03001882 return -ENOMEM;
Felipe Balbi72246da2011-08-19 18:10:58 +03001883
1884 dep->dwc = dwc;
1885 dep->number = epnum;
Felipe Balbi9aa62ae2013-07-12 19:10:59 +03001886 dep->direction = !!direction;
Felipe Balbi2eb88012016-04-12 16:53:39 +03001887 dep->regs = dwc->regs + DWC3_DEP_BASE(epnum);
Felipe Balbi72246da2011-08-19 18:10:58 +03001888 dwc->eps[epnum] = dep;
1889
1890 snprintf(dep->name, sizeof(dep->name), "ep%d%s", epnum >> 1,
1891 (epnum & 1) ? "in" : "out");
Felipe Balbi6a1e3ef2011-05-05 16:21:59 +03001892
Felipe Balbi72246da2011-08-19 18:10:58 +03001893 dep->endpoint.name = dep->name;
Felipe Balbi74674cb2016-04-13 16:44:39 +03001894 spin_lock_init(&dep->lock);
Felipe Balbi72246da2011-08-19 18:10:58 +03001895
1896 if (epnum == 0 || epnum == 1) {
Robert Baldygae117e742013-12-13 12:23:38 +01001897 usb_ep_set_maxpacket_limit(&dep->endpoint, 512);
Pratyush Anand6048e4c2013-01-18 16:53:56 +05301898 dep->endpoint.maxburst = 1;
Felipe Balbi72246da2011-08-19 18:10:58 +03001899 dep->endpoint.ops = &dwc3_gadget_ep0_ops;
1900 if (!epnum)
1901 dwc->gadget.ep0 = &dep->endpoint;
1902 } else {
1903 int ret;
1904
Robert Baldygae117e742013-12-13 12:23:38 +01001905 usb_ep_set_maxpacket_limit(&dep->endpoint, 1024);
Sebastian Andrzej Siewior12d36c12011-11-03 20:27:50 +01001906 dep->endpoint.max_streams = 15;
Felipe Balbi72246da2011-08-19 18:10:58 +03001907 dep->endpoint.ops = &dwc3_gadget_ep_ops;
1908 list_add_tail(&dep->endpoint.ep_list,
1909 &dwc->gadget.ep_list);
1910
1911 ret = dwc3_alloc_trb_pool(dep);
Felipe Balbi25b8ff62011-11-04 12:32:47 +02001912 if (ret)
Felipe Balbi72246da2011-08-19 18:10:58 +03001913 return ret;
Felipe Balbi72246da2011-08-19 18:10:58 +03001914 }
Felipe Balbi25b8ff62011-11-04 12:32:47 +02001915
Robert Baldygaa474d3b2015-07-31 16:00:19 +02001916 if (epnum == 0 || epnum == 1) {
1917 dep->endpoint.caps.type_control = true;
1918 } else {
1919 dep->endpoint.caps.type_iso = true;
1920 dep->endpoint.caps.type_bulk = true;
1921 dep->endpoint.caps.type_int = true;
1922 }
1923
1924 dep->endpoint.caps.dir_in = !!direction;
1925 dep->endpoint.caps.dir_out = !direction;
1926
Felipe Balbiaa3342c2016-03-14 11:01:31 +02001927 INIT_LIST_HEAD(&dep->pending_list);
1928 INIT_LIST_HEAD(&dep->started_list);
Felipe Balbi72246da2011-08-19 18:10:58 +03001929 }
1930
1931 return 0;
1932}
1933
Felipe Balbi6a1e3ef2011-05-05 16:21:59 +03001934static int dwc3_gadget_init_endpoints(struct dwc3 *dwc)
1935{
1936 int ret;
1937
1938 INIT_LIST_HEAD(&dwc->gadget.ep_list);
1939
1940 ret = dwc3_gadget_init_hw_endpoints(dwc, dwc->num_out_eps, 0);
1941 if (ret < 0) {
Felipe Balbi5eb30ce2016-11-03 14:07:51 +02001942 dev_err(dwc->dev, "failed to initialize OUT endpoints\n");
Felipe Balbi6a1e3ef2011-05-05 16:21:59 +03001943 return ret;
1944 }
1945
1946 ret = dwc3_gadget_init_hw_endpoints(dwc, dwc->num_in_eps, 1);
1947 if (ret < 0) {
Felipe Balbi5eb30ce2016-11-03 14:07:51 +02001948 dev_err(dwc->dev, "failed to initialize IN endpoints\n");
Felipe Balbi6a1e3ef2011-05-05 16:21:59 +03001949 return ret;
1950 }
1951
1952 return 0;
1953}
1954
Felipe Balbi72246da2011-08-19 18:10:58 +03001955static void dwc3_gadget_free_endpoints(struct dwc3 *dwc)
1956{
1957 struct dwc3_ep *dep;
1958 u8 epnum;
1959
1960 for (epnum = 0; epnum < DWC3_ENDPOINTS_NUM; epnum++) {
1961 dep = dwc->eps[epnum];
Felipe Balbi6a1e3ef2011-05-05 16:21:59 +03001962 if (!dep)
1963 continue;
George Cherian5bf8fae2013-05-27 14:35:49 +05301964 /*
1965 * Physical endpoints 0 and 1 are special; they form the
1966 * bi-directional USB endpoint 0.
1967 *
1968 * For those two physical endpoints, we don't allocate a TRB
1969 * pool nor do we add them the endpoints list. Due to that, we
1970 * shouldn't do these two operations otherwise we would end up
1971 * with all sorts of bugs when removing dwc3.ko.
1972 */
1973 if (epnum != 0 && epnum != 1) {
1974 dwc3_free_trb_pool(dep);
Felipe Balbi72246da2011-08-19 18:10:58 +03001975 list_del(&dep->endpoint.ep_list);
George Cherian5bf8fae2013-05-27 14:35:49 +05301976 }
Felipe Balbi72246da2011-08-19 18:10:58 +03001977
1978 kfree(dep);
1979 }
1980}
1981
Felipe Balbi72246da2011-08-19 18:10:58 +03001982/* -------------------------------------------------------------------------- */
Felipe Balbie5caff62013-02-26 15:11:05 +02001983
Pratyush Anande5ba5ec2013-01-14 15:59:37 +05301984static int __dwc3_cleanup_done_trbs(struct dwc3 *dwc, struct dwc3_ep *dep,
1985 struct dwc3_request *req, struct dwc3_trb *trb,
Felipe Balbie5b36ae2016-08-10 11:13:26 +03001986 const struct dwc3_event_depevt *event, int status,
1987 int chain)
Pratyush Anande5ba5ec2013-01-14 15:59:37 +05301988{
1989 unsigned int count;
1990 unsigned int s_pkt = 0;
1991 unsigned int trb_status;
1992
Felipe Balbidc55c672016-08-12 13:20:32 +03001993 dwc3_ep_inc_deq(dep);
Felipe Balbia9c3ca52016-10-05 14:24:37 +03001994
1995 if (req->trb == trb)
1996 dep->queued_requests--;
1997
Felipe Balbi2c4cbe6e52014-04-30 17:45:10 -05001998 trace_dwc3_complete_trb(dep, trb);
1999
Felipe Balbie5b36ae2016-08-10 11:13:26 +03002000 /*
2001 * If we're in the middle of series of chained TRBs and we
2002 * receive a short transfer along the way, DWC3 will skip
2003 * through all TRBs including the last TRB in the chain (the
2004 * where CHN bit is zero. DWC3 will also avoid clearing HWO
2005 * bit and SW has to do it manually.
2006 *
2007 * We're going to do that here to avoid problems of HW trying
2008 * to use bogus TRBs for transfers.
2009 */
2010 if (chain && (trb->ctrl & DWC3_TRB_CTRL_HWO))
2011 trb->ctrl &= ~DWC3_TRB_CTRL_HWO;
2012
Pratyush Anande5ba5ec2013-01-14 15:59:37 +05302013 if ((trb->ctrl & DWC3_TRB_CTRL_HWO) && status != -ESHUTDOWN)
Felipe Balbia0ad85a2016-08-10 18:07:46 +03002014 return 1;
Felipe Balbie5b36ae2016-08-10 11:13:26 +03002015
Pratyush Anande5ba5ec2013-01-14 15:59:37 +05302016 count = trb->size & DWC3_TRB_SIZE_MASK;
Felipe Balbie62c5bc52016-10-25 13:47:21 +03002017 req->remaining += count;
Pratyush Anande5ba5ec2013-01-14 15:59:37 +05302018
2019 if (dep->direction) {
2020 if (count) {
2021 trb_status = DWC3_TRB_SIZE_TRBSTS(trb->size);
2022 if (trb_status == DWC3_TRBSTS_MISSED_ISOC) {
Pratyush Anande5ba5ec2013-01-14 15:59:37 +05302023 /*
2024 * If missed isoc occurred and there is
2025 * no request queued then issue END
2026 * TRANSFER, so that core generates
2027 * next xfernotready and we will issue
2028 * a fresh START TRANSFER.
2029 * If there are still queued request
2030 * then wait, do not issue either END
2031 * or UPDATE TRANSFER, just attach next
Felipe Balbiaa3342c2016-03-14 11:01:31 +02002032 * request in pending_list during
Pratyush Anande5ba5ec2013-01-14 15:59:37 +05302033 * giveback.If any future queued request
2034 * is successfully transferred then we
2035 * will issue UPDATE TRANSFER for all
Felipe Balbiaa3342c2016-03-14 11:01:31 +02002036 * request in the pending_list.
Pratyush Anande5ba5ec2013-01-14 15:59:37 +05302037 */
2038 dep->flags |= DWC3_EP_MISSED_ISOC;
2039 } else {
2040 dev_err(dwc->dev, "incomplete IN transfer %s\n",
2041 dep->name);
2042 status = -ECONNRESET;
2043 }
2044 } else {
2045 dep->flags &= ~DWC3_EP_MISSED_ISOC;
2046 }
2047 } else {
2048 if (count && (event->status & DEPEVT_STATUS_SHORT))
2049 s_pkt = 1;
2050 }
2051
Felipe Balbi7c705df2016-08-10 12:35:30 +03002052 if (s_pkt && !chain)
Pratyush Anande5ba5ec2013-01-14 15:59:37 +05302053 return 1;
Felipe Balbif99f53f2016-08-12 13:19:20 +03002054
Pratyush Anande5ba5ec2013-01-14 15:59:37 +05302055 if ((event->status & DEPEVT_STATUS_IOC) &&
2056 (trb->ctrl & DWC3_TRB_CTRL_IOC))
2057 return 1;
Felipe Balbif99f53f2016-08-12 13:19:20 +03002058
Pratyush Anande5ba5ec2013-01-14 15:59:37 +05302059 return 0;
2060}
2061
Felipe Balbi72246da2011-08-19 18:10:58 +03002062static int dwc3_cleanup_done_reqs(struct dwc3 *dwc, struct dwc3_ep *dep,
2063 const struct dwc3_event_depevt *event, int status)
2064{
Felipe Balbi31162af2016-08-11 14:38:37 +03002065 struct dwc3_request *req, *n;
Felipe Balbif6bafc62012-02-06 11:04:53 +02002066 struct dwc3_trb *trb;
Arnd Bergmannd6e10bf2016-09-09 12:01:51 +02002067 bool ioc = false;
Felipe Balbie62c5bc52016-10-25 13:47:21 +03002068 int ret = 0;
Felipe Balbi72246da2011-08-19 18:10:58 +03002069
Felipe Balbi31162af2016-08-11 14:38:37 +03002070 list_for_each_entry_safe(req, n, &dep->started_list, list) {
Felipe Balbi1f512112016-08-12 13:17:27 +03002071 unsigned length;
Felipe Balbie5b36ae2016-08-10 11:13:26 +03002072 int chain;
2073
Felipe Balbi1f512112016-08-12 13:17:27 +03002074 length = req->request.length;
2075 chain = req->num_pending_sgs > 0;
Felipe Balbi31162af2016-08-11 14:38:37 +03002076 if (chain) {
Felipe Balbi1f512112016-08-12 13:17:27 +03002077 struct scatterlist *sg = req->sg;
Felipe Balbi31162af2016-08-11 14:38:37 +03002078 struct scatterlist *s;
Felipe Balbi1f512112016-08-12 13:17:27 +03002079 unsigned int pending = req->num_pending_sgs;
Felipe Balbi31162af2016-08-11 14:38:37 +03002080 unsigned int i;
Felipe Balbiac7bdcc2015-11-16 16:13:57 -06002081
Felipe Balbi1f512112016-08-12 13:17:27 +03002082 for_each_sg(sg, s, pending, i) {
Felipe Balbi31162af2016-08-11 14:38:37 +03002083 trb = &dep->trb_pool[dep->trb_dequeue];
Felipe Balbic7de5732016-07-29 03:17:58 +03002084
Felipe Balbi7282c4e2016-10-25 13:50:46 +03002085 if (trb->ctrl & DWC3_TRB_CTRL_HWO)
2086 break;
2087
Felipe Balbi1f512112016-08-12 13:17:27 +03002088 req->sg = sg_next(s);
2089 req->num_pending_sgs--;
2090
Felipe Balbi31162af2016-08-11 14:38:37 +03002091 ret = __dwc3_cleanup_done_trbs(dwc, dep, req, trb,
2092 event, status, chain);
Felipe Balbi1f512112016-08-12 13:17:27 +03002093 if (ret)
2094 break;
Felipe Balbi31162af2016-08-11 14:38:37 +03002095 }
2096 } else {
Felipe Balbi737f1ae2016-08-11 12:24:27 +03002097 trb = &dep->trb_pool[dep->trb_dequeue];
Ville Syrjäläd115d702015-08-31 19:48:28 +03002098 ret = __dwc3_cleanup_done_trbs(dwc, dep, req, trb,
Felipe Balbie5b36ae2016-08-10 11:13:26 +03002099 event, status, chain);
Felipe Balbi31162af2016-08-11 14:38:37 +03002100 }
Ville Syrjäläd115d702015-08-31 19:48:28 +03002101
Felipe Balbie62c5bc52016-10-25 13:47:21 +03002102 req->request.actual = length - req->remaining;
Felipe Balbi1f512112016-08-12 13:17:27 +03002103
Felipe Balbiff377ae2016-10-25 13:54:00 +03002104 if ((req->request.actual < length) && req->num_pending_sgs)
Felipe Balbi1f512112016-08-12 13:17:27 +03002105 return __dwc3_gadget_kick_transfer(dep, 0);
2106
Ville Syrjäläd115d702015-08-31 19:48:28 +03002107 dwc3_gadget_giveback(dep, req, status);
2108
Arnd Bergmannd6e10bf2016-09-09 12:01:51 +02002109 if (ret) {
2110 if ((event->status & DEPEVT_STATUS_IOC) &&
2111 (trb->ctrl & DWC3_TRB_CTRL_IOC))
2112 ioc = true;
Felipe Balbi72246da2011-08-19 18:10:58 +03002113 break;
Arnd Bergmannd6e10bf2016-09-09 12:01:51 +02002114 }
Felipe Balbi31162af2016-08-11 14:38:37 +03002115 }
Felipe Balbi72246da2011-08-19 18:10:58 +03002116
Felipe Balbi4cb42212016-05-18 12:37:21 +03002117 /*
2118 * Our endpoint might get disabled by another thread during
2119 * dwc3_gadget_giveback(). If that happens, we're just gonna return 1
2120 * early on so DWC3_EP_BUSY flag gets cleared
2121 */
2122 if (!dep->endpoint.desc)
2123 return 1;
2124
Pratyush Anandcdc359d2013-01-14 15:59:34 +05302125 if (usb_endpoint_xfer_isoc(dep->endpoint.desc) &&
Felipe Balbiaa3342c2016-03-14 11:01:31 +02002126 list_empty(&dep->started_list)) {
2127 if (list_empty(&dep->pending_list)) {
Pratyush Anandcdc359d2013-01-14 15:59:34 +05302128 /*
2129 * If there is no entry in request list then do
2130 * not issue END TRANSFER now. Just set PENDING
2131 * flag, so that END TRANSFER is issued when an
2132 * entry is added into request list.
2133 */
2134 dep->flags = DWC3_EP_PENDING_REQUEST;
2135 } else {
Paul Zimmermanb992e682012-04-27 14:17:35 +03002136 dwc3_stop_active_transfer(dwc, dep->number, true);
Pratyush Anandcdc359d2013-01-14 15:59:34 +05302137 dep->flags = DWC3_EP_ENABLED;
2138 }
Pratyush Anand7efea862013-01-14 15:59:32 +05302139 return 1;
2140 }
2141
Arnd Bergmannd6e10bf2016-09-09 12:01:51 +02002142 if (usb_endpoint_xfer_isoc(dep->endpoint.desc) && ioc)
2143 return 0;
2144
Felipe Balbi72246da2011-08-19 18:10:58 +03002145 return 1;
2146}
2147
2148static void dwc3_endpoint_transfer_complete(struct dwc3 *dwc,
Jingoo Han029d97f2014-07-04 15:00:51 +09002149 struct dwc3_ep *dep, const struct dwc3_event_depevt *event)
Felipe Balbi72246da2011-08-19 18:10:58 +03002150{
2151 unsigned status = 0;
2152 int clean_busy;
Felipe Balbie18b7972015-05-29 10:06:38 -05002153 u32 is_xfer_complete;
2154
2155 is_xfer_complete = (event->endpoint_event == DWC3_DEPEVT_XFERCOMPLETE);
Felipe Balbi72246da2011-08-19 18:10:58 +03002156
2157 if (event->status & DEPEVT_STATUS_BUSERR)
2158 status = -ECONNRESET;
2159
Paul Zimmerman1d046792012-02-15 18:56:56 -08002160 clean_busy = dwc3_cleanup_done_reqs(dwc, dep, event, status);
Felipe Balbi4cb42212016-05-18 12:37:21 +03002161 if (clean_busy && (!dep->endpoint.desc || is_xfer_complete ||
Felipe Balbie18b7972015-05-29 10:06:38 -05002162 usb_endpoint_xfer_isoc(dep->endpoint.desc)))
Felipe Balbi72246da2011-08-19 18:10:58 +03002163 dep->flags &= ~DWC3_EP_BUSY;
Felipe Balbifae2b902011-10-14 13:00:30 +03002164
2165 /*
2166 * WORKAROUND: This is the 2nd half of U1/U2 -> U0 workaround.
2167 * See dwc3_gadget_linksts_change_interrupt() for 1st half.
2168 */
2169 if (dwc->revision < DWC3_REVISION_183A) {
2170 u32 reg;
2171 int i;
2172
2173 for (i = 0; i < DWC3_ENDPOINTS_NUM; i++) {
Moiz Sonasath348e0262012-08-01 14:08:30 -05002174 dep = dwc->eps[i];
Felipe Balbifae2b902011-10-14 13:00:30 +03002175
2176 if (!(dep->flags & DWC3_EP_ENABLED))
2177 continue;
2178
Felipe Balbiaa3342c2016-03-14 11:01:31 +02002179 if (!list_empty(&dep->started_list))
Felipe Balbifae2b902011-10-14 13:00:30 +03002180 return;
2181 }
2182
2183 reg = dwc3_readl(dwc->regs, DWC3_DCTL);
2184 reg |= dwc->u1u2;
2185 dwc3_writel(dwc->regs, DWC3_DCTL, reg);
2186
2187 dwc->u1u2 = 0;
2188 }
Felipe Balbi8a1a9c92015-09-21 14:32:00 -05002189
Felipe Balbi4cb42212016-05-18 12:37:21 +03002190 /*
2191 * Our endpoint might get disabled by another thread during
2192 * dwc3_gadget_giveback(). If that happens, we're just gonna return 1
2193 * early on so DWC3_EP_BUSY flag gets cleared
2194 */
2195 if (!dep->endpoint.desc)
2196 return;
2197
Felipe Balbie6e709b2015-09-28 15:16:56 -05002198 if (!usb_endpoint_xfer_isoc(dep->endpoint.desc)) {
Felipe Balbi8a1a9c92015-09-21 14:32:00 -05002199 int ret;
2200
Felipe Balbi4fae2e32016-05-12 16:53:59 +03002201 ret = __dwc3_gadget_kick_transfer(dep, 0);
Felipe Balbi8a1a9c92015-09-21 14:32:00 -05002202 if (!ret || ret == -EBUSY)
2203 return;
2204 }
Felipe Balbi72246da2011-08-19 18:10:58 +03002205}
2206
Felipe Balbi72246da2011-08-19 18:10:58 +03002207static void dwc3_endpoint_interrupt(struct dwc3 *dwc,
2208 const struct dwc3_event_depevt *event)
2209{
2210 struct dwc3_ep *dep;
2211 u8 epnum = event->endpoint_number;
Baolin Wang76a638f2016-10-31 19:38:36 +08002212 u8 cmd;
Felipe Balbi72246da2011-08-19 18:10:58 +03002213
2214 dep = dwc->eps[epnum];
2215
Baolin Wang76a638f2016-10-31 19:38:36 +08002216 if (!(dep->flags & DWC3_EP_ENABLED) &&
2217 !(dep->flags & DWC3_EP_END_TRANSFER_PENDING))
Felipe Balbi3336abb2012-06-06 09:19:35 +03002218 return;
2219
Felipe Balbi72246da2011-08-19 18:10:58 +03002220 if (epnum == 0 || epnum == 1) {
2221 dwc3_ep0_interrupt(dwc, event);
2222 return;
2223 }
2224
2225 switch (event->endpoint_event) {
2226 case DWC3_DEPEVT_XFERCOMPLETE:
Felipe Balbib4996a82012-06-06 12:04:13 +03002227 dep->resource_index = 0;
Paul Zimmermanc2df85c2012-02-24 17:32:18 -08002228
Ido Shayevitz16e78db2012-03-12 20:25:24 +02002229 if (usb_endpoint_xfer_isoc(dep->endpoint.desc)) {
Felipe Balbi8566cd12016-09-26 11:16:39 +03002230 dev_err(dwc->dev, "XferComplete for Isochronous endpoint\n");
Felipe Balbi72246da2011-08-19 18:10:58 +03002231 return;
2232 }
2233
Jingoo Han029d97f2014-07-04 15:00:51 +09002234 dwc3_endpoint_transfer_complete(dwc, dep, event);
Felipe Balbi72246da2011-08-19 18:10:58 +03002235 break;
2236 case DWC3_DEPEVT_XFERINPROGRESS:
Jingoo Han029d97f2014-07-04 15:00:51 +09002237 dwc3_endpoint_transfer_complete(dwc, dep, event);
Felipe Balbi72246da2011-08-19 18:10:58 +03002238 break;
2239 case DWC3_DEPEVT_XFERNOTREADY:
Ido Shayevitz16e78db2012-03-12 20:25:24 +02002240 if (usb_endpoint_xfer_isoc(dep->endpoint.desc)) {
Felipe Balbi72246da2011-08-19 18:10:58 +03002241 dwc3_gadget_start_isoc(dwc, dep, event);
2242 } else {
2243 int ret;
2244
Felipe Balbi4fae2e32016-05-12 16:53:59 +03002245 ret = __dwc3_gadget_kick_transfer(dep, 0);
Felipe Balbi72246da2011-08-19 18:10:58 +03002246 if (!ret || ret == -EBUSY)
2247 return;
Felipe Balbi72246da2011-08-19 18:10:58 +03002248 }
2249
2250 break;
Felipe Balbi879631a2011-09-30 10:58:47 +03002251 case DWC3_DEPEVT_STREAMEVT:
Ido Shayevitz16e78db2012-03-12 20:25:24 +02002252 if (!usb_endpoint_xfer_bulk(dep->endpoint.desc)) {
Felipe Balbi879631a2011-09-30 10:58:47 +03002253 dev_err(dwc->dev, "Stream event for non-Bulk %s\n",
2254 dep->name);
2255 return;
2256 }
Felipe Balbi879631a2011-09-30 10:58:47 +03002257 break;
Felipe Balbi72246da2011-08-19 18:10:58 +03002258 case DWC3_DEPEVT_EPCMDCMPLT:
Baolin Wang76a638f2016-10-31 19:38:36 +08002259 cmd = DEPEVT_PARAMETER_CMD(event->parameters);
2260
2261 if (cmd == DWC3_DEPCMD_ENDTRANSFER) {
2262 dep->flags &= ~DWC3_EP_END_TRANSFER_PENDING;
2263 wake_up(&dep->wait_end_transfer);
2264 }
2265 break;
2266 case DWC3_DEPEVT_RXTXFIFOEVT:
Felipe Balbi72246da2011-08-19 18:10:58 +03002267 break;
2268 }
2269}
2270
2271static void dwc3_disconnect_gadget(struct dwc3 *dwc)
2272{
2273 if (dwc->gadget_driver && dwc->gadget_driver->disconnect) {
2274 spin_unlock(&dwc->lock);
2275 dwc->gadget_driver->disconnect(&dwc->gadget);
2276 spin_lock(&dwc->lock);
2277 }
2278}
2279
Felipe Balbibc5ba2e2014-02-26 10:17:07 -06002280static void dwc3_suspend_gadget(struct dwc3 *dwc)
2281{
Dan Carpenter73a30bf2014-03-07 14:19:57 +03002282 if (dwc->gadget_driver && dwc->gadget_driver->suspend) {
Felipe Balbibc5ba2e2014-02-26 10:17:07 -06002283 spin_unlock(&dwc->lock);
2284 dwc->gadget_driver->suspend(&dwc->gadget);
2285 spin_lock(&dwc->lock);
2286 }
2287}
2288
2289static void dwc3_resume_gadget(struct dwc3 *dwc)
2290{
Dan Carpenter73a30bf2014-03-07 14:19:57 +03002291 if (dwc->gadget_driver && dwc->gadget_driver->resume) {
Felipe Balbibc5ba2e2014-02-26 10:17:07 -06002292 spin_unlock(&dwc->lock);
2293 dwc->gadget_driver->resume(&dwc->gadget);
Felipe Balbi5c7b3b02015-01-29 10:29:18 -06002294 spin_lock(&dwc->lock);
Felipe Balbi8e744752014-11-06 14:27:53 +08002295 }
2296}
2297
2298static void dwc3_reset_gadget(struct dwc3 *dwc)
2299{
2300 if (!dwc->gadget_driver)
2301 return;
2302
2303 if (dwc->gadget.speed != USB_SPEED_UNKNOWN) {
2304 spin_unlock(&dwc->lock);
2305 usb_gadget_udc_reset(&dwc->gadget, dwc->gadget_driver);
Felipe Balbibc5ba2e2014-02-26 10:17:07 -06002306 spin_lock(&dwc->lock);
2307 }
2308}
2309
Paul Zimmermanb992e682012-04-27 14:17:35 +03002310static void dwc3_stop_active_transfer(struct dwc3 *dwc, u32 epnum, bool force)
Felipe Balbi72246da2011-08-19 18:10:58 +03002311{
2312 struct dwc3_ep *dep;
2313 struct dwc3_gadget_ep_cmd_params params;
2314 u32 cmd;
2315 int ret;
2316
2317 dep = dwc->eps[epnum];
2318
Baolin Wang76a638f2016-10-31 19:38:36 +08002319 if ((dep->flags & DWC3_EP_END_TRANSFER_PENDING) ||
2320 !dep->resource_index)
Pratyush Anand3daf74d2012-06-23 02:23:08 +05302321 return;
2322
Pratyush Anand57911502012-07-06 15:19:10 +05302323 /*
2324 * NOTICE: We are violating what the Databook says about the
2325 * EndTransfer command. Ideally we would _always_ wait for the
2326 * EndTransfer Command Completion IRQ, but that's causing too
2327 * much trouble synchronizing between us and gadget driver.
2328 *
2329 * We have discussed this with the IP Provider and it was
2330 * suggested to giveback all requests here, but give HW some
2331 * extra time to synchronize with the interconnect. We're using
Mickael Maisondc93b412014-12-23 17:34:43 +01002332 * an arbitrary 100us delay for that.
Pratyush Anand57911502012-07-06 15:19:10 +05302333 *
2334 * Note also that a similar handling was tested by Synopsys
2335 * (thanks a lot Paul) and nothing bad has come out of it.
2336 * In short, what we're doing is:
2337 *
2338 * - Issue EndTransfer WITH CMDIOC bit set
2339 * - Wait 100us
John Youn06281d42016-08-22 15:39:13 -07002340 *
2341 * As of IP version 3.10a of the DWC_usb3 IP, the controller
2342 * supports a mode to work around the above limitation. The
2343 * software can poll the CMDACT bit in the DEPCMD register
2344 * after issuing a EndTransfer command. This mode is enabled
2345 * by writing GUCTL2[14]. This polling is already done in the
2346 * dwc3_send_gadget_ep_cmd() function so if the mode is
2347 * enabled, the EndTransfer command will have completed upon
2348 * returning from this function and we don't need to delay for
2349 * 100us.
2350 *
2351 * This mode is NOT available on the DWC_usb31 IP.
Pratyush Anand57911502012-07-06 15:19:10 +05302352 */
2353
Pratyush Anand3daf74d2012-06-23 02:23:08 +05302354 cmd = DWC3_DEPCMD_ENDTRANSFER;
Paul Zimmermanb992e682012-04-27 14:17:35 +03002355 cmd |= force ? DWC3_DEPCMD_HIPRI_FORCERM : 0;
2356 cmd |= DWC3_DEPCMD_CMDIOC;
Felipe Balbib4996a82012-06-06 12:04:13 +03002357 cmd |= DWC3_DEPCMD_PARAM(dep->resource_index);
Pratyush Anand3daf74d2012-06-23 02:23:08 +05302358 memset(&params, 0, sizeof(params));
Felipe Balbi2cd47182016-04-12 16:42:43 +03002359 ret = dwc3_send_gadget_ep_cmd(dep, cmd, &params);
Pratyush Anand3daf74d2012-06-23 02:23:08 +05302360 WARN_ON_ONCE(ret);
Felipe Balbib4996a82012-06-06 12:04:13 +03002361 dep->resource_index = 0;
Felipe Balbi041d81f2012-10-04 11:58:00 +03002362 dep->flags &= ~DWC3_EP_BUSY;
John Youn06281d42016-08-22 15:39:13 -07002363
Baolin Wang76a638f2016-10-31 19:38:36 +08002364 if (dwc3_is_usb31(dwc) || dwc->revision < DWC3_REVISION_310A) {
2365 dep->flags |= DWC3_EP_END_TRANSFER_PENDING;
John Youn06281d42016-08-22 15:39:13 -07002366 udelay(100);
Baolin Wang76a638f2016-10-31 19:38:36 +08002367 }
Felipe Balbi72246da2011-08-19 18:10:58 +03002368}
2369
Felipe Balbi72246da2011-08-19 18:10:58 +03002370static void dwc3_clear_stall_all_ep(struct dwc3 *dwc)
2371{
2372 u32 epnum;
2373
2374 for (epnum = 1; epnum < DWC3_ENDPOINTS_NUM; epnum++) {
2375 struct dwc3_ep *dep;
Felipe Balbi72246da2011-08-19 18:10:58 +03002376 int ret;
2377
2378 dep = dwc->eps[epnum];
Felipe Balbi6a1e3ef2011-05-05 16:21:59 +03002379 if (!dep)
2380 continue;
Felipe Balbi72246da2011-08-19 18:10:58 +03002381
2382 if (!(dep->flags & DWC3_EP_STALL))
2383 continue;
2384
2385 dep->flags &= ~DWC3_EP_STALL;
2386
John Youn50c763f2016-05-31 17:49:56 -07002387 ret = dwc3_send_clear_stall_ep_cmd(dep);
Felipe Balbi72246da2011-08-19 18:10:58 +03002388 WARN_ON_ONCE(ret);
2389 }
2390}
2391
2392static void dwc3_gadget_disconnect_interrupt(struct dwc3 *dwc)
2393{
Felipe Balbic4430a22012-05-24 10:30:01 +03002394 int reg;
2395
Felipe Balbi72246da2011-08-19 18:10:58 +03002396 reg = dwc3_readl(dwc->regs, DWC3_DCTL);
2397 reg &= ~DWC3_DCTL_INITU1ENA;
2398 dwc3_writel(dwc->regs, DWC3_DCTL, reg);
2399
2400 reg &= ~DWC3_DCTL_INITU2ENA;
2401 dwc3_writel(dwc->regs, DWC3_DCTL, reg);
Felipe Balbi72246da2011-08-19 18:10:58 +03002402
Felipe Balbi72246da2011-08-19 18:10:58 +03002403 dwc3_disconnect_gadget(dwc);
2404
2405 dwc->gadget.speed = USB_SPEED_UNKNOWN;
Felipe Balbidf62df52011-10-14 15:11:49 +03002406 dwc->setup_packet_pending = false;
Felipe Balbi06a374e2014-10-10 15:24:00 -05002407 usb_gadget_set_state(&dwc->gadget, USB_STATE_NOTATTACHED);
Felipe Balbifc8bb912016-05-16 13:14:48 +03002408
2409 dwc->connected = false;
Felipe Balbi72246da2011-08-19 18:10:58 +03002410}
2411
Felipe Balbi72246da2011-08-19 18:10:58 +03002412static void dwc3_gadget_reset_interrupt(struct dwc3 *dwc)
2413{
2414 u32 reg;
2415
Felipe Balbifc8bb912016-05-16 13:14:48 +03002416 dwc->connected = true;
2417
Felipe Balbidf62df52011-10-14 15:11:49 +03002418 /*
2419 * WORKAROUND: DWC3 revisions <1.88a have an issue which
2420 * would cause a missing Disconnect Event if there's a
2421 * pending Setup Packet in the FIFO.
2422 *
2423 * There's no suggested workaround on the official Bug
2424 * report, which states that "unless the driver/application
2425 * is doing any special handling of a disconnect event,
2426 * there is no functional issue".
2427 *
2428 * Unfortunately, it turns out that we _do_ some special
2429 * handling of a disconnect event, namely complete all
2430 * pending transfers, notify gadget driver of the
2431 * disconnection, and so on.
2432 *
2433 * Our suggested workaround is to follow the Disconnect
2434 * Event steps here, instead, based on a setup_packet_pending
Felipe Balbib5d335e2015-11-16 16:20:34 -06002435 * flag. Such flag gets set whenever we have a SETUP_PENDING
2436 * status for EP0 TRBs and gets cleared on XferComplete for the
Felipe Balbidf62df52011-10-14 15:11:49 +03002437 * same endpoint.
2438 *
2439 * Refers to:
2440 *
2441 * STAR#9000466709: RTL: Device : Disconnect event not
2442 * generated if setup packet pending in FIFO
2443 */
2444 if (dwc->revision < DWC3_REVISION_188A) {
2445 if (dwc->setup_packet_pending)
2446 dwc3_gadget_disconnect_interrupt(dwc);
2447 }
2448
Felipe Balbi8e744752014-11-06 14:27:53 +08002449 dwc3_reset_gadget(dwc);
Felipe Balbi72246da2011-08-19 18:10:58 +03002450
2451 reg = dwc3_readl(dwc->regs, DWC3_DCTL);
2452 reg &= ~DWC3_DCTL_TSTCTRL_MASK;
2453 dwc3_writel(dwc->regs, DWC3_DCTL, reg);
Gerard Cauvy3b637362012-02-10 12:21:18 +02002454 dwc->test_mode = false;
Felipe Balbi72246da2011-08-19 18:10:58 +03002455 dwc3_clear_stall_all_ep(dwc);
2456
2457 /* Reset device address to zero */
2458 reg = dwc3_readl(dwc->regs, DWC3_DCFG);
2459 reg &= ~(DWC3_DCFG_DEVADDR_MASK);
2460 dwc3_writel(dwc->regs, DWC3_DCFG, reg);
Felipe Balbi72246da2011-08-19 18:10:58 +03002461}
2462
2463static void dwc3_update_ram_clk_sel(struct dwc3 *dwc, u32 speed)
2464{
2465 u32 reg;
2466 u32 usb30_clock = DWC3_GCTL_CLK_BUS;
2467
2468 /*
2469 * We change the clock only at SS but I dunno why I would want to do
2470 * this. Maybe it becomes part of the power saving plan.
2471 */
2472
John Younee5cd412016-02-05 17:08:45 -08002473 if ((speed != DWC3_DSTS_SUPERSPEED) &&
2474 (speed != DWC3_DSTS_SUPERSPEED_PLUS))
Felipe Balbi72246da2011-08-19 18:10:58 +03002475 return;
2476
2477 /*
2478 * RAMClkSel is reset to 0 after USB reset, so it must be reprogrammed
2479 * each time on Connect Done.
2480 */
2481 if (!usb30_clock)
2482 return;
2483
2484 reg = dwc3_readl(dwc->regs, DWC3_GCTL);
2485 reg |= DWC3_GCTL_RAMCLKSEL(usb30_clock);
2486 dwc3_writel(dwc->regs, DWC3_GCTL, reg);
2487}
2488
Felipe Balbi72246da2011-08-19 18:10:58 +03002489static void dwc3_gadget_conndone_interrupt(struct dwc3 *dwc)
2490{
Felipe Balbi72246da2011-08-19 18:10:58 +03002491 struct dwc3_ep *dep;
2492 int ret;
2493 u32 reg;
2494 u8 speed;
2495
Felipe Balbi72246da2011-08-19 18:10:58 +03002496 reg = dwc3_readl(dwc->regs, DWC3_DSTS);
2497 speed = reg & DWC3_DSTS_CONNECTSPD;
2498 dwc->speed = speed;
2499
2500 dwc3_update_ram_clk_sel(dwc, speed);
2501
2502 switch (speed) {
John Youn2da9ad72016-05-20 16:34:26 -07002503 case DWC3_DSTS_SUPERSPEED_PLUS:
John Youn75808622016-02-05 17:09:13 -08002504 dwc3_gadget_ep0_desc.wMaxPacketSize = cpu_to_le16(512);
2505 dwc->gadget.ep0->maxpacket = 512;
2506 dwc->gadget.speed = USB_SPEED_SUPER_PLUS;
2507 break;
John Youn2da9ad72016-05-20 16:34:26 -07002508 case DWC3_DSTS_SUPERSPEED:
Felipe Balbi05870c52011-10-14 14:51:38 +03002509 /*
2510 * WORKAROUND: DWC3 revisions <1.90a have an issue which
2511 * would cause a missing USB3 Reset event.
2512 *
2513 * In such situations, we should force a USB3 Reset
2514 * event by calling our dwc3_gadget_reset_interrupt()
2515 * routine.
2516 *
2517 * Refers to:
2518 *
2519 * STAR#9000483510: RTL: SS : USB3 reset event may
2520 * not be generated always when the link enters poll
2521 */
2522 if (dwc->revision < DWC3_REVISION_190A)
2523 dwc3_gadget_reset_interrupt(dwc);
2524
Felipe Balbi72246da2011-08-19 18:10:58 +03002525 dwc3_gadget_ep0_desc.wMaxPacketSize = cpu_to_le16(512);
2526 dwc->gadget.ep0->maxpacket = 512;
2527 dwc->gadget.speed = USB_SPEED_SUPER;
2528 break;
John Youn2da9ad72016-05-20 16:34:26 -07002529 case DWC3_DSTS_HIGHSPEED:
Felipe Balbi72246da2011-08-19 18:10:58 +03002530 dwc3_gadget_ep0_desc.wMaxPacketSize = cpu_to_le16(64);
2531 dwc->gadget.ep0->maxpacket = 64;
2532 dwc->gadget.speed = USB_SPEED_HIGH;
2533 break;
John Youn2da9ad72016-05-20 16:34:26 -07002534 case DWC3_DSTS_FULLSPEED2:
2535 case DWC3_DSTS_FULLSPEED1:
Felipe Balbi72246da2011-08-19 18:10:58 +03002536 dwc3_gadget_ep0_desc.wMaxPacketSize = cpu_to_le16(64);
2537 dwc->gadget.ep0->maxpacket = 64;
2538 dwc->gadget.speed = USB_SPEED_FULL;
2539 break;
John Youn2da9ad72016-05-20 16:34:26 -07002540 case DWC3_DSTS_LOWSPEED:
Felipe Balbi72246da2011-08-19 18:10:58 +03002541 dwc3_gadget_ep0_desc.wMaxPacketSize = cpu_to_le16(8);
2542 dwc->gadget.ep0->maxpacket = 8;
2543 dwc->gadget.speed = USB_SPEED_LOW;
2544 break;
2545 }
2546
Pratyush Anand2b758352013-01-14 15:59:31 +05302547 /* Enable USB2 LPM Capability */
2548
John Younee5cd412016-02-05 17:08:45 -08002549 if ((dwc->revision > DWC3_REVISION_194A) &&
John Youn2da9ad72016-05-20 16:34:26 -07002550 (speed != DWC3_DSTS_SUPERSPEED) &&
2551 (speed != DWC3_DSTS_SUPERSPEED_PLUS)) {
Pratyush Anand2b758352013-01-14 15:59:31 +05302552 reg = dwc3_readl(dwc->regs, DWC3_DCFG);
2553 reg |= DWC3_DCFG_LPM_CAP;
2554 dwc3_writel(dwc->regs, DWC3_DCFG, reg);
2555
2556 reg = dwc3_readl(dwc->regs, DWC3_DCTL);
2557 reg &= ~(DWC3_DCTL_HIRD_THRES_MASK | DWC3_DCTL_L1_HIBER_EN);
2558
Huang Rui460d0982014-10-31 11:11:18 +08002559 reg |= DWC3_DCTL_HIRD_THRES(dwc->hird_threshold);
Pratyush Anand2b758352013-01-14 15:59:31 +05302560
Huang Rui80caf7d2014-10-28 19:54:26 +08002561 /*
2562 * When dwc3 revisions >= 2.40a, LPM Erratum is enabled and
2563 * DCFG.LPMCap is set, core responses with an ACK and the
2564 * BESL value in the LPM token is less than or equal to LPM
2565 * NYET threshold.
2566 */
2567 WARN_ONCE(dwc->revision < DWC3_REVISION_240A
2568 && dwc->has_lpm_erratum,
2569 "LPM Erratum not available on dwc3 revisisions < 2.40a\n");
2570
2571 if (dwc->has_lpm_erratum && dwc->revision >= DWC3_REVISION_240A)
2572 reg |= DWC3_DCTL_LPM_ERRATA(dwc->lpm_nyet_threshold);
2573
Pratyush Anand2b758352013-01-14 15:59:31 +05302574 dwc3_writel(dwc->regs, DWC3_DCTL, reg);
Felipe Balbi356363b2013-12-19 16:37:05 -06002575 } else {
2576 reg = dwc3_readl(dwc->regs, DWC3_DCTL);
2577 reg &= ~DWC3_DCTL_HIRD_THRES_MASK;
2578 dwc3_writel(dwc->regs, DWC3_DCTL, reg);
Pratyush Anand2b758352013-01-14 15:59:31 +05302579 }
2580
Felipe Balbi72246da2011-08-19 18:10:58 +03002581 dep = dwc->eps[0];
Paul Zimmerman265b70a2013-12-19 12:38:49 -06002582 ret = __dwc3_gadget_ep_enable(dep, &dwc3_gadget_ep0_desc, NULL, true,
2583 false);
Felipe Balbi72246da2011-08-19 18:10:58 +03002584 if (ret) {
2585 dev_err(dwc->dev, "failed to enable %s\n", dep->name);
2586 return;
2587 }
2588
2589 dep = dwc->eps[1];
Paul Zimmerman265b70a2013-12-19 12:38:49 -06002590 ret = __dwc3_gadget_ep_enable(dep, &dwc3_gadget_ep0_desc, NULL, true,
2591 false);
Felipe Balbi72246da2011-08-19 18:10:58 +03002592 if (ret) {
2593 dev_err(dwc->dev, "failed to enable %s\n", dep->name);
2594 return;
2595 }
2596
2597 /*
2598 * Configure PHY via GUSB3PIPECTLn if required.
2599 *
2600 * Update GTXFIFOSIZn
2601 *
2602 * In both cases reset values should be sufficient.
2603 */
2604}
2605
2606static void dwc3_gadget_wakeup_interrupt(struct dwc3 *dwc)
2607{
Felipe Balbi72246da2011-08-19 18:10:58 +03002608 /*
2609 * TODO take core out of low power mode when that's
2610 * implemented.
2611 */
2612
Jiebing Liad14d4e2014-12-11 13:26:29 +08002613 if (dwc->gadget_driver && dwc->gadget_driver->resume) {
2614 spin_unlock(&dwc->lock);
2615 dwc->gadget_driver->resume(&dwc->gadget);
2616 spin_lock(&dwc->lock);
2617 }
Felipe Balbi72246da2011-08-19 18:10:58 +03002618}
2619
2620static void dwc3_gadget_linksts_change_interrupt(struct dwc3 *dwc,
2621 unsigned int evtinfo)
2622{
Felipe Balbifae2b902011-10-14 13:00:30 +03002623 enum dwc3_link_state next = evtinfo & DWC3_LINK_STATE_MASK;
Felipe Balbi0b0cc1c2012-09-18 21:39:24 +03002624 unsigned int pwropt;
2625
2626 /*
2627 * WORKAROUND: DWC3 < 2.50a have an issue when configured without
2628 * Hibernation mode enabled which would show up when device detects
2629 * host-initiated U3 exit.
2630 *
2631 * In that case, device will generate a Link State Change Interrupt
2632 * from U3 to RESUME which is only necessary if Hibernation is
2633 * configured in.
2634 *
2635 * There are no functional changes due to such spurious event and we
2636 * just need to ignore it.
2637 *
2638 * Refers to:
2639 *
2640 * STAR#9000570034 RTL: SS Resume event generated in non-Hibernation
2641 * operational mode
2642 */
2643 pwropt = DWC3_GHWPARAMS1_EN_PWROPT(dwc->hwparams.hwparams1);
2644 if ((dwc->revision < DWC3_REVISION_250A) &&
2645 (pwropt != DWC3_GHWPARAMS1_EN_PWROPT_HIB)) {
2646 if ((dwc->link_state == DWC3_LINK_STATE_U3) &&
2647 (next == DWC3_LINK_STATE_RESUME)) {
Felipe Balbi0b0cc1c2012-09-18 21:39:24 +03002648 return;
2649 }
2650 }
Felipe Balbifae2b902011-10-14 13:00:30 +03002651
2652 /*
2653 * WORKAROUND: DWC3 Revisions <1.83a have an issue which, depending
2654 * on the link partner, the USB session might do multiple entry/exit
2655 * of low power states before a transfer takes place.
2656 *
2657 * Due to this problem, we might experience lower throughput. The
2658 * suggested workaround is to disable DCTL[12:9] bits if we're
2659 * transitioning from U1/U2 to U0 and enable those bits again
2660 * after a transfer completes and there are no pending transfers
2661 * on any of the enabled endpoints.
2662 *
2663 * This is the first half of that workaround.
2664 *
2665 * Refers to:
2666 *
2667 * STAR#9000446952: RTL: Device SS : if U1/U2 ->U0 takes >128us
2668 * core send LGO_Ux entering U0
2669 */
2670 if (dwc->revision < DWC3_REVISION_183A) {
2671 if (next == DWC3_LINK_STATE_U0) {
2672 u32 u1u2;
2673 u32 reg;
2674
2675 switch (dwc->link_state) {
2676 case DWC3_LINK_STATE_U1:
2677 case DWC3_LINK_STATE_U2:
2678 reg = dwc3_readl(dwc->regs, DWC3_DCTL);
2679 u1u2 = reg & (DWC3_DCTL_INITU2ENA
2680 | DWC3_DCTL_ACCEPTU2ENA
2681 | DWC3_DCTL_INITU1ENA
2682 | DWC3_DCTL_ACCEPTU1ENA);
2683
2684 if (!dwc->u1u2)
2685 dwc->u1u2 = reg & u1u2;
2686
2687 reg &= ~u1u2;
2688
2689 dwc3_writel(dwc->regs, DWC3_DCTL, reg);
2690 break;
2691 default:
2692 /* do nothing */
2693 break;
2694 }
2695 }
2696 }
2697
Felipe Balbibc5ba2e2014-02-26 10:17:07 -06002698 switch (next) {
2699 case DWC3_LINK_STATE_U1:
2700 if (dwc->speed == USB_SPEED_SUPER)
2701 dwc3_suspend_gadget(dwc);
2702 break;
2703 case DWC3_LINK_STATE_U2:
2704 case DWC3_LINK_STATE_U3:
2705 dwc3_suspend_gadget(dwc);
2706 break;
2707 case DWC3_LINK_STATE_RESUME:
2708 dwc3_resume_gadget(dwc);
2709 break;
2710 default:
2711 /* do nothing */
2712 break;
2713 }
2714
Felipe Balbie57ebc12014-04-22 13:20:12 -05002715 dwc->link_state = next;
Felipe Balbi72246da2011-08-19 18:10:58 +03002716}
2717
Baolin Wang72704f82016-05-16 16:43:53 +08002718static void dwc3_gadget_suspend_interrupt(struct dwc3 *dwc,
2719 unsigned int evtinfo)
2720{
2721 enum dwc3_link_state next = evtinfo & DWC3_LINK_STATE_MASK;
2722
2723 if (dwc->link_state != next && next == DWC3_LINK_STATE_U3)
2724 dwc3_suspend_gadget(dwc);
2725
2726 dwc->link_state = next;
2727}
2728
Felipe Balbie1dadd32014-02-25 14:47:54 -06002729static void dwc3_gadget_hibernation_interrupt(struct dwc3 *dwc,
2730 unsigned int evtinfo)
2731{
2732 unsigned int is_ss = evtinfo & BIT(4);
2733
2734 /**
2735 * WORKAROUND: DWC3 revison 2.20a with hibernation support
2736 * have a known issue which can cause USB CV TD.9.23 to fail
2737 * randomly.
2738 *
2739 * Because of this issue, core could generate bogus hibernation
2740 * events which SW needs to ignore.
2741 *
2742 * Refers to:
2743 *
2744 * STAR#9000546576: Device Mode Hibernation: Issue in USB 2.0
2745 * Device Fallback from SuperSpeed
2746 */
2747 if (is_ss ^ (dwc->speed == USB_SPEED_SUPER))
2748 return;
2749
2750 /* enter hibernation here */
2751}
2752
Felipe Balbi72246da2011-08-19 18:10:58 +03002753static void dwc3_gadget_interrupt(struct dwc3 *dwc,
2754 const struct dwc3_event_devt *event)
2755{
2756 switch (event->type) {
2757 case DWC3_DEVICE_EVENT_DISCONNECT:
2758 dwc3_gadget_disconnect_interrupt(dwc);
2759 break;
2760 case DWC3_DEVICE_EVENT_RESET:
2761 dwc3_gadget_reset_interrupt(dwc);
2762 break;
2763 case DWC3_DEVICE_EVENT_CONNECT_DONE:
2764 dwc3_gadget_conndone_interrupt(dwc);
2765 break;
2766 case DWC3_DEVICE_EVENT_WAKEUP:
2767 dwc3_gadget_wakeup_interrupt(dwc);
2768 break;
Felipe Balbie1dadd32014-02-25 14:47:54 -06002769 case DWC3_DEVICE_EVENT_HIBER_REQ:
2770 if (dev_WARN_ONCE(dwc->dev, !dwc->has_hibernation,
2771 "unexpected hibernation event\n"))
2772 break;
2773
2774 dwc3_gadget_hibernation_interrupt(dwc, event->event_info);
2775 break;
Felipe Balbi72246da2011-08-19 18:10:58 +03002776 case DWC3_DEVICE_EVENT_LINK_STATUS_CHANGE:
2777 dwc3_gadget_linksts_change_interrupt(dwc, event->event_info);
2778 break;
2779 case DWC3_DEVICE_EVENT_EOPF:
Baolin Wang72704f82016-05-16 16:43:53 +08002780 /* It changed to be suspend event for version 2.30a and above */
Felipe Balbi5eb30ce2016-11-03 14:07:51 +02002781 if (dwc->revision >= DWC3_REVISION_230A) {
Baolin Wang72704f82016-05-16 16:43:53 +08002782 /*
2783 * Ignore suspend event until the gadget enters into
2784 * USB_STATE_CONFIGURED state.
2785 */
2786 if (dwc->gadget.state >= USB_STATE_CONFIGURED)
2787 dwc3_gadget_suspend_interrupt(dwc,
2788 event->event_info);
2789 }
Felipe Balbi72246da2011-08-19 18:10:58 +03002790 break;
2791 case DWC3_DEVICE_EVENT_SOF:
Felipe Balbi72246da2011-08-19 18:10:58 +03002792 case DWC3_DEVICE_EVENT_ERRATIC_ERROR:
Felipe Balbi72246da2011-08-19 18:10:58 +03002793 case DWC3_DEVICE_EVENT_CMD_CMPL:
Felipe Balbi72246da2011-08-19 18:10:58 +03002794 case DWC3_DEVICE_EVENT_OVERFLOW:
Felipe Balbi72246da2011-08-19 18:10:58 +03002795 break;
2796 default:
Felipe Balbie9f2aa82015-01-27 13:49:28 -06002797 dev_WARN(dwc->dev, "UNKNOWN IRQ %d\n", event->type);
Felipe Balbi72246da2011-08-19 18:10:58 +03002798 }
2799}
2800
2801static void dwc3_process_event_entry(struct dwc3 *dwc,
2802 const union dwc3_event *event)
2803{
Felipe Balbi43c96be2016-09-26 13:23:34 +03002804 trace_dwc3_event(event->raw, dwc);
Felipe Balbi2c4cbe6e52014-04-30 17:45:10 -05002805
Felipe Balbi72246da2011-08-19 18:10:58 +03002806 /* Endpoint IRQ, handle it and return early */
2807 if (event->type.is_devspec == 0) {
2808 /* depevt */
2809 return dwc3_endpoint_interrupt(dwc, &event->depevt);
2810 }
2811
2812 switch (event->type.type) {
2813 case DWC3_EVENT_TYPE_DEV:
2814 dwc3_gadget_interrupt(dwc, &event->devt);
2815 break;
2816 /* REVISIT what to do with Carkit and I2C events ? */
2817 default:
2818 dev_err(dwc->dev, "UNKNOWN IRQ type %d\n", event->raw);
2819 }
2820}
2821
Felipe Balbidea520a2016-03-30 09:39:34 +03002822static irqreturn_t dwc3_process_event_buf(struct dwc3_event_buffer *evt)
Felipe Balbif42f2442013-06-12 21:25:08 +03002823{
Felipe Balbidea520a2016-03-30 09:39:34 +03002824 struct dwc3 *dwc = evt->dwc;
Felipe Balbif42f2442013-06-12 21:25:08 +03002825 irqreturn_t ret = IRQ_NONE;
2826 int left;
2827 u32 reg;
2828
Felipe Balbif42f2442013-06-12 21:25:08 +03002829 left = evt->count;
2830
2831 if (!(evt->flags & DWC3_EVENT_PENDING))
2832 return IRQ_NONE;
2833
2834 while (left > 0) {
2835 union dwc3_event event;
2836
2837 event.raw = *(u32 *) (evt->buf + evt->lpos);
2838
2839 dwc3_process_event_entry(dwc, &event);
2840
2841 /*
2842 * FIXME we wrap around correctly to the next entry as
2843 * almost all entries are 4 bytes in size. There is one
2844 * entry which has 12 bytes which is a regular entry
2845 * followed by 8 bytes data. ATM I don't know how
2846 * things are organized if we get next to the a
2847 * boundary so I worry about that once we try to handle
2848 * that.
2849 */
2850 evt->lpos = (evt->lpos + 4) % DWC3_EVENT_BUFFERS_SIZE;
2851 left -= 4;
2852
Felipe Balbi660e9bd2016-03-30 09:26:24 +03002853 dwc3_writel(dwc->regs, DWC3_GEVNTCOUNT(0), 4);
Felipe Balbif42f2442013-06-12 21:25:08 +03002854 }
2855
2856 evt->count = 0;
2857 evt->flags &= ~DWC3_EVENT_PENDING;
2858 ret = IRQ_HANDLED;
2859
2860 /* Unmask interrupt */
Felipe Balbi660e9bd2016-03-30 09:26:24 +03002861 reg = dwc3_readl(dwc->regs, DWC3_GEVNTSIZ(0));
Felipe Balbif42f2442013-06-12 21:25:08 +03002862 reg &= ~DWC3_GEVNTSIZ_INTMASK;
Felipe Balbi660e9bd2016-03-30 09:26:24 +03002863 dwc3_writel(dwc->regs, DWC3_GEVNTSIZ(0), reg);
Felipe Balbif42f2442013-06-12 21:25:08 +03002864
2865 return ret;
2866}
2867
Felipe Balbidea520a2016-03-30 09:39:34 +03002868static irqreturn_t dwc3_thread_interrupt(int irq, void *_evt)
Felipe Balbib15a7622011-06-30 16:57:15 +03002869{
Felipe Balbidea520a2016-03-30 09:39:34 +03002870 struct dwc3_event_buffer *evt = _evt;
2871 struct dwc3 *dwc = evt->dwc;
Felipe Balbie5f68b42015-10-12 13:25:44 -05002872 unsigned long flags;
Felipe Balbib15a7622011-06-30 16:57:15 +03002873 irqreturn_t ret = IRQ_NONE;
Felipe Balbib15a7622011-06-30 16:57:15 +03002874
Felipe Balbie5f68b42015-10-12 13:25:44 -05002875 spin_lock_irqsave(&dwc->lock, flags);
Felipe Balbidea520a2016-03-30 09:39:34 +03002876 ret = dwc3_process_event_buf(evt);
Felipe Balbie5f68b42015-10-12 13:25:44 -05002877 spin_unlock_irqrestore(&dwc->lock, flags);
Felipe Balbib15a7622011-06-30 16:57:15 +03002878
2879 return ret;
2880}
2881
Felipe Balbidea520a2016-03-30 09:39:34 +03002882static irqreturn_t dwc3_check_event_buf(struct dwc3_event_buffer *evt)
Felipe Balbi72246da2011-08-19 18:10:58 +03002883{
Felipe Balbidea520a2016-03-30 09:39:34 +03002884 struct dwc3 *dwc = evt->dwc;
Felipe Balbi72246da2011-08-19 18:10:58 +03002885 u32 count;
Felipe Balbie8adfc32013-06-12 21:11:14 +03002886 u32 reg;
Felipe Balbi72246da2011-08-19 18:10:58 +03002887
Felipe Balbifc8bb912016-05-16 13:14:48 +03002888 if (pm_runtime_suspended(dwc->dev)) {
2889 pm_runtime_get(dwc->dev);
2890 disable_irq_nosync(dwc->irq_gadget);
2891 dwc->pending_events = true;
2892 return IRQ_HANDLED;
2893 }
2894
Felipe Balbi660e9bd2016-03-30 09:26:24 +03002895 count = dwc3_readl(dwc->regs, DWC3_GEVNTCOUNT(0));
Felipe Balbi72246da2011-08-19 18:10:58 +03002896 count &= DWC3_GEVNTCOUNT_MASK;
2897 if (!count)
2898 return IRQ_NONE;
2899
Felipe Balbib15a7622011-06-30 16:57:15 +03002900 evt->count = count;
2901 evt->flags |= DWC3_EVENT_PENDING;
Felipe Balbi72246da2011-08-19 18:10:58 +03002902
Felipe Balbie8adfc32013-06-12 21:11:14 +03002903 /* Mask interrupt */
Felipe Balbi660e9bd2016-03-30 09:26:24 +03002904 reg = dwc3_readl(dwc->regs, DWC3_GEVNTSIZ(0));
Felipe Balbie8adfc32013-06-12 21:11:14 +03002905 reg |= DWC3_GEVNTSIZ_INTMASK;
Felipe Balbi660e9bd2016-03-30 09:26:24 +03002906 dwc3_writel(dwc->regs, DWC3_GEVNTSIZ(0), reg);
Felipe Balbie8adfc32013-06-12 21:11:14 +03002907
Felipe Balbib15a7622011-06-30 16:57:15 +03002908 return IRQ_WAKE_THREAD;
Felipe Balbi72246da2011-08-19 18:10:58 +03002909}
2910
Felipe Balbidea520a2016-03-30 09:39:34 +03002911static irqreturn_t dwc3_interrupt(int irq, void *_evt)
Felipe Balbi72246da2011-08-19 18:10:58 +03002912{
Felipe Balbidea520a2016-03-30 09:39:34 +03002913 struct dwc3_event_buffer *evt = _evt;
Felipe Balbi72246da2011-08-19 18:10:58 +03002914
Felipe Balbidea520a2016-03-30 09:39:34 +03002915 return dwc3_check_event_buf(evt);
Felipe Balbi72246da2011-08-19 18:10:58 +03002916}
2917
Felipe Balbi6db38122016-10-03 11:27:01 +03002918static int dwc3_gadget_get_irq(struct dwc3 *dwc)
2919{
2920 struct platform_device *dwc3_pdev = to_platform_device(dwc->dev);
2921 int irq;
2922
2923 irq = platform_get_irq_byname(dwc3_pdev, "peripheral");
2924 if (irq > 0)
2925 goto out;
2926
2927 if (irq == -EPROBE_DEFER)
2928 goto out;
2929
2930 irq = platform_get_irq_byname(dwc3_pdev, "dwc_usb3");
2931 if (irq > 0)
2932 goto out;
2933
2934 if (irq == -EPROBE_DEFER)
2935 goto out;
2936
2937 irq = platform_get_irq(dwc3_pdev, 0);
2938 if (irq > 0)
2939 goto out;
2940
2941 if (irq != -EPROBE_DEFER)
2942 dev_err(dwc->dev, "missing peripheral IRQ\n");
2943
2944 if (!irq)
2945 irq = -EINVAL;
2946
2947out:
2948 return irq;
2949}
2950
Felipe Balbi72246da2011-08-19 18:10:58 +03002951/**
2952 * dwc3_gadget_init - Initializes gadget related registers
Paul Zimmerman1d046792012-02-15 18:56:56 -08002953 * @dwc: pointer to our controller context structure
Felipe Balbi72246da2011-08-19 18:10:58 +03002954 *
2955 * Returns 0 on success otherwise negative errno.
2956 */
Bill Pemberton41ac7b32012-11-19 13:21:48 -05002957int dwc3_gadget_init(struct dwc3 *dwc)
Felipe Balbi72246da2011-08-19 18:10:58 +03002958{
Felipe Balbi6db38122016-10-03 11:27:01 +03002959 int ret;
2960 int irq;
Roger Quadros9522def2016-06-10 14:48:38 +03002961
Felipe Balbi6db38122016-10-03 11:27:01 +03002962 irq = dwc3_gadget_get_irq(dwc);
2963 if (irq < 0) {
2964 ret = irq;
2965 goto err0;
Roger Quadros9522def2016-06-10 14:48:38 +03002966 }
2967
2968 dwc->irq_gadget = irq;
Felipe Balbi72246da2011-08-19 18:10:58 +03002969
2970 dwc->ctrl_req = dma_alloc_coherent(dwc->dev, sizeof(*dwc->ctrl_req),
2971 &dwc->ctrl_req_addr, GFP_KERNEL);
2972 if (!dwc->ctrl_req) {
2973 dev_err(dwc->dev, "failed to allocate ctrl request\n");
2974 ret = -ENOMEM;
2975 goto err0;
2976 }
2977
Kishon Vijay Abraham I2abd9d52015-07-27 12:25:31 +05302978 dwc->ep0_trb = dma_alloc_coherent(dwc->dev, sizeof(*dwc->ep0_trb) * 2,
Felipe Balbi72246da2011-08-19 18:10:58 +03002979 &dwc->ep0_trb_addr, GFP_KERNEL);
2980 if (!dwc->ep0_trb) {
2981 dev_err(dwc->dev, "failed to allocate ep0 trb\n");
2982 ret = -ENOMEM;
2983 goto err1;
2984 }
2985
Felipe Balbi3ef35fa2012-05-04 12:58:14 +03002986 dwc->setup_buf = kzalloc(DWC3_EP0_BOUNCE_SIZE, GFP_KERNEL);
Felipe Balbi72246da2011-08-19 18:10:58 +03002987 if (!dwc->setup_buf) {
Felipe Balbi72246da2011-08-19 18:10:58 +03002988 ret = -ENOMEM;
2989 goto err2;
2990 }
2991
Felipe Balbi5812b1c2011-08-27 22:07:53 +03002992 dwc->ep0_bounce = dma_alloc_coherent(dwc->dev,
Felipe Balbi3ef35fa2012-05-04 12:58:14 +03002993 DWC3_EP0_BOUNCE_SIZE, &dwc->ep0_bounce_addr,
2994 GFP_KERNEL);
Felipe Balbi5812b1c2011-08-27 22:07:53 +03002995 if (!dwc->ep0_bounce) {
2996 dev_err(dwc->dev, "failed to allocate ep0 bounce buffer\n");
2997 ret = -ENOMEM;
2998 goto err3;
2999 }
3000
Felipe Balbi04c03d12015-12-02 10:06:45 -06003001 dwc->zlp_buf = kzalloc(DWC3_ZLP_BUF_SIZE, GFP_KERNEL);
3002 if (!dwc->zlp_buf) {
3003 ret = -ENOMEM;
3004 goto err4;
3005 }
3006
Baolin Wangbb014732016-10-14 17:11:33 +08003007 init_completion(&dwc->ep0_in_setup);
3008
Felipe Balbi72246da2011-08-19 18:10:58 +03003009 dwc->gadget.ops = &dwc3_gadget_ops;
Felipe Balbi72246da2011-08-19 18:10:58 +03003010 dwc->gadget.speed = USB_SPEED_UNKNOWN;
Felipe Balbieeb720f2011-11-28 12:46:59 +02003011 dwc->gadget.sg_supported = true;
Felipe Balbi72246da2011-08-19 18:10:58 +03003012 dwc->gadget.name = "dwc3-gadget";
Jianqiang Tang6a4290c2016-01-20 14:09:39 +08003013 dwc->gadget.is_otg = dwc->dr_mode == USB_DR_MODE_OTG;
Felipe Balbi72246da2011-08-19 18:10:58 +03003014
3015 /*
Ben McCauleyb9e51b22015-11-16 10:47:24 -06003016 * FIXME We might be setting max_speed to <SUPER, however versions
3017 * <2.20a of dwc3 have an issue with metastability (documented
3018 * elsewhere in this driver) which tells us we can't set max speed to
3019 * anything lower than SUPER.
3020 *
3021 * Because gadget.max_speed is only used by composite.c and function
3022 * drivers (i.e. it won't go into dwc3's registers) we are allowing this
3023 * to happen so we avoid sending SuperSpeed Capability descriptor
3024 * together with our BOS descriptor as that could confuse host into
3025 * thinking we can handle super speed.
3026 *
3027 * Note that, in fact, we won't even support GetBOS requests when speed
3028 * is less than super speed because we don't have means, yet, to tell
3029 * composite.c that we are USB 2.0 + LPM ECN.
3030 */
3031 if (dwc->revision < DWC3_REVISION_220A)
Felipe Balbi5eb30ce2016-11-03 14:07:51 +02003032 dev_info(dwc->dev, "changing max_speed on rev %08x\n",
Ben McCauleyb9e51b22015-11-16 10:47:24 -06003033 dwc->revision);
3034
3035 dwc->gadget.max_speed = dwc->maximum_speed;
3036
3037 /*
David Cohena4b9d942013-12-09 15:55:38 -08003038 * Per databook, DWC3 needs buffer size to be aligned to MaxPacketSize
3039 * on ep out.
3040 */
3041 dwc->gadget.quirk_ep_out_aligned_size = true;
3042
3043 /*
Felipe Balbi72246da2011-08-19 18:10:58 +03003044 * REVISIT: Here we should clear all pending IRQs to be
3045 * sure we're starting from a well known location.
3046 */
3047
3048 ret = dwc3_gadget_init_endpoints(dwc);
3049 if (ret)
Felipe Balbi04c03d12015-12-02 10:06:45 -06003050 goto err5;
Felipe Balbi72246da2011-08-19 18:10:58 +03003051
Felipe Balbi72246da2011-08-19 18:10:58 +03003052 ret = usb_add_gadget_udc(dwc->dev, &dwc->gadget);
3053 if (ret) {
3054 dev_err(dwc->dev, "failed to register udc\n");
Felipe Balbi04c03d12015-12-02 10:06:45 -06003055 goto err5;
Felipe Balbi72246da2011-08-19 18:10:58 +03003056 }
3057
3058 return 0;
3059
Felipe Balbi04c03d12015-12-02 10:06:45 -06003060err5:
3061 kfree(dwc->zlp_buf);
3062
Felipe Balbi5812b1c2011-08-27 22:07:53 +03003063err4:
David Cohene1f80462013-09-11 17:42:47 -07003064 dwc3_gadget_free_endpoints(dwc);
Felipe Balbi3ef35fa2012-05-04 12:58:14 +03003065 dma_free_coherent(dwc->dev, DWC3_EP0_BOUNCE_SIZE,
3066 dwc->ep0_bounce, dwc->ep0_bounce_addr);
Felipe Balbi5812b1c2011-08-27 22:07:53 +03003067
Felipe Balbi72246da2011-08-19 18:10:58 +03003068err3:
Felipe Balbi0fc9a1b2011-12-19 11:32:34 +02003069 kfree(dwc->setup_buf);
Felipe Balbi72246da2011-08-19 18:10:58 +03003070
3071err2:
Christophe JAILLET51fbc7c2016-10-07 22:12:39 +02003072 dma_free_coherent(dwc->dev, sizeof(*dwc->ep0_trb) * 2,
Felipe Balbi72246da2011-08-19 18:10:58 +03003073 dwc->ep0_trb, dwc->ep0_trb_addr);
3074
3075err1:
3076 dma_free_coherent(dwc->dev, sizeof(*dwc->ctrl_req),
3077 dwc->ctrl_req, dwc->ctrl_req_addr);
3078
3079err0:
3080 return ret;
3081}
3082
Felipe Balbi7415f172012-04-30 14:56:33 +03003083/* -------------------------------------------------------------------------- */
3084
Felipe Balbi72246da2011-08-19 18:10:58 +03003085void dwc3_gadget_exit(struct dwc3 *dwc)
3086{
Felipe Balbi72246da2011-08-19 18:10:58 +03003087 usb_del_gadget_udc(&dwc->gadget);
Felipe Balbi72246da2011-08-19 18:10:58 +03003088
Felipe Balbi72246da2011-08-19 18:10:58 +03003089 dwc3_gadget_free_endpoints(dwc);
3090
Felipe Balbi3ef35fa2012-05-04 12:58:14 +03003091 dma_free_coherent(dwc->dev, DWC3_EP0_BOUNCE_SIZE,
3092 dwc->ep0_bounce, dwc->ep0_bounce_addr);
Felipe Balbi5812b1c2011-08-27 22:07:53 +03003093
Felipe Balbi0fc9a1b2011-12-19 11:32:34 +02003094 kfree(dwc->setup_buf);
Felipe Balbi04c03d12015-12-02 10:06:45 -06003095 kfree(dwc->zlp_buf);
Felipe Balbi72246da2011-08-19 18:10:58 +03003096
Christophe JAILLET51fbc7c2016-10-07 22:12:39 +02003097 dma_free_coherent(dwc->dev, sizeof(*dwc->ep0_trb) * 2,
Felipe Balbi72246da2011-08-19 18:10:58 +03003098 dwc->ep0_trb, dwc->ep0_trb_addr);
3099
3100 dma_free_coherent(dwc->dev, sizeof(*dwc->ctrl_req),
3101 dwc->ctrl_req, dwc->ctrl_req_addr);
Felipe Balbi72246da2011-08-19 18:10:58 +03003102}
Felipe Balbi7415f172012-04-30 14:56:33 +03003103
Felipe Balbi0b0231a2014-10-07 10:19:23 -05003104int dwc3_gadget_suspend(struct dwc3 *dwc)
Felipe Balbi7415f172012-04-30 14:56:33 +03003105{
Felipe Balbi9f8a67b2016-05-04 15:50:27 +03003106 int ret;
3107
Roger Quadros9772b472016-04-12 11:33:29 +03003108 if (!dwc->gadget_driver)
3109 return 0;
3110
Felipe Balbi9f8a67b2016-05-04 15:50:27 +03003111 ret = dwc3_gadget_run_stop(dwc, false, false);
3112 if (ret < 0)
3113 return ret;
Felipe Balbi7415f172012-04-30 14:56:33 +03003114
Felipe Balbi9f8a67b2016-05-04 15:50:27 +03003115 dwc3_disconnect_gadget(dwc);
3116 __dwc3_gadget_stop(dwc);
Felipe Balbi7415f172012-04-30 14:56:33 +03003117
3118 return 0;
3119}
3120
3121int dwc3_gadget_resume(struct dwc3 *dwc)
3122{
Felipe Balbi7415f172012-04-30 14:56:33 +03003123 int ret;
3124
Roger Quadros9772b472016-04-12 11:33:29 +03003125 if (!dwc->gadget_driver)
3126 return 0;
3127
Felipe Balbi9f8a67b2016-05-04 15:50:27 +03003128 ret = __dwc3_gadget_start(dwc);
3129 if (ret < 0)
Felipe Balbi7415f172012-04-30 14:56:33 +03003130 goto err0;
3131
Felipe Balbi9f8a67b2016-05-04 15:50:27 +03003132 ret = dwc3_gadget_run_stop(dwc, true, false);
3133 if (ret < 0)
Felipe Balbi7415f172012-04-30 14:56:33 +03003134 goto err1;
3135
Felipe Balbi7415f172012-04-30 14:56:33 +03003136 return 0;
3137
3138err1:
Felipe Balbi9f8a67b2016-05-04 15:50:27 +03003139 __dwc3_gadget_stop(dwc);
Felipe Balbi7415f172012-04-30 14:56:33 +03003140
3141err0:
3142 return ret;
3143}
Felipe Balbifc8bb912016-05-16 13:14:48 +03003144
3145void dwc3_gadget_process_pending_events(struct dwc3 *dwc)
3146{
3147 if (dwc->pending_events) {
3148 dwc3_interrupt(dwc->irq_gadget, dwc->ev_buf);
3149 dwc->pending_events = false;
3150 enable_irq(dwc->irq_gadget);
3151 }
3152}