Linux Audio

Check our new training course

Loading...
v4.17
   1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * ep0.c - DesignWare USB3 DRD Controller Endpoint 0 Handling
   4 *
   5 * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com
   6 *
   7 * Authors: Felipe Balbi <balbi@ti.com>,
   8 *	    Sebastian Andrzej Siewior <bigeasy@linutronix.de>
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
   9 */
  10
  11#include <linux/kernel.h>
  12#include <linux/slab.h>
  13#include <linux/spinlock.h>
  14#include <linux/platform_device.h>
  15#include <linux/pm_runtime.h>
  16#include <linux/interrupt.h>
  17#include <linux/io.h>
  18#include <linux/list.h>
  19#include <linux/dma-mapping.h>
  20
  21#include <linux/usb/ch9.h>
  22#include <linux/usb/gadget.h>
  23#include <linux/usb/composite.h>
  24
  25#include "core.h"
  26#include "debug.h"
  27#include "gadget.h"
  28#include "io.h"
  29
  30static void __dwc3_ep0_do_control_status(struct dwc3 *dwc, struct dwc3_ep *dep);
  31static void __dwc3_ep0_do_control_data(struct dwc3 *dwc,
  32		struct dwc3_ep *dep, struct dwc3_request *req);
  33
  34static void dwc3_ep0_prepare_one_trb(struct dwc3_ep *dep,
  35		dma_addr_t buf_dma, u32 len, u32 type, bool chain)
  36{
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  37	struct dwc3_trb			*trb;
  38	struct dwc3			*dwc;
 
 
  39
  40	dwc = dep->dwc;
  41	trb = &dwc->ep0_trb[dep->trb_enqueue];
 
 
 
  42
  43	if (chain)
  44		dep->trb_enqueue++;
  45
  46	trb->bpl = lower_32_bits(buf_dma);
  47	trb->bph = upper_32_bits(buf_dma);
  48	trb->size = len;
  49	trb->ctrl = type;
  50
  51	trb->ctrl |= (DWC3_TRB_CTRL_HWO
 
 
  52			| DWC3_TRB_CTRL_ISP_IMI);
  53
  54	if (chain)
  55		trb->ctrl |= DWC3_TRB_CTRL_CHN;
  56	else
  57		trb->ctrl |= (DWC3_TRB_CTRL_IOC
  58				| DWC3_TRB_CTRL_LST);
  59
  60	trace_dwc3_prepare_trb(dep, trb);
  61}
  62
  63static int dwc3_ep0_start_trans(struct dwc3_ep *dep)
  64{
  65	struct dwc3_gadget_ep_cmd_params params;
  66	struct dwc3			*dwc;
  67	int				ret;
  68
  69	if (dep->flags & DWC3_EP_BUSY)
  70		return 0;
  71
  72	dwc = dep->dwc;
  73
  74	memset(&params, 0, sizeof(params));
  75	params.param0 = upper_32_bits(dwc->ep0_trb_addr);
  76	params.param1 = lower_32_bits(dwc->ep0_trb_addr);
  77
  78	ret = dwc3_send_gadget_ep_cmd(dep, DWC3_DEPCMD_STARTTRANSFER, &params);
  79	if (ret < 0)
 
 
  80		return ret;
 
  81
  82	dep->flags |= DWC3_EP_BUSY;
  83	dep->resource_index = dwc3_gadget_ep_get_transfer_index(dep);
 
 
  84	dwc->ep0_next_event = DWC3_EP0_COMPLETE;
  85
  86	return 0;
  87}
  88
  89static int __dwc3_gadget_ep0_queue(struct dwc3_ep *dep,
  90		struct dwc3_request *req)
  91{
  92	struct dwc3		*dwc = dep->dwc;
 
  93
  94	req->request.actual	= 0;
  95	req->request.status	= -EINPROGRESS;
  96	req->epnum		= dep->number;
  97
  98	list_add_tail(&req->list, &dep->pending_list);
  99
 100	/*
 101	 * Gadget driver might not be quick enough to queue a request
 102	 * before we get a Transfer Not Ready event on this endpoint.
 103	 *
 104	 * In that case, we will set DWC3_EP_PENDING_REQUEST. When that
 105	 * flag is set, it's telling us that as soon as Gadget queues the
 106	 * required request, we should kick the transfer here because the
 107	 * IRQ we were waiting for is long gone.
 108	 */
 109	if (dep->flags & DWC3_EP_PENDING_REQUEST) {
 110		unsigned	direction;
 111
 112		direction = !!(dep->flags & DWC3_EP0_DIR_IN);
 113
 114		if (dwc->ep0state != EP0_DATA_PHASE) {
 115			dev_WARN(dwc->dev, "Unexpected pending request\n");
 116			return 0;
 117		}
 118
 119		__dwc3_ep0_do_control_data(dwc, dwc->eps[direction], req);
 120
 
 121		dep->flags &= ~(DWC3_EP_PENDING_REQUEST |
 122				DWC3_EP0_DIR_IN);
 123
 124		return 0;
 125	}
 126
 127	/*
 128	 * In case gadget driver asked us to delay the STATUS phase,
 129	 * handle it here.
 130	 */
 131	if (dwc->delayed_status) {
 132		unsigned	direction;
 133
 134		direction = !dwc->ep0_expect_in;
 135		dwc->delayed_status = false;
 136		usb_gadget_set_state(&dwc->gadget, USB_STATE_CONFIGURED);
 137
 138		if (dwc->ep0state == EP0_STATUS_PHASE)
 139			__dwc3_ep0_do_control_status(dwc, dwc->eps[direction]);
 140
 141		return 0;
 142	}
 143
 144	/*
 145	 * Unfortunately we have uncovered a limitation wrt the Data Phase.
 146	 *
 147	 * Section 9.4 says we can wait for the XferNotReady(DATA) event to
 148	 * come before issueing Start Transfer command, but if we do, we will
 149	 * miss situations where the host starts another SETUP phase instead of
 150	 * the DATA phase.  Such cases happen at least on TD.7.6 of the Link
 151	 * Layer Compliance Suite.
 152	 *
 153	 * The problem surfaces due to the fact that in case of back-to-back
 154	 * SETUP packets there will be no XferNotReady(DATA) generated and we
 155	 * will be stuck waiting for XferNotReady(DATA) forever.
 156	 *
 157	 * By looking at tables 9-13 and 9-14 of the Databook, we can see that
 158	 * it tells us to start Data Phase right away. It also mentions that if
 159	 * we receive a SETUP phase instead of the DATA phase, core will issue
 160	 * XferComplete for the DATA phase, before actually initiating it in
 161	 * the wire, with the TRB's status set to "SETUP_PENDING". Such status
 162	 * can only be used to print some debugging logs, as the core expects
 163	 * us to go through to the STATUS phase and start a CONTROL_STATUS TRB,
 164	 * just so it completes right away, without transferring anything and,
 165	 * only then, we can go back to the SETUP phase.
 166	 *
 167	 * Because of this scenario, SNPS decided to change the programming
 168	 * model of control transfers and support on-demand transfers only for
 169	 * the STATUS phase. To fix the issue we have now, we will always wait
 170	 * for gadget driver to queue the DATA phase's struct usb_request, then
 171	 * start it right away.
 172	 *
 173	 * If we're actually in a 2-stage transfer, we will wait for
 174	 * XferNotReady(STATUS).
 175	 */
 176	if (dwc->three_stage_setup) {
 177		unsigned        direction;
 178
 179		direction = dwc->ep0_expect_in;
 180		dwc->ep0state = EP0_DATA_PHASE;
 181
 182		__dwc3_ep0_do_control_data(dwc, dwc->eps[direction], req);
 183
 184		dep->flags &= ~DWC3_EP0_DIR_IN;
 185	}
 186
 187	return 0;
 188}
 189
 190int dwc3_gadget_ep0_queue(struct usb_ep *ep, struct usb_request *request,
 191		gfp_t gfp_flags)
 192{
 193	struct dwc3_request		*req = to_dwc3_request(request);
 194	struct dwc3_ep			*dep = to_dwc3_ep(ep);
 195	struct dwc3			*dwc = dep->dwc;
 196
 197	unsigned long			flags;
 198
 199	int				ret;
 200
 201	spin_lock_irqsave(&dwc->lock, flags);
 202	if (!dep->endpoint.desc) {
 203		dev_err(dwc->dev, "%s: can't queue to disabled endpoint\n",
 204				dep->name);
 205		ret = -ESHUTDOWN;
 206		goto out;
 207	}
 208
 209	/* we share one TRB for ep0/1 */
 210	if (!list_empty(&dep->pending_list)) {
 211		ret = -EBUSY;
 212		goto out;
 213	}
 214
 
 
 
 
 215	ret = __dwc3_gadget_ep0_queue(dep, req);
 216
 217out:
 218	spin_unlock_irqrestore(&dwc->lock, flags);
 219
 220	return ret;
 221}
 222
 223static void dwc3_ep0_stall_and_restart(struct dwc3 *dwc)
 224{
 225	struct dwc3_ep		*dep;
 226
 227	/* reinitialize physical ep1 */
 228	dep = dwc->eps[1];
 229	dep->flags = DWC3_EP_ENABLED;
 230
 231	/* stall is always issued on EP0 */
 232	dep = dwc->eps[0];
 233	__dwc3_gadget_ep_set_halt(dep, 1, false);
 234	dep->flags = DWC3_EP_ENABLED;
 235	dwc->delayed_status = false;
 236
 237	if (!list_empty(&dep->pending_list)) {
 238		struct dwc3_request	*req;
 239
 240		req = next_request(&dep->pending_list);
 241		dwc3_gadget_giveback(dep, req, -ECONNRESET);
 242	}
 243
 244	dwc->ep0state = EP0_SETUP_PHASE;
 245	dwc3_ep0_out_start(dwc);
 246}
 247
 248int __dwc3_gadget_ep0_set_halt(struct usb_ep *ep, int value)
 249{
 250	struct dwc3_ep			*dep = to_dwc3_ep(ep);
 251	struct dwc3			*dwc = dep->dwc;
 252
 253	dwc3_ep0_stall_and_restart(dwc);
 254
 255	return 0;
 256}
 257
 258int dwc3_gadget_ep0_set_halt(struct usb_ep *ep, int value)
 259{
 260	struct dwc3_ep			*dep = to_dwc3_ep(ep);
 261	struct dwc3			*dwc = dep->dwc;
 262	unsigned long			flags;
 263	int				ret;
 264
 265	spin_lock_irqsave(&dwc->lock, flags);
 266	ret = __dwc3_gadget_ep0_set_halt(ep, value);
 267	spin_unlock_irqrestore(&dwc->lock, flags);
 268
 269	return ret;
 270}
 271
 272void dwc3_ep0_out_start(struct dwc3 *dwc)
 273{
 274	struct dwc3_ep			*dep;
 275	int				ret;
 276
 277	complete(&dwc->ep0_in_setup);
 278
 279	dep = dwc->eps[0];
 280	dwc3_ep0_prepare_one_trb(dep, dwc->ep0_trb_addr, 8,
 281			DWC3_TRBCTL_CONTROL_SETUP, false);
 282	ret = dwc3_ep0_start_trans(dep);
 283	WARN_ON(ret < 0);
 284}
 285
 286static struct dwc3_ep *dwc3_wIndex_to_dep(struct dwc3 *dwc, __le16 wIndex_le)
 287{
 288	struct dwc3_ep		*dep;
 289	u32			windex = le16_to_cpu(wIndex_le);
 290	u32			epnum;
 291
 292	epnum = (windex & USB_ENDPOINT_NUMBER_MASK) << 1;
 293	if ((windex & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN)
 294		epnum |= 1;
 295
 296	dep = dwc->eps[epnum];
 297	if (dep->flags & DWC3_EP_ENABLED)
 298		return dep;
 299
 300	return NULL;
 301}
 302
 303static void dwc3_ep0_status_cmpl(struct usb_ep *ep, struct usb_request *req)
 304{
 305}
 306/*
 307 * ch 9.4.5
 308 */
 309static int dwc3_ep0_handle_status(struct dwc3 *dwc,
 310		struct usb_ctrlrequest *ctrl)
 311{
 312	struct dwc3_ep		*dep;
 313	u32			recip;
 314	u32			value;
 315	u32			reg;
 316	u16			usb_status = 0;
 317	__le16			*response_pkt;
 318
 319	/* We don't support PTM_STATUS */
 320	value = le16_to_cpu(ctrl->wValue);
 321	if (value != 0)
 322		return -EINVAL;
 323
 324	recip = ctrl->bRequestType & USB_RECIP_MASK;
 325	switch (recip) {
 326	case USB_RECIP_DEVICE:
 327		/*
 328		 * LTM will be set once we know how to set this in HW.
 329		 */
 330		usb_status |= dwc->gadget.is_selfpowered;
 331
 332		if ((dwc->speed == DWC3_DSTS_SUPERSPEED) ||
 333		    (dwc->speed == DWC3_DSTS_SUPERSPEED_PLUS)) {
 334			reg = dwc3_readl(dwc->regs, DWC3_DCTL);
 335			if (reg & DWC3_DCTL_INITU1ENA)
 336				usb_status |= 1 << USB_DEV_STAT_U1_ENABLED;
 337			if (reg & DWC3_DCTL_INITU2ENA)
 338				usb_status |= 1 << USB_DEV_STAT_U2_ENABLED;
 339		}
 340
 341		break;
 342
 343	case USB_RECIP_INTERFACE:
 344		/*
 345		 * Function Remote Wake Capable	D0
 346		 * Function Remote Wakeup	D1
 347		 */
 348		break;
 349
 350	case USB_RECIP_ENDPOINT:
 351		dep = dwc3_wIndex_to_dep(dwc, ctrl->wIndex);
 352		if (!dep)
 353			return -EINVAL;
 354
 355		if (dep->flags & DWC3_EP_STALL)
 356			usb_status = 1 << USB_ENDPOINT_HALT;
 357		break;
 358	default:
 359		return -EINVAL;
 360	}
 361
 362	response_pkt = (__le16 *) dwc->setup_buf;
 363	*response_pkt = cpu_to_le16(usb_status);
 364
 365	dep = dwc->eps[0];
 366	dwc->ep0_usb_req.dep = dep;
 367	dwc->ep0_usb_req.request.length = sizeof(*response_pkt);
 368	dwc->ep0_usb_req.request.buf = dwc->setup_buf;
 369	dwc->ep0_usb_req.request.complete = dwc3_ep0_status_cmpl;
 370
 371	return __dwc3_gadget_ep0_queue(dep, &dwc->ep0_usb_req);
 372}
 373
 374static int dwc3_ep0_handle_u1(struct dwc3 *dwc, enum usb_device_state state,
 375		int set)
 376{
 377	u32 reg;
 378
 379	if (state != USB_STATE_CONFIGURED)
 380		return -EINVAL;
 381	if ((dwc->speed != DWC3_DSTS_SUPERSPEED) &&
 382			(dwc->speed != DWC3_DSTS_SUPERSPEED_PLUS))
 383		return -EINVAL;
 384
 385	reg = dwc3_readl(dwc->regs, DWC3_DCTL);
 386	if (set)
 387		reg |= DWC3_DCTL_INITU1ENA;
 388	else
 389		reg &= ~DWC3_DCTL_INITU1ENA;
 390	dwc3_writel(dwc->regs, DWC3_DCTL, reg);
 391
 392	return 0;
 393}
 394
 395static int dwc3_ep0_handle_u2(struct dwc3 *dwc, enum usb_device_state state,
 396		int set)
 397{
 398	u32 reg;
 399
 400
 401	if (state != USB_STATE_CONFIGURED)
 402		return -EINVAL;
 403	if ((dwc->speed != DWC3_DSTS_SUPERSPEED) &&
 404			(dwc->speed != DWC3_DSTS_SUPERSPEED_PLUS))
 405		return -EINVAL;
 406
 407	reg = dwc3_readl(dwc->regs, DWC3_DCTL);
 408	if (set)
 409		reg |= DWC3_DCTL_INITU2ENA;
 410	else
 411		reg &= ~DWC3_DCTL_INITU2ENA;
 412	dwc3_writel(dwc->regs, DWC3_DCTL, reg);
 413
 414	return 0;
 415}
 416
 417static int dwc3_ep0_handle_test(struct dwc3 *dwc, enum usb_device_state state,
 418		u32 wIndex, int set)
 419{
 420	if ((wIndex & 0xff) != 0)
 421		return -EINVAL;
 422	if (!set)
 423		return -EINVAL;
 424
 425	switch (wIndex >> 8) {
 426	case TEST_J:
 427	case TEST_K:
 428	case TEST_SE0_NAK:
 429	case TEST_PACKET:
 430	case TEST_FORCE_EN:
 431		dwc->test_mode_nr = wIndex >> 8;
 432		dwc->test_mode = true;
 433		break;
 434	default:
 435		return -EINVAL;
 436	}
 437
 438	return 0;
 439}
 440
 441static int dwc3_ep0_handle_device(struct dwc3 *dwc,
 442		struct usb_ctrlrequest *ctrl, int set)
 443{
 444	enum usb_device_state	state;
 
 445	u32			wValue;
 446	u32			wIndex;
 447	int			ret = 0;
 
 448
 449	wValue = le16_to_cpu(ctrl->wValue);
 450	wIndex = le16_to_cpu(ctrl->wIndex);
 451	state = dwc->gadget.state;
 452
 453	switch (wValue) {
 454	case USB_DEVICE_REMOTE_WAKEUP:
 455		break;
 456	/*
 457	 * 9.4.1 says only only for SS, in AddressState only for
 458	 * default control pipe
 459	 */
 460	case USB_DEVICE_U1_ENABLE:
 461		ret = dwc3_ep0_handle_u1(dwc, state, set);
 462		break;
 463	case USB_DEVICE_U2_ENABLE:
 464		ret = dwc3_ep0_handle_u2(dwc, state, set);
 465		break;
 466	case USB_DEVICE_LTM_ENABLE:
 467		ret = -EINVAL;
 468		break;
 469	case USB_DEVICE_TEST_MODE:
 470		ret = dwc3_ep0_handle_test(dwc, state, wIndex, set);
 471		break;
 472	default:
 473		ret = -EINVAL;
 474	}
 475
 476	return ret;
 477}
 478
 479static int dwc3_ep0_handle_intf(struct dwc3 *dwc,
 480		struct usb_ctrlrequest *ctrl, int set)
 481{
 482	u32			wValue;
 483	int			ret = 0;
 484
 485	wValue = le16_to_cpu(ctrl->wValue);
 486
 487	switch (wValue) {
 488	case USB_INTRF_FUNC_SUSPEND:
 
 489		/*
 490		 * REVISIT: Ideally we would enable some low power mode here,
 491		 * however it's unclear what we should be doing here.
 492		 *
 493		 * For now, we're not doing anything, just making sure we return
 494		 * 0 so USB Command Verifier tests pass without any errors.
 495		 */
 496		break;
 497	default:
 498		ret = -EINVAL;
 499	}
 
 500
 501	return ret;
 502}
 
 
 
 
 
 503
 504static int dwc3_ep0_handle_endpoint(struct dwc3 *dwc,
 505		struct usb_ctrlrequest *ctrl, int set)
 506{
 507	struct dwc3_ep		*dep;
 508	u32			wValue;
 509	int			ret;
 510
 511	wValue = le16_to_cpu(ctrl->wValue);
 
 
 
 
 
 
 512
 513	switch (wValue) {
 514	case USB_ENDPOINT_HALT:
 515		dep = dwc3_wIndex_to_dep(dwc, ctrl->wIndex);
 516		if (!dep)
 517			return -EINVAL;
 518
 519		if (set == 0 && (dep->flags & DWC3_EP_WEDGE))
 520			break;
 521
 522		ret = __dwc3_gadget_ep_set_halt(dep, set, true);
 523		if (ret)
 
 
 
 
 
 
 
 
 524			return -EINVAL;
 
 525		break;
 526	default:
 527		return -EINVAL;
 528	}
 529
 530	return 0;
 531}
 532
 533static int dwc3_ep0_handle_feature(struct dwc3 *dwc,
 534		struct usb_ctrlrequest *ctrl, int set)
 535{
 536	u32			recip;
 537	int			ret;
 538
 539	recip = ctrl->bRequestType & USB_RECIP_MASK;
 540
 541	switch (recip) {
 542	case USB_RECIP_DEVICE:
 543		ret = dwc3_ep0_handle_device(dwc, ctrl, set);
 544		break;
 545	case USB_RECIP_INTERFACE:
 546		ret = dwc3_ep0_handle_intf(dwc, ctrl, set);
 
 
 
 
 
 
 
 
 
 
 
 547		break;
 
 548	case USB_RECIP_ENDPOINT:
 549		ret = dwc3_ep0_handle_endpoint(dwc, ctrl, set);
 
 
 
 
 
 
 
 
 
 
 
 550		break;
 
 551	default:
 552		ret = -EINVAL;
 553	}
 554
 555	return ret;
 556}
 557
 558static int dwc3_ep0_set_address(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 559{
 560	enum usb_device_state state = dwc->gadget.state;
 561	u32 addr;
 562	u32 reg;
 563
 564	addr = le16_to_cpu(ctrl->wValue);
 565	if (addr > 127) {
 566		dev_err(dwc->dev, "invalid device address %d\n", addr);
 567		return -EINVAL;
 568	}
 569
 570	if (state == USB_STATE_CONFIGURED) {
 571		dev_err(dwc->dev, "can't SetAddress() from Configured State\n");
 572		return -EINVAL;
 573	}
 574
 575	reg = dwc3_readl(dwc->regs, DWC3_DCFG);
 576	reg &= ~(DWC3_DCFG_DEVADDR_MASK);
 577	reg |= DWC3_DCFG_DEVADDR(addr);
 578	dwc3_writel(dwc->regs, DWC3_DCFG, reg);
 579
 580	if (addr)
 581		usb_gadget_set_state(&dwc->gadget, USB_STATE_ADDRESS);
 582	else
 583		usb_gadget_set_state(&dwc->gadget, USB_STATE_DEFAULT);
 584
 585	return 0;
 586}
 587
 588static int dwc3_ep0_delegate_req(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 589{
 590	int ret;
 591
 592	spin_unlock(&dwc->lock);
 593	ret = dwc->gadget_driver->setup(&dwc->gadget, ctrl);
 594	spin_lock(&dwc->lock);
 595	return ret;
 596}
 597
 598static int dwc3_ep0_set_config(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 599{
 600	enum usb_device_state state = dwc->gadget.state;
 601	u32 cfg;
 602	int ret;
 603	u32 reg;
 604
 
 605	cfg = le16_to_cpu(ctrl->wValue);
 606
 607	switch (state) {
 608	case USB_STATE_DEFAULT:
 609		return -EINVAL;
 
 610
 611	case USB_STATE_ADDRESS:
 612		ret = dwc3_ep0_delegate_req(dwc, ctrl);
 613		/* if the cfg matches and the cfg is non zero */
 614		if (cfg && (!ret || (ret == USB_GADGET_DELAYED_STATUS))) {
 615
 616			/*
 617			 * only change state if set_config has already
 618			 * been processed. If gadget driver returns
 619			 * USB_GADGET_DELAYED_STATUS, we will wait
 620			 * to change the state on the next usb_ep_queue()
 621			 */
 622			if (ret == 0)
 623				usb_gadget_set_state(&dwc->gadget,
 624						USB_STATE_CONFIGURED);
 625
 626			/*
 627			 * Enable transition to U1/U2 state when
 628			 * nothing is pending from application.
 629			 */
 630			reg = dwc3_readl(dwc->regs, DWC3_DCTL);
 631			reg |= (DWC3_DCTL_ACCEPTU1ENA | DWC3_DCTL_ACCEPTU2ENA);
 632			dwc3_writel(dwc->regs, DWC3_DCTL, reg);
 633		}
 634		break;
 635
 636	case USB_STATE_CONFIGURED:
 637		ret = dwc3_ep0_delegate_req(dwc, ctrl);
 638		if (!cfg && !ret)
 639			usb_gadget_set_state(&dwc->gadget,
 640					USB_STATE_ADDRESS);
 641		break;
 642	default:
 643		ret = -EINVAL;
 644	}
 645	return ret;
 646}
 647
 648static void dwc3_ep0_set_sel_cmpl(struct usb_ep *ep, struct usb_request *req)
 649{
 650	struct dwc3_ep	*dep = to_dwc3_ep(ep);
 651	struct dwc3	*dwc = dep->dwc;
 652
 653	u32		param = 0;
 654	u32		reg;
 655
 656	struct timing {
 657		u8	u1sel;
 658		u8	u1pel;
 659		__le16	u2sel;
 660		__le16	u2pel;
 661	} __packed timing;
 662
 663	int		ret;
 664
 665	memcpy(&timing, req->buf, sizeof(timing));
 666
 667	dwc->u1sel = timing.u1sel;
 668	dwc->u1pel = timing.u1pel;
 669	dwc->u2sel = le16_to_cpu(timing.u2sel);
 670	dwc->u2pel = le16_to_cpu(timing.u2pel);
 671
 672	reg = dwc3_readl(dwc->regs, DWC3_DCTL);
 673	if (reg & DWC3_DCTL_INITU2ENA)
 674		param = dwc->u2pel;
 675	if (reg & DWC3_DCTL_INITU1ENA)
 676		param = dwc->u1pel;
 677
 678	/*
 679	 * According to Synopsys Databook, if parameter is
 680	 * greater than 125, a value of zero should be
 681	 * programmed in the register.
 682	 */
 683	if (param > 125)
 684		param = 0;
 685
 686	/* now that we have the time, issue DGCMD Set Sel */
 687	ret = dwc3_send_gadget_generic_command(dwc,
 688			DWC3_DGCMD_SET_PERIODIC_PAR, param);
 689	WARN_ON(ret < 0);
 690}
 691
 692static int dwc3_ep0_set_sel(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 693{
 694	struct dwc3_ep	*dep;
 695	enum usb_device_state state = dwc->gadget.state;
 696	u16		wLength;
 
 697
 698	if (state == USB_STATE_DEFAULT)
 699		return -EINVAL;
 700
 
 701	wLength = le16_to_cpu(ctrl->wLength);
 702
 703	if (wLength != 6) {
 704		dev_err(dwc->dev, "Set SEL should be 6 bytes, got %d\n",
 705				wLength);
 706		return -EINVAL;
 707	}
 708
 709	/*
 710	 * To handle Set SEL we need to receive 6 bytes from Host. So let's
 711	 * queue a usb_request for 6 bytes.
 712	 *
 713	 * Remember, though, this controller can't handle non-wMaxPacketSize
 714	 * aligned transfers on the OUT direction, so we queue a request for
 715	 * wMaxPacketSize instead.
 716	 */
 717	dep = dwc->eps[0];
 718	dwc->ep0_usb_req.dep = dep;
 719	dwc->ep0_usb_req.request.length = dep->endpoint.maxpacket;
 720	dwc->ep0_usb_req.request.buf = dwc->setup_buf;
 721	dwc->ep0_usb_req.request.complete = dwc3_ep0_set_sel_cmpl;
 722
 723	return __dwc3_gadget_ep0_queue(dep, &dwc->ep0_usb_req);
 724}
 725
 726static int dwc3_ep0_set_isoch_delay(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 727{
 728	u16		wLength;
 729	u16		wValue;
 730	u16		wIndex;
 731
 732	wValue = le16_to_cpu(ctrl->wValue);
 733	wLength = le16_to_cpu(ctrl->wLength);
 734	wIndex = le16_to_cpu(ctrl->wIndex);
 735
 736	if (wIndex || wLength)
 737		return -EINVAL;
 738
 739	dwc->gadget.isoch_delay = wValue;
 
 
 
 
 740
 741	return 0;
 742}
 743
 744static int dwc3_ep0_std_request(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 745{
 746	int ret;
 747
 748	switch (ctrl->bRequest) {
 749	case USB_REQ_GET_STATUS:
 
 750		ret = dwc3_ep0_handle_status(dwc, ctrl);
 751		break;
 752	case USB_REQ_CLEAR_FEATURE:
 
 753		ret = dwc3_ep0_handle_feature(dwc, ctrl, 0);
 754		break;
 755	case USB_REQ_SET_FEATURE:
 
 756		ret = dwc3_ep0_handle_feature(dwc, ctrl, 1);
 757		break;
 758	case USB_REQ_SET_ADDRESS:
 
 759		ret = dwc3_ep0_set_address(dwc, ctrl);
 760		break;
 761	case USB_REQ_SET_CONFIGURATION:
 
 762		ret = dwc3_ep0_set_config(dwc, ctrl);
 763		break;
 764	case USB_REQ_SET_SEL:
 
 765		ret = dwc3_ep0_set_sel(dwc, ctrl);
 766		break;
 767	case USB_REQ_SET_ISOCH_DELAY:
 
 768		ret = dwc3_ep0_set_isoch_delay(dwc, ctrl);
 769		break;
 770	default:
 
 771		ret = dwc3_ep0_delegate_req(dwc, ctrl);
 772		break;
 773	}
 774
 775	return ret;
 776}
 777
 778static void dwc3_ep0_inspect_setup(struct dwc3 *dwc,
 779		const struct dwc3_event_depevt *event)
 780{
 781	struct usb_ctrlrequest *ctrl = (void *) dwc->ep0_trb;
 782	int ret = -EINVAL;
 783	u32 len;
 784
 785	if (!dwc->gadget_driver)
 786		goto out;
 787
 788	trace_dwc3_ctrl_req(ctrl);
 789
 790	len = le16_to_cpu(ctrl->wLength);
 791	if (!len) {
 792		dwc->three_stage_setup = false;
 793		dwc->ep0_expect_in = false;
 794		dwc->ep0_next_event = DWC3_EP0_NRDY_STATUS;
 795	} else {
 796		dwc->three_stage_setup = true;
 797		dwc->ep0_expect_in = !!(ctrl->bRequestType & USB_DIR_IN);
 798		dwc->ep0_next_event = DWC3_EP0_NRDY_DATA;
 799	}
 800
 801	if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD)
 802		ret = dwc3_ep0_std_request(dwc, ctrl);
 803	else
 804		ret = dwc3_ep0_delegate_req(dwc, ctrl);
 805
 806	if (ret == USB_GADGET_DELAYED_STATUS)
 807		dwc->delayed_status = true;
 808
 809out:
 810	if (ret < 0)
 811		dwc3_ep0_stall_and_restart(dwc);
 
 
 812}
 813
 814static void dwc3_ep0_complete_data(struct dwc3 *dwc,
 815		const struct dwc3_event_depevt *event)
 816{
 817	struct dwc3_request	*r;
 818	struct usb_request	*ur;
 819	struct dwc3_trb		*trb;
 820	struct dwc3_ep		*ep0;
 821	u32			transferred = 0;
 822	u32			status;
 823	u32			length;
 824	u8			epnum;
 825
 826	epnum = event->endpoint_number;
 827	ep0 = dwc->eps[0];
 828
 829	dwc->ep0_next_event = DWC3_EP0_NRDY_STATUS;
 830	trb = dwc->ep0_trb;
 831	trace_dwc3_complete_trb(ep0, trb);
 832
 833	r = next_request(&ep0->pending_list);
 834	if (!r)
 835		return;
 836
 837	status = DWC3_TRB_SIZE_TRBSTS(trb->size);
 838	if (status == DWC3_TRBSTS_SETUP_PENDING) {
 839		dwc->setup_packet_pending = true;
 840		if (r)
 841			dwc3_gadget_giveback(ep0, r, -ECONNRESET);
 842
 843		return;
 
 
 
 
 
 
 
 
 
 844	}
 845
 846	ur = &r->request;
 847
 848	length = trb->size & DWC3_TRB_SIZE_MASK;
 849	transferred = ur->length - length;
 850	ur->actual += transferred;
 851
 852	if ((IS_ALIGNED(ur->length, ep0->endpoint.maxpacket) &&
 853	     ur->length && ur->zero) || dwc->ep0_bounced) {
 854		trb++;
 855		trb->ctrl &= ~DWC3_TRB_CTRL_HWO;
 856		trace_dwc3_complete_trb(ep0, trb);
 857
 858		if (r->direction)
 859			dwc->eps[1]->trb_enqueue = 0;
 860		else
 861			dwc->eps[0]->trb_enqueue = 0;
 862
 863		dwc->ep0_bounced = false;
 864	}
 865
 866	if ((epnum & 1) && ur->actual < ur->length)
 867		dwc3_ep0_stall_and_restart(dwc);
 868	else
 869		dwc3_gadget_giveback(ep0, r, 0);
 
 
 
 
 
 
 870}
 871
 872static void dwc3_ep0_complete_status(struct dwc3 *dwc,
 873		const struct dwc3_event_depevt *event)
 874{
 875	struct dwc3_request	*r;
 876	struct dwc3_ep		*dep;
 877	struct dwc3_trb		*trb;
 878	u32			status;
 879
 880	dep = dwc->eps[0];
 881	trb = dwc->ep0_trb;
 882
 883	trace_dwc3_complete_trb(dep, trb);
 884
 885	if (!list_empty(&dep->pending_list)) {
 886		r = next_request(&dep->pending_list);
 887
 888		dwc3_gadget_giveback(dep, r, 0);
 889	}
 890
 891	if (dwc->test_mode) {
 892		int ret;
 893
 894		ret = dwc3_gadget_set_test_mode(dwc, dwc->test_mode_nr);
 895		if (ret < 0) {
 896			dev_err(dwc->dev, "invalid test #%d\n",
 897					dwc->test_mode_nr);
 898			dwc3_ep0_stall_and_restart(dwc);
 899			return;
 900		}
 901	}
 902
 903	status = DWC3_TRB_SIZE_TRBSTS(trb->size);
 904	if (status == DWC3_TRBSTS_SETUP_PENDING)
 905		dwc->setup_packet_pending = true;
 906
 907	dwc->ep0state = EP0_SETUP_PHASE;
 908	dwc3_ep0_out_start(dwc);
 909}
 910
 911static void dwc3_ep0_xfer_complete(struct dwc3 *dwc,
 912			const struct dwc3_event_depevt *event)
 913{
 914	struct dwc3_ep		*dep = dwc->eps[event->endpoint_number];
 915
 916	dep->flags &= ~DWC3_EP_BUSY;
 917	dep->resource_index = 0;
 918	dwc->setup_packet_pending = false;
 919
 920	switch (dwc->ep0state) {
 921	case EP0_SETUP_PHASE:
 
 922		dwc3_ep0_inspect_setup(dwc, event);
 923		break;
 924
 925	case EP0_DATA_PHASE:
 
 926		dwc3_ep0_complete_data(dwc, event);
 927		break;
 928
 929	case EP0_STATUS_PHASE:
 930		dwc3_ep0_complete_status(dwc, event);
 
 931		break;
 932	default:
 933		WARN(true, "UNKNOWN ep0state %d\n", dwc->ep0state);
 934	}
 935}
 936
 937static void __dwc3_ep0_do_control_data(struct dwc3 *dwc,
 938		struct dwc3_ep *dep, struct dwc3_request *req)
 
 
 
 
 
 
 939{
 
 
 940	int			ret;
 941
 942	req->direction = !!dep->number;
 943
 944	if (req->request.length == 0) {
 945		dwc3_ep0_prepare_one_trb(dep, dwc->ep0_trb_addr, 0,
 946				DWC3_TRBCTL_CONTROL_DATA, false);
 947		ret = dwc3_ep0_start_trans(dep);
 948	} else if (!IS_ALIGNED(req->request.length, dep->endpoint.maxpacket)
 949			&& (dep->number == 0)) {
 950		u32	maxpacket;
 951		u32	rem;
 952
 953		ret = usb_gadget_map_request_by_dev(dwc->sysdev,
 954				&req->request, dep->number);
 955		if (ret)
 956			return;
 957
 958		maxpacket = dep->endpoint.maxpacket;
 959		rem = req->request.length % maxpacket;
 960		dwc->ep0_bounced = true;
 
 
 
 
 961
 962		/* prepare normal TRB */
 963		dwc3_ep0_prepare_one_trb(dep, req->request.dma,
 964					 req->request.length,
 965					 DWC3_TRBCTL_CONTROL_DATA,
 966					 true);
 967
 968		req->trb = &dwc->ep0_trb[dep->trb_enqueue - 1];
 969
 970		/* Now prepare one extra TRB to align transfer size */
 971		dwc3_ep0_prepare_one_trb(dep, dwc->bounce_addr,
 972					 maxpacket - rem,
 973					 DWC3_TRBCTL_CONTROL_DATA,
 974					 false);
 975		ret = dwc3_ep0_start_trans(dep);
 976	} else if (IS_ALIGNED(req->request.length, dep->endpoint.maxpacket) &&
 977		   req->request.length && req->request.zero) {
 978		u32	maxpacket;
 979
 980		ret = usb_gadget_map_request_by_dev(dwc->sysdev,
 981				&req->request, dep->number);
 982		if (ret)
 983			return;
 
 
 
 984
 985		maxpacket = dep->endpoint.maxpacket;
 986
 987		/* prepare normal TRB */
 988		dwc3_ep0_prepare_one_trb(dep, req->request.dma,
 989					 req->request.length,
 990					 DWC3_TRBCTL_CONTROL_DATA,
 991					 true);
 992
 993		req->trb = &dwc->ep0_trb[dep->trb_enqueue - 1];
 994
 995		/* Now prepare one extra TRB to align transfer size */
 996		dwc3_ep0_prepare_one_trb(dep, dwc->bounce_addr,
 997					 0, DWC3_TRBCTL_CONTROL_DATA,
 998					 false);
 999		ret = dwc3_ep0_start_trans(dep);
1000	} else {
1001		ret = usb_gadget_map_request_by_dev(dwc->sysdev,
1002				&req->request, dep->number);
1003		if (ret)
 
1004			return;
 
1005
1006		dwc3_ep0_prepare_one_trb(dep, req->request.dma,
1007				req->request.length, DWC3_TRBCTL_CONTROL_DATA,
1008				false);
1009
1010		req->trb = &dwc->ep0_trb[dep->trb_enqueue];
1011
1012		ret = dwc3_ep0_start_trans(dep);
1013	}
1014
1015	WARN_ON(ret < 0);
1016}
1017
1018static int dwc3_ep0_start_control_status(struct dwc3_ep *dep)
1019{
1020	struct dwc3		*dwc = dep->dwc;
1021	u32			type;
1022
1023	type = dwc->three_stage_setup ? DWC3_TRBCTL_CONTROL_STATUS3
1024		: DWC3_TRBCTL_CONTROL_STATUS2;
1025
1026	dwc3_ep0_prepare_one_trb(dep, dwc->ep0_trb_addr, 0, type, false);
1027	return dwc3_ep0_start_trans(dep);
1028}
1029
1030static void __dwc3_ep0_do_control_status(struct dwc3 *dwc, struct dwc3_ep *dep)
1031{
 
 
 
 
 
 
 
 
1032	WARN_ON(dwc3_ep0_start_control_status(dep));
1033}
1034
1035static void dwc3_ep0_do_control_status(struct dwc3 *dwc,
1036		const struct dwc3_event_depevt *event)
1037{
1038	struct dwc3_ep		*dep = dwc->eps[event->endpoint_number];
1039
1040	__dwc3_ep0_do_control_status(dwc, dep);
1041}
1042
1043static void dwc3_ep0_end_control_data(struct dwc3 *dwc, struct dwc3_ep *dep)
1044{
1045	struct dwc3_gadget_ep_cmd_params params;
1046	u32			cmd;
1047	int			ret;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1048
1049	if (!dep->resource_index)
1050		return;
 
1051
1052	cmd = DWC3_DEPCMD_ENDTRANSFER;
1053	cmd |= DWC3_DEPCMD_CMDIOC;
1054	cmd |= DWC3_DEPCMD_PARAM(dep->resource_index);
1055	memset(&params, 0, sizeof(params));
1056	ret = dwc3_send_gadget_ep_cmd(dep, cmd, &params);
1057	WARN_ON_ONCE(ret);
1058	dep->resource_index = 0;
1059}
1060
1061static void dwc3_ep0_xfernotready(struct dwc3 *dwc,
1062		const struct dwc3_event_depevt *event)
1063{
1064	switch (event->status) {
 
 
 
 
 
 
 
 
1065	case DEPEVT_STATUS_CONTROL_DATA:
 
 
 
 
 
 
 
 
 
 
 
 
 
1066		/*
1067		 * We already have a DATA transfer in the controller's cache,
1068		 * if we receive a XferNotReady(DATA) we will ignore it, unless
1069		 * it's for the wrong direction.
1070		 *
1071		 * In that case, we must issue END_TRANSFER command to the Data
1072		 * Phase we already have started and issue SetStall on the
1073		 * control endpoint.
1074		 */
1075		if (dwc->ep0_expect_in != event->endpoint_number) {
1076			struct dwc3_ep	*dep = dwc->eps[dwc->ep0_expect_in];
1077
1078			dev_err(dwc->dev, "unexpected direction for Data Phase\n");
1079			dwc3_ep0_end_control_data(dwc, dep);
1080			dwc3_ep0_stall_and_restart(dwc);
1081			return;
1082		}
1083
 
1084		break;
1085
1086	case DEPEVT_STATUS_CONTROL_STATUS:
1087		if (dwc->ep0_next_event != DWC3_EP0_NRDY_STATUS)
1088			return;
1089
1090		dwc->ep0state = EP0_STATUS_PHASE;
1091
1092		if (dwc->delayed_status) {
1093			struct dwc3_ep *dep = dwc->eps[0];
 
 
1094
1095			WARN_ON_ONCE(event->endpoint_number != 1);
1096			/*
1097			 * We should handle the delay STATUS phase here if the
1098			 * request for handling delay STATUS has been queued
1099			 * into the list.
1100			 */
1101			if (!list_empty(&dep->pending_list)) {
1102				dwc->delayed_status = false;
1103				usb_gadget_set_state(&dwc->gadget,
1104						     USB_STATE_CONFIGURED);
1105				dwc3_ep0_do_control_status(dwc, event);
1106			}
1107
 
 
 
1108			return;
1109		}
1110
1111		dwc3_ep0_do_control_status(dwc, event);
1112	}
1113}
1114
1115void dwc3_ep0_interrupt(struct dwc3 *dwc,
1116		const struct dwc3_event_depevt *event)
1117{
 
 
 
 
 
 
 
1118	switch (event->endpoint_event) {
1119	case DWC3_DEPEVT_XFERCOMPLETE:
1120		dwc3_ep0_xfer_complete(dwc, event);
1121		break;
1122
1123	case DWC3_DEPEVT_XFERNOTREADY:
1124		dwc3_ep0_xfernotready(dwc, event);
1125		break;
1126
1127	case DWC3_DEPEVT_XFERINPROGRESS:
1128	case DWC3_DEPEVT_RXTXFIFOEVT:
1129	case DWC3_DEPEVT_STREAMEVT:
1130	case DWC3_DEPEVT_EPCMDCMPLT:
1131		break;
1132	}
1133}
v3.5.6
   1/**
 
   2 * ep0.c - DesignWare USB3 DRD Controller Endpoint 0 Handling
   3 *
   4 * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com
   5 *
   6 * Authors: Felipe Balbi <balbi@ti.com>,
   7 *	    Sebastian Andrzej Siewior <bigeasy@linutronix.de>
   8 *
   9 * Redistribution and use in source and binary forms, with or without
  10 * modification, are permitted provided that the following conditions
  11 * are met:
  12 * 1. Redistributions of source code must retain the above copyright
  13 *    notice, this list of conditions, and the following disclaimer,
  14 *    without modification.
  15 * 2. Redistributions in binary form must reproduce the above copyright
  16 *    notice, this list of conditions and the following disclaimer in the
  17 *    documentation and/or other materials provided with the distribution.
  18 * 3. The names of the above-listed copyright holders may not be used
  19 *    to endorse or promote products derived from this software without
  20 *    specific prior written permission.
  21 *
  22 * ALTERNATIVELY, this software may be distributed under the terms of the
  23 * GNU General Public License ("GPL") version 2, as published by the Free
  24 * Software Foundation.
  25 *
  26 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
  27 * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
  28 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  29 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
  30 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
  31 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  32 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
  33 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
  34 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
  35 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  36 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  37 */
  38
  39#include <linux/kernel.h>
  40#include <linux/slab.h>
  41#include <linux/spinlock.h>
  42#include <linux/platform_device.h>
  43#include <linux/pm_runtime.h>
  44#include <linux/interrupt.h>
  45#include <linux/io.h>
  46#include <linux/list.h>
  47#include <linux/dma-mapping.h>
  48
  49#include <linux/usb/ch9.h>
  50#include <linux/usb/gadget.h>
  51#include <linux/usb/composite.h>
  52
  53#include "core.h"
 
  54#include "gadget.h"
  55#include "io.h"
  56
  57static void dwc3_ep0_do_control_status(struct dwc3 *dwc, u32 epnum);
 
 
  58
  59static const char *dwc3_ep0_state_string(enum dwc3_ep0_state state)
 
  60{
  61	switch (state) {
  62	case EP0_UNCONNECTED:
  63		return "Unconnected";
  64	case EP0_SETUP_PHASE:
  65		return "Setup Phase";
  66	case EP0_DATA_PHASE:
  67		return "Data Phase";
  68	case EP0_STATUS_PHASE:
  69		return "Status Phase";
  70	default:
  71		return "UNKNOWN";
  72	}
  73}
  74
  75static int dwc3_ep0_start_trans(struct dwc3 *dwc, u8 epnum, dma_addr_t buf_dma,
  76		u32 len, u32 type)
  77{
  78	struct dwc3_gadget_ep_cmd_params params;
  79	struct dwc3_trb			*trb;
  80	struct dwc3_ep			*dep;
  81
  82	int				ret;
  83
  84	dep = dwc->eps[epnum];
  85	if (dep->flags & DWC3_EP_BUSY) {
  86		dev_vdbg(dwc->dev, "%s: still busy\n", dep->name);
  87		return 0;
  88	}
  89
  90	trb = dwc->ep0_trb;
 
  91
  92	trb->bpl = lower_32_bits(buf_dma);
  93	trb->bph = upper_32_bits(buf_dma);
  94	trb->size = len;
  95	trb->ctrl = type;
  96
  97	trb->ctrl |= (DWC3_TRB_CTRL_HWO
  98			| DWC3_TRB_CTRL_LST
  99			| DWC3_TRB_CTRL_IOC
 100			| DWC3_TRB_CTRL_ISP_IMI);
 101
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 102	memset(&params, 0, sizeof(params));
 103	params.param0 = upper_32_bits(dwc->ep0_trb_addr);
 104	params.param1 = lower_32_bits(dwc->ep0_trb_addr);
 105
 106	ret = dwc3_send_gadget_ep_cmd(dwc, dep->number,
 107			DWC3_DEPCMD_STARTTRANSFER, &params);
 108	if (ret < 0) {
 109		dev_dbg(dwc->dev, "failed to send STARTTRANSFER command\n");
 110		return ret;
 111	}
 112
 113	dep->flags |= DWC3_EP_BUSY;
 114	dep->res_trans_idx = dwc3_gadget_ep_get_transfer_index(dwc,
 115			dep->number);
 116
 117	dwc->ep0_next_event = DWC3_EP0_COMPLETE;
 118
 119	return 0;
 120}
 121
 122static int __dwc3_gadget_ep0_queue(struct dwc3_ep *dep,
 123		struct dwc3_request *req)
 124{
 125	struct dwc3		*dwc = dep->dwc;
 126	int			ret = 0;
 127
 128	req->request.actual	= 0;
 129	req->request.status	= -EINPROGRESS;
 130	req->epnum		= dep->number;
 131
 132	list_add_tail(&req->list, &dep->request_list);
 133
 134	/*
 135	 * Gadget driver might not be quick enough to queue a request
 136	 * before we get a Transfer Not Ready event on this endpoint.
 137	 *
 138	 * In that case, we will set DWC3_EP_PENDING_REQUEST. When that
 139	 * flag is set, it's telling us that as soon as Gadget queues the
 140	 * required request, we should kick the transfer here because the
 141	 * IRQ we were waiting for is long gone.
 142	 */
 143	if (dep->flags & DWC3_EP_PENDING_REQUEST) {
 144		unsigned	direction;
 145
 146		direction = !!(dep->flags & DWC3_EP0_DIR_IN);
 147
 148		if (dwc->ep0state != EP0_DATA_PHASE) {
 149			dev_WARN(dwc->dev, "Unexpected pending request\n");
 150			return 0;
 151		}
 152
 153		ret = dwc3_ep0_start_trans(dwc, direction,
 154				req->request.dma, req->request.length,
 155				DWC3_TRBCTL_CONTROL_DATA);
 156		dep->flags &= ~(DWC3_EP_PENDING_REQUEST |
 157				DWC3_EP0_DIR_IN);
 158	} else if (dwc->delayed_status) {
 
 
 
 
 
 
 
 
 
 
 
 159		dwc->delayed_status = false;
 
 160
 161		if (dwc->ep0state == EP0_STATUS_PHASE)
 162			dwc3_ep0_do_control_status(dwc, 1);
 163		else
 164			dev_dbg(dwc->dev, "too early for delayed status\n");
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 165	}
 166
 167	return ret;
 168}
 169
 170int dwc3_gadget_ep0_queue(struct usb_ep *ep, struct usb_request *request,
 171		gfp_t gfp_flags)
 172{
 173	struct dwc3_request		*req = to_dwc3_request(request);
 174	struct dwc3_ep			*dep = to_dwc3_ep(ep);
 175	struct dwc3			*dwc = dep->dwc;
 176
 177	unsigned long			flags;
 178
 179	int				ret;
 180
 181	spin_lock_irqsave(&dwc->lock, flags);
 182	if (!dep->endpoint.desc) {
 183		dev_dbg(dwc->dev, "trying to queue request %p to disabled %s\n",
 184				request, dep->name);
 185		ret = -ESHUTDOWN;
 186		goto out;
 187	}
 188
 189	/* we share one TRB for ep0/1 */
 190	if (!list_empty(&dep->request_list)) {
 191		ret = -EBUSY;
 192		goto out;
 193	}
 194
 195	dev_vdbg(dwc->dev, "queueing request %p to %s length %d, state '%s'\n",
 196			request, dep->name, request->length,
 197			dwc3_ep0_state_string(dwc->ep0state));
 198
 199	ret = __dwc3_gadget_ep0_queue(dep, req);
 200
 201out:
 202	spin_unlock_irqrestore(&dwc->lock, flags);
 203
 204	return ret;
 205}
 206
 207static void dwc3_ep0_stall_and_restart(struct dwc3 *dwc)
 208{
 209	struct dwc3_ep		*dep = dwc->eps[0];
 
 
 
 
 210
 211	/* stall is always issued on EP0 */
 212	__dwc3_gadget_ep_set_halt(dep, 1);
 
 213	dep->flags = DWC3_EP_ENABLED;
 214	dwc->delayed_status = false;
 215
 216	if (!list_empty(&dep->request_list)) {
 217		struct dwc3_request	*req;
 218
 219		req = next_request(&dep->request_list);
 220		dwc3_gadget_giveback(dep, req, -ECONNRESET);
 221	}
 222
 223	dwc->ep0state = EP0_SETUP_PHASE;
 224	dwc3_ep0_out_start(dwc);
 225}
 226
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 227void dwc3_ep0_out_start(struct dwc3 *dwc)
 228{
 
 229	int				ret;
 230
 231	ret = dwc3_ep0_start_trans(dwc, 0, dwc->ctrl_req_addr, 8,
 232			DWC3_TRBCTL_CONTROL_SETUP);
 
 
 
 
 233	WARN_ON(ret < 0);
 234}
 235
 236static struct dwc3_ep *dwc3_wIndex_to_dep(struct dwc3 *dwc, __le16 wIndex_le)
 237{
 238	struct dwc3_ep		*dep;
 239	u32			windex = le16_to_cpu(wIndex_le);
 240	u32			epnum;
 241
 242	epnum = (windex & USB_ENDPOINT_NUMBER_MASK) << 1;
 243	if ((windex & USB_ENDPOINT_DIR_MASK) == USB_DIR_IN)
 244		epnum |= 1;
 245
 246	dep = dwc->eps[epnum];
 247	if (dep->flags & DWC3_EP_ENABLED)
 248		return dep;
 249
 250	return NULL;
 251}
 252
 253static void dwc3_ep0_status_cmpl(struct usb_ep *ep, struct usb_request *req)
 254{
 255}
 256/*
 257 * ch 9.4.5
 258 */
 259static int dwc3_ep0_handle_status(struct dwc3 *dwc,
 260		struct usb_ctrlrequest *ctrl)
 261{
 262	struct dwc3_ep		*dep;
 263	u32			recip;
 
 264	u32			reg;
 265	u16			usb_status = 0;
 266	__le16			*response_pkt;
 267
 
 
 
 
 
 268	recip = ctrl->bRequestType & USB_RECIP_MASK;
 269	switch (recip) {
 270	case USB_RECIP_DEVICE:
 271		/*
 272		 * LTM will be set once we know how to set this in HW.
 273		 */
 274		usb_status |= dwc->is_selfpowered << USB_DEVICE_SELF_POWERED;
 275
 276		if (dwc->speed == DWC3_DSTS_SUPERSPEED) {
 
 277			reg = dwc3_readl(dwc->regs, DWC3_DCTL);
 278			if (reg & DWC3_DCTL_INITU1ENA)
 279				usb_status |= 1 << USB_DEV_STAT_U1_ENABLED;
 280			if (reg & DWC3_DCTL_INITU2ENA)
 281				usb_status |= 1 << USB_DEV_STAT_U2_ENABLED;
 282		}
 283
 284		break;
 285
 286	case USB_RECIP_INTERFACE:
 287		/*
 288		 * Function Remote Wake Capable	D0
 289		 * Function Remote Wakeup	D1
 290		 */
 291		break;
 292
 293	case USB_RECIP_ENDPOINT:
 294		dep = dwc3_wIndex_to_dep(dwc, ctrl->wIndex);
 295		if (!dep)
 296			return -EINVAL;
 297
 298		if (dep->flags & DWC3_EP_STALL)
 299			usb_status = 1 << USB_ENDPOINT_HALT;
 300		break;
 301	default:
 302		return -EINVAL;
 303	};
 304
 305	response_pkt = (__le16 *) dwc->setup_buf;
 306	*response_pkt = cpu_to_le16(usb_status);
 307
 308	dep = dwc->eps[0];
 309	dwc->ep0_usb_req.dep = dep;
 310	dwc->ep0_usb_req.request.length = sizeof(*response_pkt);
 311	dwc->ep0_usb_req.request.buf = dwc->setup_buf;
 312	dwc->ep0_usb_req.request.complete = dwc3_ep0_status_cmpl;
 313
 314	return __dwc3_gadget_ep0_queue(dep, &dwc->ep0_usb_req);
 315}
 316
 317static int dwc3_ep0_handle_feature(struct dwc3 *dwc,
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 318		struct usb_ctrlrequest *ctrl, int set)
 319{
 320	struct dwc3_ep		*dep;
 321	u32			recip;
 322	u32			wValue;
 323	u32			wIndex;
 324	u32			reg;
 325	int			ret;
 326
 327	wValue = le16_to_cpu(ctrl->wValue);
 328	wIndex = le16_to_cpu(ctrl->wIndex);
 329	recip = ctrl->bRequestType & USB_RECIP_MASK;
 330	switch (recip) {
 331	case USB_RECIP_DEVICE:
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 332
 333		switch (wValue) {
 334		case USB_DEVICE_REMOTE_WAKEUP:
 335			break;
 336		/*
 337		 * 9.4.1 says only only for SS, in AddressState only for
 338		 * default control pipe
 
 
 
 339		 */
 340		case USB_DEVICE_U1_ENABLE:
 341			if (dwc->dev_state != DWC3_CONFIGURED_STATE)
 342				return -EINVAL;
 343			if (dwc->speed != DWC3_DSTS_SUPERSPEED)
 344				return -EINVAL;
 345
 346			reg = dwc3_readl(dwc->regs, DWC3_DCTL);
 347			if (set)
 348				reg |= DWC3_DCTL_INITU1ENA;
 349			else
 350				reg &= ~DWC3_DCTL_INITU1ENA;
 351			dwc3_writel(dwc->regs, DWC3_DCTL, reg);
 352			break;
 353
 354		case USB_DEVICE_U2_ENABLE:
 355			if (dwc->dev_state != DWC3_CONFIGURED_STATE)
 356				return -EINVAL;
 357			if (dwc->speed != DWC3_DSTS_SUPERSPEED)
 358				return -EINVAL;
 
 359
 360			reg = dwc3_readl(dwc->regs, DWC3_DCTL);
 361			if (set)
 362				reg |= DWC3_DCTL_INITU2ENA;
 363			else
 364				reg &= ~DWC3_DCTL_INITU2ENA;
 365			dwc3_writel(dwc->regs, DWC3_DCTL, reg);
 366			break;
 367
 368		case USB_DEVICE_LTM_ENABLE:
 
 
 
 369			return -EINVAL;
 
 
 370			break;
 371
 372		case USB_DEVICE_TEST_MODE:
 373			if ((wIndex & 0xff) != 0)
 374				return -EINVAL;
 375			if (!set)
 376				return -EINVAL;
 377
 378			dwc->test_mode_nr = wIndex >> 8;
 379			dwc->test_mode = true;
 380			break;
 381		default:
 382			return -EINVAL;
 383		}
 384		break;
 
 
 
 
 
 
 
 
 
 
 
 
 385
 
 
 
 
 
 
 386	case USB_RECIP_INTERFACE:
 387		switch (wValue) {
 388		case USB_INTRF_FUNC_SUSPEND:
 389			if (wIndex & USB_INTRF_FUNC_SUSPEND_LP)
 390				/* XXX enable Low power suspend */
 391				;
 392			if (wIndex & USB_INTRF_FUNC_SUSPEND_RW)
 393				/* XXX enable remote wakeup */
 394				;
 395			break;
 396		default:
 397			return -EINVAL;
 398		}
 399		break;
 400
 401	case USB_RECIP_ENDPOINT:
 402		switch (wValue) {
 403		case USB_ENDPOINT_HALT:
 404			dep = dwc3_wIndex_to_dep(dwc, wIndex);
 405			if (!dep)
 406				return -EINVAL;
 407			ret = __dwc3_gadget_ep_set_halt(dep, set);
 408			if (ret)
 409				return -EINVAL;
 410			break;
 411		default:
 412			return -EINVAL;
 413		}
 414		break;
 415
 416	default:
 417		return -EINVAL;
 418	};
 419
 420	return 0;
 421}
 422
 423static int dwc3_ep0_set_address(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 424{
 
 425	u32 addr;
 426	u32 reg;
 427
 428	addr = le16_to_cpu(ctrl->wValue);
 429	if (addr > 127) {
 430		dev_dbg(dwc->dev, "invalid device address %d\n", addr);
 431		return -EINVAL;
 432	}
 433
 434	if (dwc->dev_state == DWC3_CONFIGURED_STATE) {
 435		dev_dbg(dwc->dev, "trying to set address when configured\n");
 436		return -EINVAL;
 437	}
 438
 439	reg = dwc3_readl(dwc->regs, DWC3_DCFG);
 440	reg &= ~(DWC3_DCFG_DEVADDR_MASK);
 441	reg |= DWC3_DCFG_DEVADDR(addr);
 442	dwc3_writel(dwc->regs, DWC3_DCFG, reg);
 443
 444	if (addr)
 445		dwc->dev_state = DWC3_ADDRESS_STATE;
 446	else
 447		dwc->dev_state = DWC3_DEFAULT_STATE;
 448
 449	return 0;
 450}
 451
 452static int dwc3_ep0_delegate_req(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 453{
 454	int ret;
 455
 456	spin_unlock(&dwc->lock);
 457	ret = dwc->gadget_driver->setup(&dwc->gadget, ctrl);
 458	spin_lock(&dwc->lock);
 459	return ret;
 460}
 461
 462static int dwc3_ep0_set_config(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 463{
 
 464	u32 cfg;
 465	int ret;
 
 466
 467	dwc->start_config_issued = false;
 468	cfg = le16_to_cpu(ctrl->wValue);
 469
 470	switch (dwc->dev_state) {
 471	case DWC3_DEFAULT_STATE:
 472		return -EINVAL;
 473		break;
 474
 475	case DWC3_ADDRESS_STATE:
 476		ret = dwc3_ep0_delegate_req(dwc, ctrl);
 477		/* if the cfg matches and the cfg is non zero */
 478		if (cfg && (!ret || (ret == USB_GADGET_DELAYED_STATUS))) {
 479			dwc->dev_state = DWC3_CONFIGURED_STATE;
 480			dwc->resize_fifos = true;
 481			dev_dbg(dwc->dev, "resize fifos flag SET\n");
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 482		}
 483		break;
 484
 485	case DWC3_CONFIGURED_STATE:
 486		ret = dwc3_ep0_delegate_req(dwc, ctrl);
 487		if (!cfg)
 488			dwc->dev_state = DWC3_ADDRESS_STATE;
 
 489		break;
 490	default:
 491		ret = -EINVAL;
 492	}
 493	return ret;
 494}
 495
 496static void dwc3_ep0_set_sel_cmpl(struct usb_ep *ep, struct usb_request *req)
 497{
 498	struct dwc3_ep	*dep = to_dwc3_ep(ep);
 499	struct dwc3	*dwc = dep->dwc;
 500
 501	u32		param = 0;
 502	u32		reg;
 503
 504	struct timing {
 505		u8	u1sel;
 506		u8	u1pel;
 507		u16	u2sel;
 508		u16	u2pel;
 509	} __packed timing;
 510
 511	int		ret;
 512
 513	memcpy(&timing, req->buf, sizeof(timing));
 514
 515	dwc->u1sel = timing.u1sel;
 516	dwc->u1pel = timing.u1pel;
 517	dwc->u2sel = timing.u2sel;
 518	dwc->u2pel = timing.u2pel;
 519
 520	reg = dwc3_readl(dwc->regs, DWC3_DCTL);
 521	if (reg & DWC3_DCTL_INITU2ENA)
 522		param = dwc->u2pel;
 523	if (reg & DWC3_DCTL_INITU1ENA)
 524		param = dwc->u1pel;
 525
 526	/*
 527	 * According to Synopsys Databook, if parameter is
 528	 * greater than 125, a value of zero should be
 529	 * programmed in the register.
 530	 */
 531	if (param > 125)
 532		param = 0;
 533
 534	/* now that we have the time, issue DGCMD Set Sel */
 535	ret = dwc3_send_gadget_generic_command(dwc,
 536			DWC3_DGCMD_SET_PERIODIC_PAR, param);
 537	WARN_ON(ret < 0);
 538}
 539
 540static int dwc3_ep0_set_sel(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 541{
 542	struct dwc3_ep	*dep;
 
 543	u16		wLength;
 544	u16		wValue;
 545
 546	if (dwc->dev_state == DWC3_DEFAULT_STATE)
 547		return -EINVAL;
 548
 549	wValue = le16_to_cpu(ctrl->wValue);
 550	wLength = le16_to_cpu(ctrl->wLength);
 551
 552	if (wLength != 6) {
 553		dev_err(dwc->dev, "Set SEL should be 6 bytes, got %d\n",
 554				wLength);
 555		return -EINVAL;
 556	}
 557
 558	/*
 559	 * To handle Set SEL we need to receive 6 bytes from Host. So let's
 560	 * queue a usb_request for 6 bytes.
 561	 *
 562	 * Remember, though, this controller can't handle non-wMaxPacketSize
 563	 * aligned transfers on the OUT direction, so we queue a request for
 564	 * wMaxPacketSize instead.
 565	 */
 566	dep = dwc->eps[0];
 567	dwc->ep0_usb_req.dep = dep;
 568	dwc->ep0_usb_req.request.length = dep->endpoint.maxpacket;
 569	dwc->ep0_usb_req.request.buf = dwc->setup_buf;
 570	dwc->ep0_usb_req.request.complete = dwc3_ep0_set_sel_cmpl;
 571
 572	return __dwc3_gadget_ep0_queue(dep, &dwc->ep0_usb_req);
 573}
 574
 575static int dwc3_ep0_set_isoch_delay(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 576{
 577	u16		wLength;
 578	u16		wValue;
 579	u16		wIndex;
 580
 581	wValue = le16_to_cpu(ctrl->wValue);
 582	wLength = le16_to_cpu(ctrl->wLength);
 583	wIndex = le16_to_cpu(ctrl->wIndex);
 584
 585	if (wIndex || wLength)
 586		return -EINVAL;
 587
 588	/*
 589	 * REVISIT It's unclear from Databook what to do with this
 590	 * value. For now, just cache it.
 591	 */
 592	dwc->isoch_delay = wValue;
 593
 594	return 0;
 595}
 596
 597static int dwc3_ep0_std_request(struct dwc3 *dwc, struct usb_ctrlrequest *ctrl)
 598{
 599	int ret;
 600
 601	switch (ctrl->bRequest) {
 602	case USB_REQ_GET_STATUS:
 603		dev_vdbg(dwc->dev, "USB_REQ_GET_STATUS\n");
 604		ret = dwc3_ep0_handle_status(dwc, ctrl);
 605		break;
 606	case USB_REQ_CLEAR_FEATURE:
 607		dev_vdbg(dwc->dev, "USB_REQ_CLEAR_FEATURE\n");
 608		ret = dwc3_ep0_handle_feature(dwc, ctrl, 0);
 609		break;
 610	case USB_REQ_SET_FEATURE:
 611		dev_vdbg(dwc->dev, "USB_REQ_SET_FEATURE\n");
 612		ret = dwc3_ep0_handle_feature(dwc, ctrl, 1);
 613		break;
 614	case USB_REQ_SET_ADDRESS:
 615		dev_vdbg(dwc->dev, "USB_REQ_SET_ADDRESS\n");
 616		ret = dwc3_ep0_set_address(dwc, ctrl);
 617		break;
 618	case USB_REQ_SET_CONFIGURATION:
 619		dev_vdbg(dwc->dev, "USB_REQ_SET_CONFIGURATION\n");
 620		ret = dwc3_ep0_set_config(dwc, ctrl);
 621		break;
 622	case USB_REQ_SET_SEL:
 623		dev_vdbg(dwc->dev, "USB_REQ_SET_SEL\n");
 624		ret = dwc3_ep0_set_sel(dwc, ctrl);
 625		break;
 626	case USB_REQ_SET_ISOCH_DELAY:
 627		dev_vdbg(dwc->dev, "USB_REQ_SET_ISOCH_DELAY\n");
 628		ret = dwc3_ep0_set_isoch_delay(dwc, ctrl);
 629		break;
 630	default:
 631		dev_vdbg(dwc->dev, "Forwarding to gadget driver\n");
 632		ret = dwc3_ep0_delegate_req(dwc, ctrl);
 633		break;
 634	};
 635
 636	return ret;
 637}
 638
 639static void dwc3_ep0_inspect_setup(struct dwc3 *dwc,
 640		const struct dwc3_event_depevt *event)
 641{
 642	struct usb_ctrlrequest *ctrl = dwc->ctrl_req;
 643	int ret;
 644	u32 len;
 645
 646	if (!dwc->gadget_driver)
 647		goto err;
 
 
 648
 649	len = le16_to_cpu(ctrl->wLength);
 650	if (!len) {
 651		dwc->three_stage_setup = false;
 652		dwc->ep0_expect_in = false;
 653		dwc->ep0_next_event = DWC3_EP0_NRDY_STATUS;
 654	} else {
 655		dwc->three_stage_setup = true;
 656		dwc->ep0_expect_in = !!(ctrl->bRequestType & USB_DIR_IN);
 657		dwc->ep0_next_event = DWC3_EP0_NRDY_DATA;
 658	}
 659
 660	if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD)
 661		ret = dwc3_ep0_std_request(dwc, ctrl);
 662	else
 663		ret = dwc3_ep0_delegate_req(dwc, ctrl);
 664
 665	if (ret == USB_GADGET_DELAYED_STATUS)
 666		dwc->delayed_status = true;
 667
 668	if (ret >= 0)
 669		return;
 670
 671err:
 672	dwc3_ep0_stall_and_restart(dwc);
 673}
 674
 675static void dwc3_ep0_complete_data(struct dwc3 *dwc,
 676		const struct dwc3_event_depevt *event)
 677{
 678	struct dwc3_request	*r = NULL;
 679	struct usb_request	*ur;
 680	struct dwc3_trb		*trb;
 681	struct dwc3_ep		*ep0;
 682	u32			transferred;
 
 683	u32			length;
 684	u8			epnum;
 685
 686	epnum = event->endpoint_number;
 687	ep0 = dwc->eps[0];
 688
 689	dwc->ep0_next_event = DWC3_EP0_NRDY_STATUS;
 
 
 690
 691	r = next_request(&ep0->request_list);
 692	ur = &r->request;
 
 693
 694	trb = dwc->ep0_trb;
 695	length = trb->size & DWC3_TRB_SIZE_MASK;
 
 
 
 696
 697	if (dwc->ep0_bounced) {
 698		unsigned transfer_size = ur->length;
 699		unsigned maxp = ep0->endpoint.maxpacket;
 700
 701		transfer_size += (maxp - (transfer_size % maxp));
 702		transferred = min_t(u32, ur->length,
 703				transfer_size - length);
 704		memcpy(ur->buf, dwc->ep0_bounce, transferred);
 705	} else {
 706		transferred = ur->length - length;
 707	}
 708
 
 
 
 
 709	ur->actual += transferred;
 710
 711	if ((epnum & 1) && ur->actual < ur->length) {
 712		/* for some reason we did not get everything out */
 
 
 
 713
 
 
 
 
 
 
 
 
 
 714		dwc3_ep0_stall_and_restart(dwc);
 715	} else {
 716		/*
 717		 * handle the case where we have to send a zero packet. This
 718		 * seems to be case when req.length > maxpacket. Could it be?
 719		 */
 720		if (r)
 721			dwc3_gadget_giveback(ep0, r, 0);
 722	}
 723}
 724
 725static void dwc3_ep0_complete_req(struct dwc3 *dwc,
 726		const struct dwc3_event_depevt *event)
 727{
 728	struct dwc3_request	*r;
 729	struct dwc3_ep		*dep;
 
 
 730
 731	dep = dwc->eps[0];
 
 732
 733	if (!list_empty(&dep->request_list)) {
 734		r = next_request(&dep->request_list);
 
 
 735
 736		dwc3_gadget_giveback(dep, r, 0);
 737	}
 738
 739	if (dwc->test_mode) {
 740		int ret;
 741
 742		ret = dwc3_gadget_set_test_mode(dwc, dwc->test_mode_nr);
 743		if (ret < 0) {
 744			dev_dbg(dwc->dev, "Invalid Test #%d\n",
 745					dwc->test_mode_nr);
 746			dwc3_ep0_stall_and_restart(dwc);
 
 747		}
 748	}
 749
 
 
 
 
 750	dwc->ep0state = EP0_SETUP_PHASE;
 751	dwc3_ep0_out_start(dwc);
 752}
 753
 754static void dwc3_ep0_xfer_complete(struct dwc3 *dwc,
 755			const struct dwc3_event_depevt *event)
 756{
 757	struct dwc3_ep		*dep = dwc->eps[event->endpoint_number];
 758
 759	dep->flags &= ~DWC3_EP_BUSY;
 760	dep->res_trans_idx = 0;
 761	dwc->setup_packet_pending = false;
 762
 763	switch (dwc->ep0state) {
 764	case EP0_SETUP_PHASE:
 765		dev_vdbg(dwc->dev, "Inspecting Setup Bytes\n");
 766		dwc3_ep0_inspect_setup(dwc, event);
 767		break;
 768
 769	case EP0_DATA_PHASE:
 770		dev_vdbg(dwc->dev, "Data Phase\n");
 771		dwc3_ep0_complete_data(dwc, event);
 772		break;
 773
 774	case EP0_STATUS_PHASE:
 775		dev_vdbg(dwc->dev, "Status Phase\n");
 776		dwc3_ep0_complete_req(dwc, event);
 777		break;
 778	default:
 779		WARN(true, "UNKNOWN ep0state %d\n", dwc->ep0state);
 780	}
 781}
 782
 783static void dwc3_ep0_do_control_setup(struct dwc3 *dwc,
 784		const struct dwc3_event_depevt *event)
 785{
 786	dwc3_ep0_out_start(dwc);
 787}
 788
 789static void dwc3_ep0_do_control_data(struct dwc3 *dwc,
 790		const struct dwc3_event_depevt *event)
 791{
 792	struct dwc3_ep		*dep;
 793	struct dwc3_request	*req;
 794	int			ret;
 795
 796	dep = dwc->eps[0];
 797
 798	if (list_empty(&dep->request_list)) {
 799		dev_vdbg(dwc->dev, "pending request for EP0 Data phase\n");
 800		dep->flags |= DWC3_EP_PENDING_REQUEST;
 
 
 
 
 
 
 
 
 
 
 801
 802		if (event->endpoint_number)
 803			dep->flags |= DWC3_EP0_DIR_IN;
 804		return;
 805	}
 806
 807	req = next_request(&dep->request_list);
 808	req->direction = !!event->endpoint_number;
 809
 810	if (req->request.length == 0) {
 811		ret = dwc3_ep0_start_trans(dwc, event->endpoint_number,
 812				dwc->ctrl_req_addr, 0,
 813				DWC3_TRBCTL_CONTROL_DATA);
 814	} else if ((req->request.length % dep->endpoint.maxpacket)
 815			&& (event->endpoint_number == 0)) {
 816		ret = usb_gadget_map_request(&dwc->gadget, &req->request,
 817				event->endpoint_number);
 818		if (ret) {
 819			dev_dbg(dwc->dev, "failed to map request\n");
 
 
 
 
 
 
 
 
 
 
 
 820			return;
 821		}
 822
 823		WARN_ON(req->request.length > dep->endpoint.maxpacket);
 824
 825		dwc->ep0_bounced = true;
 826
 827		/*
 828		 * REVISIT in case request length is bigger than EP0
 829		 * wMaxPacketSize, we will need two chained TRBs to handle
 830		 * the transfer.
 831		 */
 832		ret = dwc3_ep0_start_trans(dwc, event->endpoint_number,
 833				dwc->ep0_bounce_addr, dep->endpoint.maxpacket,
 834				DWC3_TRBCTL_CONTROL_DATA);
 
 
 
 
 
 835	} else {
 836		ret = usb_gadget_map_request(&dwc->gadget, &req->request,
 837				event->endpoint_number);
 838		if (ret) {
 839			dev_dbg(dwc->dev, "failed to map request\n");
 840			return;
 841		}
 842
 843		ret = dwc3_ep0_start_trans(dwc, event->endpoint_number,
 844				req->request.dma, req->request.length,
 845				DWC3_TRBCTL_CONTROL_DATA);
 
 
 
 
 846	}
 847
 848	WARN_ON(ret < 0);
 849}
 850
 851static int dwc3_ep0_start_control_status(struct dwc3_ep *dep)
 852{
 853	struct dwc3		*dwc = dep->dwc;
 854	u32			type;
 855
 856	type = dwc->three_stage_setup ? DWC3_TRBCTL_CONTROL_STATUS3
 857		: DWC3_TRBCTL_CONTROL_STATUS2;
 858
 859	return dwc3_ep0_start_trans(dwc, dep->number,
 860			dwc->ctrl_req_addr, 0, type);
 861}
 862
 863static void dwc3_ep0_do_control_status(struct dwc3 *dwc, u32 epnum)
 864{
 865	struct dwc3_ep		*dep = dwc->eps[epnum];
 866
 867	if (dwc->resize_fifos) {
 868		dev_dbg(dwc->dev, "starting to resize fifos\n");
 869		dwc3_gadget_resize_tx_fifos(dwc);
 870		dwc->resize_fifos = 0;
 871	}
 872
 873	WARN_ON(dwc3_ep0_start_control_status(dep));
 874}
 875
 876static void dwc3_ep0_xfernotready(struct dwc3 *dwc,
 877		const struct dwc3_event_depevt *event)
 878{
 879	dwc->setup_packet_pending = true;
 
 
 
 880
 881	/*
 882	 * This part is very tricky: If we has just handled
 883	 * XferNotReady(Setup) and we're now expecting a
 884	 * XferComplete but, instead, we receive another
 885	 * XferNotReady(Setup), we should STALL and restart
 886	 * the state machine.
 887	 *
 888	 * In all other cases, we just continue waiting
 889	 * for the XferComplete event.
 890	 *
 891	 * We are a little bit unsafe here because we're
 892	 * not trying to ensure that last event was, indeed,
 893	 * XferNotReady(Setup).
 894	 *
 895	 * Still, we don't expect any condition where that
 896	 * should happen and, even if it does, it would be
 897	 * another error condition.
 898	 */
 899	if (dwc->ep0_next_event == DWC3_EP0_COMPLETE) {
 900		switch (event->status) {
 901		case DEPEVT_STATUS_CONTROL_SETUP:
 902			dev_vdbg(dwc->dev, "Unexpected XferNotReady(Setup)\n");
 903			dwc3_ep0_stall_and_restart(dwc);
 904			break;
 905		case DEPEVT_STATUS_CONTROL_DATA:
 906			/* FALLTHROUGH */
 907		case DEPEVT_STATUS_CONTROL_STATUS:
 908			/* FALLTHROUGH */
 909		default:
 910			dev_vdbg(dwc->dev, "waiting for XferComplete\n");
 911		}
 912
 
 913		return;
 914	}
 915
 
 
 
 
 
 
 
 
 
 
 
 
 916	switch (event->status) {
 917	case DEPEVT_STATUS_CONTROL_SETUP:
 918		dev_vdbg(dwc->dev, "Control Setup\n");
 919
 920		dwc->ep0state = EP0_SETUP_PHASE;
 921
 922		dwc3_ep0_do_control_setup(dwc, event);
 923		break;
 924
 925	case DEPEVT_STATUS_CONTROL_DATA:
 926		dev_vdbg(dwc->dev, "Control Data\n");
 927
 928		dwc->ep0state = EP0_DATA_PHASE;
 929
 930		if (dwc->ep0_next_event != DWC3_EP0_NRDY_DATA) {
 931			dev_vdbg(dwc->dev, "Expected %d got %d\n",
 932					dwc->ep0_next_event,
 933					DWC3_EP0_NRDY_DATA);
 934
 935			dwc3_ep0_stall_and_restart(dwc);
 936			return;
 937		}
 938
 939		/*
 940		 * One of the possible error cases is when Host _does_
 941		 * request for Data Phase, but it does so on the wrong
 942		 * direction.
 943		 *
 944		 * Here, we already know ep0_next_event is DATA (see above),
 945		 * so we only need to check for direction.
 
 946		 */
 947		if (dwc->ep0_expect_in != event->endpoint_number) {
 948			dev_vdbg(dwc->dev, "Wrong direction for Data phase\n");
 
 
 
 949			dwc3_ep0_stall_and_restart(dwc);
 950			return;
 951		}
 952
 953		dwc3_ep0_do_control_data(dwc, event);
 954		break;
 955
 956	case DEPEVT_STATUS_CONTROL_STATUS:
 957		dev_vdbg(dwc->dev, "Control Status\n");
 
 958
 959		dwc->ep0state = EP0_STATUS_PHASE;
 960
 961		if (dwc->ep0_next_event != DWC3_EP0_NRDY_STATUS) {
 962			dev_vdbg(dwc->dev, "Expected %d got %d\n",
 963					dwc->ep0_next_event,
 964					DWC3_EP0_NRDY_STATUS);
 965
 966			dwc3_ep0_stall_and_restart(dwc);
 967			return;
 968		}
 
 
 
 
 
 
 
 
 
 969
 970		if (dwc->delayed_status) {
 971			WARN_ON_ONCE(event->endpoint_number != 1);
 972			dev_vdbg(dwc->dev, "Mass Storage delayed status\n");
 973			return;
 974		}
 975
 976		dwc3_ep0_do_control_status(dwc, event->endpoint_number);
 977	}
 978}
 979
 980void dwc3_ep0_interrupt(struct dwc3 *dwc,
 981		const struct dwc3_event_depevt *event)
 982{
 983	u8			epnum = event->endpoint_number;
 984
 985	dev_dbg(dwc->dev, "%s while ep%d%s in state '%s'\n",
 986			dwc3_ep_event_string(event->endpoint_event),
 987			epnum >> 1, (epnum & 1) ? "in" : "out",
 988			dwc3_ep0_state_string(dwc->ep0state));
 989
 990	switch (event->endpoint_event) {
 991	case DWC3_DEPEVT_XFERCOMPLETE:
 992		dwc3_ep0_xfer_complete(dwc, event);
 993		break;
 994
 995	case DWC3_DEPEVT_XFERNOTREADY:
 996		dwc3_ep0_xfernotready(dwc, event);
 997		break;
 998
 999	case DWC3_DEPEVT_XFERINPROGRESS:
1000	case DWC3_DEPEVT_RXTXFIFOEVT:
1001	case DWC3_DEPEVT_STREAMEVT:
1002	case DWC3_DEPEVT_EPCMDCMPLT:
1003		break;
1004	}
1005}