2008-07-24 13:27:36 +04:00
|
|
|
/*
|
|
|
|
* MUSB OTG driver peripheral support
|
|
|
|
*
|
|
|
|
* Copyright 2005 Mentor Graphics Corporation
|
|
|
|
* Copyright (C) 2005-2006 by Texas Instruments
|
|
|
|
* Copyright (C) 2006-2007 Nokia Corporation
|
2009-11-18 22:51:18 +03:00
|
|
|
* Copyright (C) 2009 MontaVista Software, Inc. <source@mvista.com>
|
2008-07-24 13:27:36 +04:00
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or
|
|
|
|
* modify it under the terms of the GNU General Public License
|
|
|
|
* version 2 as published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful, but
|
|
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
|
|
* General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program; if not, write to the Free Software
|
|
|
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
|
|
|
|
* 02110-1301 USA
|
|
|
|
*
|
|
|
|
* THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
|
|
|
|
* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
|
|
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
|
|
|
|
* NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
|
|
|
|
* USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
|
|
|
|
* ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/list.h>
|
|
|
|
#include <linux/timer.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/smp.h>
|
|
|
|
#include <linux/spinlock.h>
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/dma-mapping.h>
|
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h
percpu.h is included by sched.h and module.h and thus ends up being
included when building most .c files. percpu.h includes slab.h which
in turn includes gfp.h making everything defined by the two files
universally available and complicating inclusion dependencies.
percpu.h -> slab.h dependency is about to be removed. Prepare for
this change by updating users of gfp and slab facilities include those
headers directly instead of assuming availability. As this conversion
needs to touch large number of source files, the following script is
used as the basis of conversion.
http://userweb.kernel.org/~tj/misc/slabh-sweep.py
The script does the followings.
* Scan files for gfp and slab usages and update includes such that
only the necessary includes are there. ie. if only gfp is used,
gfp.h, if slab is used, slab.h.
* When the script inserts a new include, it looks at the include
blocks and try to put the new include such that its order conforms
to its surrounding. It's put in the include block which contains
core kernel includes, in the same order that the rest are ordered -
alphabetical, Christmas tree, rev-Xmas-tree or at the end if there
doesn't seem to be any matching order.
* If the script can't find a place to put a new include (mostly
because the file doesn't have fitting include block), it prints out
an error message indicating which .h file needs to be added to the
file.
The conversion was done in the following steps.
1. The initial automatic conversion of all .c files updated slightly
over 4000 files, deleting around 700 includes and adding ~480 gfp.h
and ~3000 slab.h inclusions. The script emitted errors for ~400
files.
2. Each error was manually checked. Some didn't need the inclusion,
some needed manual addition while adding it to implementation .h or
embedding .c file was more appropriate for others. This step added
inclusions to around 150 files.
3. The script was run again and the output was compared to the edits
from #2 to make sure no file was left behind.
4. Several build tests were done and a couple of problems were fixed.
e.g. lib/decompress_*.c used malloc/free() wrappers around slab
APIs requiring slab.h to be added manually.
5. The script was run on all .h files but without automatically
editing them as sprinkling gfp.h and slab.h inclusions around .h
files could easily lead to inclusion dependency hell. Most gfp.h
inclusion directives were ignored as stuff from gfp.h was usually
wildly available and often used in preprocessor macros. Each
slab.h inclusion directive was examined and added manually as
necessary.
6. percpu.h was updated not to include slab.h.
7. Build test were done on the following configurations and failures
were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my
distributed build env didn't work with gcov compiles) and a few
more options had to be turned off depending on archs to make things
build (like ipr on powerpc/64 which failed due to missing writeq).
* x86 and x86_64 UP and SMP allmodconfig and a custom test config.
* powerpc and powerpc64 SMP allmodconfig
* sparc and sparc64 SMP allmodconfig
* ia64 SMP allmodconfig
* s390 SMP allmodconfig
* alpha SMP allmodconfig
* um on x86_64 SMP allmodconfig
8. percpu.h modifications were reverted so that it could be applied as
a separate patch and serve as bisection point.
Given the fact that I had only a couple of failures from tests on step
6, I'm fairly confident about the coverage of this conversion patch.
If there is a breakage, it's likely to be something in one of the arch
headers which should be easily discoverable easily on most builds of
the specific arch.
Signed-off-by: Tejun Heo <tj@kernel.org>
Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org>
Cc: Ingo Molnar <mingo@redhat.com>
Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 11:04:11 +03:00
|
|
|
#include <linux/slab.h>
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
#include "musb_core.h"
|
|
|
|
|
|
|
|
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
|
2011-01-04 14:47:02 +03:00
|
|
|
#define is_buffer_mapped(req) (is_dma_capable() && \
|
|
|
|
(req->map_state != UN_MAPPED))
|
|
|
|
|
2010-11-15 13:24:01 +03:00
|
|
|
/* Maps the buffer to dma */
|
|
|
|
|
|
|
|
static inline void map_dma_buffer(struct musb_request *request,
|
2011-01-04 14:47:02 +03:00
|
|
|
struct musb *musb, struct musb_ep *musb_ep)
|
2010-11-15 13:24:01 +03:00
|
|
|
{
|
2011-01-04 14:47:03 +03:00
|
|
|
int compatible = true;
|
|
|
|
struct dma_controller *dma = musb->dma_controller;
|
|
|
|
|
2011-01-04 14:47:02 +03:00
|
|
|
request->map_state = UN_MAPPED;
|
|
|
|
|
|
|
|
if (!is_dma_capable() || !musb_ep->dma)
|
|
|
|
return;
|
|
|
|
|
2011-01-04 14:47:03 +03:00
|
|
|
/* Check if DMA engine can handle this request.
|
|
|
|
* DMA code must reject the USB request explicitly.
|
|
|
|
* Default behaviour is to map the request.
|
|
|
|
*/
|
|
|
|
if (dma->is_compatible)
|
|
|
|
compatible = dma->is_compatible(musb_ep->dma,
|
|
|
|
musb_ep->packet_sz, request->request.buf,
|
|
|
|
request->request.length);
|
|
|
|
if (!compatible)
|
|
|
|
return;
|
|
|
|
|
2010-11-15 13:24:01 +03:00
|
|
|
if (request->request.dma == DMA_ADDR_INVALID) {
|
2013-08-13 21:35:43 +04:00
|
|
|
dma_addr_t dma_addr;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
dma_addr = dma_map_single(
|
2010-11-15 13:24:01 +03:00
|
|
|
musb->controller,
|
|
|
|
request->request.buf,
|
|
|
|
request->request.length,
|
|
|
|
request->tx
|
|
|
|
? DMA_TO_DEVICE
|
|
|
|
: DMA_FROM_DEVICE);
|
2013-08-13 21:35:43 +04:00
|
|
|
ret = dma_mapping_error(musb->controller, dma_addr);
|
|
|
|
if (ret)
|
|
|
|
return;
|
|
|
|
|
|
|
|
request->request.dma = dma_addr;
|
2011-01-04 14:47:02 +03:00
|
|
|
request->map_state = MUSB_MAPPED;
|
2010-11-15 13:24:01 +03:00
|
|
|
} else {
|
|
|
|
dma_sync_single_for_device(musb->controller,
|
|
|
|
request->request.dma,
|
|
|
|
request->request.length,
|
|
|
|
request->tx
|
|
|
|
? DMA_TO_DEVICE
|
|
|
|
: DMA_FROM_DEVICE);
|
2011-01-04 14:47:02 +03:00
|
|
|
request->map_state = PRE_MAPPED;
|
2010-11-15 13:24:01 +03:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Unmap the buffer from dma and maps it back to cpu */
|
|
|
|
static inline void unmap_dma_buffer(struct musb_request *request,
|
|
|
|
struct musb *musb)
|
|
|
|
{
|
2013-03-15 17:28:50 +04:00
|
|
|
struct musb_ep *musb_ep = request->ep;
|
|
|
|
|
|
|
|
if (!is_buffer_mapped(request) || !musb_ep->dma)
|
2011-01-04 14:47:02 +03:00
|
|
|
return;
|
|
|
|
|
2010-11-15 13:24:01 +03:00
|
|
|
if (request->request.dma == DMA_ADDR_INVALID) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_vdbg(musb->controller,
|
|
|
|
"not unmapping a never mapped buffer\n");
|
2010-11-15 13:24:01 +03:00
|
|
|
return;
|
|
|
|
}
|
2011-01-04 14:47:02 +03:00
|
|
|
if (request->map_state == MUSB_MAPPED) {
|
2010-11-15 13:24:01 +03:00
|
|
|
dma_unmap_single(musb->controller,
|
|
|
|
request->request.dma,
|
|
|
|
request->request.length,
|
|
|
|
request->tx
|
|
|
|
? DMA_TO_DEVICE
|
|
|
|
: DMA_FROM_DEVICE);
|
|
|
|
request->request.dma = DMA_ADDR_INVALID;
|
2011-01-04 14:47:02 +03:00
|
|
|
} else { /* PRE_MAPPED */
|
2010-11-15 13:24:01 +03:00
|
|
|
dma_sync_single_for_cpu(musb->controller,
|
|
|
|
request->request.dma,
|
|
|
|
request->request.length,
|
|
|
|
request->tx
|
|
|
|
? DMA_TO_DEVICE
|
|
|
|
: DMA_FROM_DEVICE);
|
|
|
|
}
|
2011-01-04 14:47:02 +03:00
|
|
|
request->map_state = UN_MAPPED;
|
2010-11-15 13:24:01 +03:00
|
|
|
}
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
/*
|
|
|
|
* Immediately complete a request.
|
|
|
|
*
|
|
|
|
* @param request the request to complete
|
|
|
|
* @param status the status to complete the request with
|
|
|
|
* Context: controller locked, IRQs blocked.
|
|
|
|
*/
|
|
|
|
void musb_g_giveback(
|
|
|
|
struct musb_ep *ep,
|
|
|
|
struct usb_request *request,
|
|
|
|
int status)
|
|
|
|
__releases(ep->musb->lock)
|
|
|
|
__acquires(ep->musb->lock)
|
|
|
|
{
|
|
|
|
struct musb_request *req;
|
|
|
|
struct musb *musb;
|
|
|
|
int busy = ep->busy;
|
|
|
|
|
|
|
|
req = to_musb_request(request);
|
|
|
|
|
2011-02-16 13:40:05 +03:00
|
|
|
list_del(&req->list);
|
2008-07-24 13:27:36 +04:00
|
|
|
if (req->request.status == -EINPROGRESS)
|
|
|
|
req->request.status = status;
|
|
|
|
musb = req->musb;
|
|
|
|
|
|
|
|
ep->busy = 1;
|
|
|
|
spin_unlock(&musb->lock);
|
2013-03-15 17:28:50 +04:00
|
|
|
|
|
|
|
if (!dma_mapping_error(&musb->g.dev, request->dma))
|
|
|
|
unmap_dma_buffer(req, musb);
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
if (request->status == 0)
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s done request %p, %d/%d\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
ep->end_point.name, request,
|
|
|
|
req->request.actual, req->request.length);
|
|
|
|
else
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s request %p, %d/%d fault %d\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
ep->end_point.name, request,
|
|
|
|
req->request.actual, req->request.length,
|
|
|
|
request->status);
|
|
|
|
req->request.complete(&req->ep->end_point, &req->request);
|
|
|
|
spin_lock(&musb->lock);
|
|
|
|
ep->busy = busy;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Abort requests queued to an endpoint using the status. Synchronous.
|
|
|
|
* caller locked controller and blocked irqs, and selected this ep.
|
|
|
|
*/
|
|
|
|
static void nuke(struct musb_ep *ep, const int status)
|
|
|
|
{
|
2011-05-11 13:44:08 +04:00
|
|
|
struct musb *musb = ep->musb;
|
2008-07-24 13:27:36 +04:00
|
|
|
struct musb_request *req = NULL;
|
|
|
|
void __iomem *epio = ep->musb->endpoints[ep->current_epnum].regs;
|
|
|
|
|
|
|
|
ep->busy = 1;
|
|
|
|
|
|
|
|
if (is_dma_capable() && ep->dma) {
|
|
|
|
struct dma_controller *c = ep->musb->dma_controller;
|
|
|
|
int value;
|
2009-03-27 04:27:47 +03:00
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
if (ep->is_in) {
|
2009-03-27 04:27:47 +03:00
|
|
|
/*
|
|
|
|
* The programming guide says that we must not clear
|
|
|
|
* the DMAMODE bit before DMAENAB, so we only
|
|
|
|
* clear it in the second write...
|
|
|
|
*/
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_writew(epio, MUSB_TXCSR,
|
2009-03-27 04:27:47 +03:00
|
|
|
MUSB_TXCSR_DMAMODE | MUSB_TXCSR_FLUSHFIFO);
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_writew(epio, MUSB_TXCSR,
|
|
|
|
0 | MUSB_TXCSR_FLUSHFIFO);
|
|
|
|
} else {
|
|
|
|
musb_writew(epio, MUSB_RXCSR,
|
|
|
|
0 | MUSB_RXCSR_FLUSHFIFO);
|
|
|
|
musb_writew(epio, MUSB_RXCSR,
|
|
|
|
0 | MUSB_RXCSR_FLUSHFIFO);
|
|
|
|
}
|
|
|
|
|
|
|
|
value = c->channel_abort(ep->dma);
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s: abort DMA --> %d\n",
|
|
|
|
ep->name, value);
|
2008-07-24 13:27:36 +04:00
|
|
|
c->channel_release(ep->dma);
|
|
|
|
ep->dma = NULL;
|
|
|
|
}
|
|
|
|
|
2011-02-16 13:40:05 +03:00
|
|
|
while (!list_empty(&ep->req_list)) {
|
|
|
|
req = list_first_entry(&ep->req_list, struct musb_request, list);
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_g_giveback(ep, &req->request, status);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
|
|
|
|
/* Data transfers - pure PIO, pure DMA, or mixed mode */
|
|
|
|
|
|
|
|
/*
|
|
|
|
* This assumes the separate CPPI engine is responding to DMA requests
|
|
|
|
* from the usb core ... sequenced a bit differently from mentor dma.
|
|
|
|
*/
|
|
|
|
|
|
|
|
static inline int max_ep_writesize(struct musb *musb, struct musb_ep *ep)
|
|
|
|
{
|
|
|
|
if (can_bulk_split(musb, ep->type))
|
|
|
|
return ep->hw_ep->max_packet_sz_tx;
|
|
|
|
else
|
|
|
|
return ep->packet_sz;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* An endpoint is transmitting data. This can be called either from
|
|
|
|
* the IRQ routine or from ep.queue() to kickstart a request on an
|
|
|
|
* endpoint.
|
|
|
|
*
|
|
|
|
* Context: controller locked, IRQs blocked, endpoint selected
|
|
|
|
*/
|
|
|
|
static void txstate(struct musb *musb, struct musb_request *req)
|
|
|
|
{
|
|
|
|
u8 epnum = req->epnum;
|
|
|
|
struct musb_ep *musb_ep;
|
|
|
|
void __iomem *epio = musb->endpoints[epnum].regs;
|
|
|
|
struct usb_request *request;
|
|
|
|
u16 fifo_count = 0, csr;
|
|
|
|
int use_dma = 0;
|
|
|
|
|
|
|
|
musb_ep = req->ep;
|
|
|
|
|
2012-05-19 00:48:04 +04:00
|
|
|
/* Check if EP is disabled */
|
|
|
|
if (!musb_ep->desc) {
|
|
|
|
dev_dbg(musb->controller, "ep:%s disabled - ignore request\n",
|
|
|
|
musb_ep->end_point.name);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
/* we shouldn't get here while DMA is active ... but we do ... */
|
|
|
|
if (dma_channel_status(musb_ep->dma) == MUSB_DMA_STATUS_BUSY) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "dma pending...\n");
|
2008-07-24 13:27:36 +04:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* read TXCSR before */
|
|
|
|
csr = musb_readw(epio, MUSB_TXCSR);
|
|
|
|
|
|
|
|
request = &req->request;
|
|
|
|
fifo_count = min(max_ep_writesize(musb, musb_ep),
|
|
|
|
(int)(request->length - request->actual));
|
|
|
|
|
|
|
|
if (csr & MUSB_TXCSR_TXPKTRDY) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s old packet still ready , txcsr %03x\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_ep->end_point.name, csr);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (csr & MUSB_TXCSR_P_SENDSTALL) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s stalling, txcsr %03x\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_ep->end_point.name, csr);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "hw_ep%d, maxpacket %d, fifo count %d, txcsr %03x\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
epnum, musb_ep->packet_sz, fifo_count,
|
|
|
|
csr);
|
|
|
|
|
|
|
|
#ifndef CONFIG_MUSB_PIO_ONLY
|
2011-01-04 14:47:02 +03:00
|
|
|
if (is_buffer_mapped(req)) {
|
2008-07-24 13:27:36 +04:00
|
|
|
struct dma_controller *c = musb->dma_controller;
|
2010-09-20 11:32:06 +04:00
|
|
|
size_t request_size;
|
|
|
|
|
|
|
|
/* setup DMA, then program endpoint CSR */
|
|
|
|
request_size = min_t(size_t, request->length - request->actual,
|
|
|
|
musb_ep->dma->max_len);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2012-07-20 09:37:23 +04:00
|
|
|
use_dma = (request->dma != DMA_ADDR_INVALID && request_size);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* MUSB_TXCSR_P_ISO is still set correctly */
|
|
|
|
|
2011-03-22 17:55:56 +03:00
|
|
|
#if defined(CONFIG_USB_INVENTRA_DMA) || defined(CONFIG_USB_UX500_DMA)
|
2008-07-24 13:27:36 +04:00
|
|
|
{
|
2009-04-02 23:07:08 +04:00
|
|
|
if (request_size < musb_ep->packet_sz)
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_ep->dma->desired_mode = 0;
|
|
|
|
else
|
|
|
|
musb_ep->dma->desired_mode = 1;
|
|
|
|
|
|
|
|
use_dma = use_dma && c->channel_program(
|
|
|
|
musb_ep->dma, musb_ep->packet_sz,
|
|
|
|
musb_ep->dma->desired_mode,
|
2009-12-22 05:18:02 +03:00
|
|
|
request->dma + request->actual, request_size);
|
2008-07-24 13:27:36 +04:00
|
|
|
if (use_dma) {
|
|
|
|
if (musb_ep->dma->desired_mode == 0) {
|
2009-03-27 04:27:47 +03:00
|
|
|
/*
|
|
|
|
* We must not clear the DMAMODE bit
|
|
|
|
* before the DMAENAB bit -- and the
|
|
|
|
* latter doesn't always get cleared
|
|
|
|
* before we get here...
|
|
|
|
*/
|
|
|
|
csr &= ~(MUSB_TXCSR_AUTOSET
|
|
|
|
| MUSB_TXCSR_DMAENAB);
|
|
|
|
musb_writew(epio, MUSB_TXCSR, csr
|
|
|
|
| MUSB_TXCSR_P_WZC_BITS);
|
|
|
|
csr &= ~MUSB_TXCSR_DMAMODE;
|
2008-07-24 13:27:36 +04:00
|
|
|
csr |= (MUSB_TXCSR_DMAENAB |
|
|
|
|
MUSB_TXCSR_MODE);
|
|
|
|
/* against programming guide */
|
2010-09-24 14:44:04 +04:00
|
|
|
} else {
|
|
|
|
csr |= (MUSB_TXCSR_DMAENAB
|
2008-07-24 13:27:36 +04:00
|
|
|
| MUSB_TXCSR_DMAMODE
|
|
|
|
| MUSB_TXCSR_MODE);
|
2012-12-06 09:42:48 +04:00
|
|
|
/*
|
|
|
|
* Enable Autoset according to table
|
|
|
|
* below
|
|
|
|
* bulk_split hb_mult Autoset_Enable
|
|
|
|
* 0 0 Yes(Normal)
|
|
|
|
* 0 >0 No(High BW ISO)
|
|
|
|
* 1 0 Yes(HS bulk)
|
|
|
|
* 1 >0 Yes(FS bulk)
|
|
|
|
*/
|
|
|
|
if (!musb_ep->hb_mult ||
|
|
|
|
(musb_ep->hb_mult &&
|
|
|
|
can_bulk_split(musb,
|
|
|
|
musb_ep->type)))
|
2010-09-24 14:44:04 +04:00
|
|
|
csr |= MUSB_TXCSR_AUTOSET;
|
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
csr &= ~MUSB_TXCSR_P_UNDERRUN;
|
2010-09-24 14:44:04 +04:00
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_writew(epio, MUSB_TXCSR, csr);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
2013-08-13 21:38:23 +04:00
|
|
|
if (is_cppi_enabled()) {
|
|
|
|
/* program endpoint CSR first, then setup DMA */
|
|
|
|
csr &= ~(MUSB_TXCSR_P_UNDERRUN | MUSB_TXCSR_TXPKTRDY);
|
|
|
|
csr |= MUSB_TXCSR_DMAENAB | MUSB_TXCSR_DMAMODE |
|
|
|
|
MUSB_TXCSR_MODE;
|
|
|
|
musb_writew(epio, MUSB_TXCSR, (MUSB_TXCSR_P_WZC_BITS &
|
|
|
|
~MUSB_TXCSR_P_UNDERRUN) | csr);
|
|
|
|
|
|
|
|
/* ensure writebuffer is empty */
|
|
|
|
csr = musb_readw(epio, MUSB_TXCSR);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* NOTE host side sets DMAENAB later than this; both are
|
|
|
|
* OK since the transfer dma glue (between CPPI and
|
|
|
|
* Mentor fifos) just tells CPPI it could start. Data
|
|
|
|
* only moves to the USB TX fifo when both fifos are
|
|
|
|
* ready.
|
|
|
|
*/
|
|
|
|
/*
|
|
|
|
* "mode" is irrelevant here; handle terminating ZLPs
|
|
|
|
* like PIO does, since the hardware RNDIS mode seems
|
|
|
|
* unreliable except for the
|
|
|
|
* last-packet-is-already-short case.
|
|
|
|
*/
|
|
|
|
use_dma = use_dma && c->channel_program(
|
|
|
|
musb_ep->dma, musb_ep->packet_sz,
|
|
|
|
0,
|
|
|
|
request->dma + request->actual,
|
|
|
|
request_size);
|
|
|
|
if (!use_dma) {
|
|
|
|
c->channel_release(musb_ep->dma);
|
|
|
|
musb_ep->dma = NULL;
|
|
|
|
csr &= ~MUSB_TXCSR_DMAENAB;
|
|
|
|
musb_writew(epio, MUSB_TXCSR, csr);
|
|
|
|
/* invariant: prequest->buf is non-null */
|
|
|
|
}
|
|
|
|
} else if (tusb_dma_omap())
|
|
|
|
use_dma = use_dma && c->channel_program(
|
|
|
|
musb_ep->dma, musb_ep->packet_sz,
|
|
|
|
request->zero,
|
|
|
|
request->dma + request->actual,
|
|
|
|
request_size);
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
if (!use_dma) {
|
2010-11-15 13:24:01 +03:00
|
|
|
/*
|
|
|
|
* Unmap the dma buffer back to cpu if dma channel
|
|
|
|
* programming fails
|
|
|
|
*/
|
2011-01-04 14:47:02 +03:00
|
|
|
unmap_dma_buffer(req, musb);
|
2010-11-15 13:24:01 +03:00
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_write_fifo(musb_ep->hw_ep, fifo_count,
|
|
|
|
(u8 *) (request->buf + request->actual));
|
|
|
|
request->actual += fifo_count;
|
|
|
|
csr |= MUSB_TXCSR_TXPKTRDY;
|
|
|
|
csr &= ~MUSB_TXCSR_P_UNDERRUN;
|
|
|
|
musb_writew(epio, MUSB_TXCSR, csr);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* host may already have the data when this message shows... */
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s TX/IN %s len %d/%d, txcsr %04x, fifo %d/%d\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_ep->end_point.name, use_dma ? "dma" : "pio",
|
|
|
|
request->actual, request->length,
|
|
|
|
musb_readw(epio, MUSB_TXCSR),
|
|
|
|
fifo_count,
|
|
|
|
musb_readw(epio, MUSB_TXMAXP));
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* FIFO state update (e.g. data ready).
|
|
|
|
* Called from IRQ, with controller locked.
|
|
|
|
*/
|
|
|
|
void musb_g_tx(struct musb *musb, u8 epnum)
|
|
|
|
{
|
|
|
|
u16 csr;
|
2011-02-16 13:40:05 +03:00
|
|
|
struct musb_request *req;
|
2008-07-24 13:27:36 +04:00
|
|
|
struct usb_request *request;
|
|
|
|
u8 __iomem *mbase = musb->mregs;
|
|
|
|
struct musb_ep *musb_ep = &musb->endpoints[epnum].ep_in;
|
|
|
|
void __iomem *epio = musb->endpoints[epnum].regs;
|
|
|
|
struct dma_channel *dma;
|
|
|
|
|
|
|
|
musb_ep_select(mbase, epnum);
|
2011-02-16 13:40:05 +03:00
|
|
|
req = next_request(musb_ep);
|
|
|
|
request = &req->request;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
csr = musb_readw(epio, MUSB_TXCSR);
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "<== %s, txcsr %04x\n", musb_ep->end_point.name, csr);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
dma = is_dma_capable() ? musb_ep->dma : NULL;
|
2009-11-18 22:55:28 +03:00
|
|
|
|
|
|
|
/*
|
|
|
|
* REVISIT: for high bandwidth, MUSB_TXCSR_P_INCOMPTX
|
|
|
|
* probably rates reporting as a host error.
|
|
|
|
*/
|
|
|
|
if (csr & MUSB_TXCSR_P_SENTSTALL) {
|
|
|
|
csr |= MUSB_TXCSR_P_WZC_BITS;
|
|
|
|
csr &= ~MUSB_TXCSR_P_SENTSTALL;
|
|
|
|
musb_writew(epio, MUSB_TXCSR, csr);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (csr & MUSB_TXCSR_P_UNDERRUN) {
|
|
|
|
/* We NAKed, no big deal... little reason to care. */
|
|
|
|
csr |= MUSB_TXCSR_P_WZC_BITS;
|
|
|
|
csr &= ~(MUSB_TXCSR_P_UNDERRUN | MUSB_TXCSR_TXPKTRDY);
|
|
|
|
musb_writew(epio, MUSB_TXCSR, csr);
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_vdbg(musb->controller, "underrun on ep%d, req %p\n",
|
|
|
|
epnum, request);
|
2009-11-18 22:55:28 +03:00
|
|
|
}
|
|
|
|
|
|
|
|
if (dma_channel_status(dma) == MUSB_DMA_STATUS_BUSY) {
|
|
|
|
/*
|
|
|
|
* SHOULD NOT HAPPEN... has with CPPI though, after
|
|
|
|
* changing SENDSTALL (and other cases); harmless?
|
2008-07-24 13:27:36 +04:00
|
|
|
*/
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s dma still busy?\n", musb_ep->end_point.name);
|
2009-11-18 22:55:28 +03:00
|
|
|
return;
|
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2009-11-18 22:55:28 +03:00
|
|
|
if (request) {
|
|
|
|
u8 is_dma = 0;
|
|
|
|
|
|
|
|
if (dma && (csr & MUSB_TXCSR_DMAENAB)) {
|
|
|
|
is_dma = 1;
|
2008-07-24 13:27:36 +04:00
|
|
|
csr |= MUSB_TXCSR_P_WZC_BITS;
|
2009-11-18 22:55:28 +03:00
|
|
|
csr &= ~(MUSB_TXCSR_DMAENAB | MUSB_TXCSR_P_UNDERRUN |
|
2011-03-15 18:24:24 +03:00
|
|
|
MUSB_TXCSR_TXPKTRDY | MUSB_TXCSR_AUTOSET);
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_writew(epio, MUSB_TXCSR, csr);
|
2009-11-18 22:55:28 +03:00
|
|
|
/* Ensure writebuffer is empty. */
|
|
|
|
csr = musb_readw(epio, MUSB_TXCSR);
|
|
|
|
request->actual += musb_ep->dma->actual_len;
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "TXCSR%d %04x, DMA off, len %zu, req %p\n",
|
2009-11-18 22:55:28 +03:00
|
|
|
epnum, csr, musb_ep->dma->actual_len, request);
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
2010-09-24 14:44:14 +04:00
|
|
|
/*
|
|
|
|
* First, maybe a terminating short packet. Some DMA
|
|
|
|
* engines might handle this by themselves.
|
|
|
|
*/
|
|
|
|
if ((request->zero && request->length
|
|
|
|
&& (request->length % musb_ep->packet_sz == 0)
|
|
|
|
&& (request->actual == request->length))
|
2011-03-22 17:55:56 +03:00
|
|
|
#if defined(CONFIG_USB_INVENTRA_DMA) || defined(CONFIG_USB_UX500_DMA)
|
2010-09-24 14:44:14 +04:00
|
|
|
|| (is_dma && (!dma->desired_mode ||
|
|
|
|
(request->actual &
|
|
|
|
(musb_ep->packet_sz - 1))))
|
2008-07-24 13:27:36 +04:00
|
|
|
#endif
|
2010-09-24 14:44:14 +04:00
|
|
|
) {
|
|
|
|
/*
|
|
|
|
* On DMA completion, FIFO may not be
|
|
|
|
* available yet...
|
|
|
|
*/
|
|
|
|
if (csr & MUSB_TXCSR_TXPKTRDY)
|
|
|
|
return;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "sending zero pkt\n");
|
2010-09-24 14:44:14 +04:00
|
|
|
musb_writew(epio, MUSB_TXCSR, MUSB_TXCSR_MODE
|
|
|
|
| MUSB_TXCSR_TXPKTRDY);
|
|
|
|
request->zero = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (request->actual == request->length) {
|
|
|
|
musb_g_giveback(musb_ep, request, 0);
|
2012-02-17 13:24:52 +04:00
|
|
|
/*
|
|
|
|
* In the giveback function the MUSB lock is
|
|
|
|
* released and acquired after sometime. During
|
|
|
|
* this time period the INDEX register could get
|
|
|
|
* changed by the gadget_queue function especially
|
|
|
|
* on SMP systems. Reselect the INDEX to be sure
|
|
|
|
* we are reading/modifying the right registers
|
|
|
|
*/
|
|
|
|
musb_ep_select(mbase, epnum);
|
2011-02-16 13:40:05 +03:00
|
|
|
req = musb_ep->desc ? next_request(musb_ep) : NULL;
|
|
|
|
if (!req) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s idle now\n",
|
2010-09-24 14:44:14 +04:00
|
|
|
musb_ep->end_point.name);
|
|
|
|
return;
|
2009-12-16 20:38:31 +03:00
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
2011-02-16 13:40:05 +03:00
|
|
|
txstate(musb, req);
|
2009-11-18 22:55:28 +03:00
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------ */
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Context: controller locked, IRQs blocked, endpoint selected
|
|
|
|
*/
|
|
|
|
static void rxstate(struct musb *musb, struct musb_request *req)
|
|
|
|
{
|
|
|
|
const u8 epnum = req->epnum;
|
|
|
|
struct usb_request *request = &req->request;
|
2010-09-20 11:32:01 +04:00
|
|
|
struct musb_ep *musb_ep;
|
2008-07-24 13:27:36 +04:00
|
|
|
void __iomem *epio = musb->endpoints[epnum].regs;
|
2012-07-16 23:25:04 +04:00
|
|
|
unsigned len = 0;
|
|
|
|
u16 fifo_count;
|
2009-11-18 22:51:18 +03:00
|
|
|
u16 csr = musb_readw(epio, MUSB_RXCSR);
|
2010-09-20 11:32:01 +04:00
|
|
|
struct musb_hw_ep *hw_ep = &musb->endpoints[epnum];
|
2011-07-20 09:11:58 +04:00
|
|
|
u8 use_mode_1;
|
2010-09-20 11:32:01 +04:00
|
|
|
|
|
|
|
if (hw_ep->is_shared_fifo)
|
|
|
|
musb_ep = &hw_ep->ep_in;
|
|
|
|
else
|
|
|
|
musb_ep = &hw_ep->ep_out;
|
|
|
|
|
2012-07-16 23:25:04 +04:00
|
|
|
fifo_count = musb_ep->packet_sz;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2012-05-19 00:48:04 +04:00
|
|
|
/* Check if EP is disabled */
|
|
|
|
if (!musb_ep->desc) {
|
|
|
|
dev_dbg(musb->controller, "ep:%s disabled - ignore request\n",
|
|
|
|
musb_ep->end_point.name);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2009-11-18 22:51:18 +03:00
|
|
|
/* We shouldn't get here while DMA is active, but we do... */
|
|
|
|
if (dma_channel_status(musb_ep->dma) == MUSB_DMA_STATUS_BUSY) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "DMA pending...\n");
|
2009-11-18 22:51:18 +03:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (csr & MUSB_RXCSR_P_SENDSTALL) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s stalling, RXCSR %04x\n",
|
2009-11-18 22:51:18 +03:00
|
|
|
musb_ep->end_point.name, csr);
|
|
|
|
return;
|
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2011-01-04 14:47:02 +03:00
|
|
|
if (is_cppi_enabled() && is_buffer_mapped(req)) {
|
2008-07-24 13:27:36 +04:00
|
|
|
struct dma_controller *c = musb->dma_controller;
|
|
|
|
struct dma_channel *channel = musb_ep->dma;
|
|
|
|
|
|
|
|
/* NOTE: CPPI won't actually stop advancing the DMA
|
|
|
|
* queue after short packet transfers, so this is almost
|
|
|
|
* always going to run as IRQ-per-packet DMA so that
|
|
|
|
* faults will be handled correctly.
|
|
|
|
*/
|
|
|
|
if (c->channel_program(channel,
|
|
|
|
musb_ep->packet_sz,
|
|
|
|
!request->short_not_ok,
|
|
|
|
request->dma + request->actual,
|
|
|
|
request->length - request->actual)) {
|
|
|
|
|
|
|
|
/* make sure that if an rxpkt arrived after the irq,
|
|
|
|
* the cppi engine will be ready to take it as soon
|
|
|
|
* as DMA is enabled
|
|
|
|
*/
|
|
|
|
csr &= ~(MUSB_RXCSR_AUTOCLEAR
|
|
|
|
| MUSB_RXCSR_DMAMODE);
|
|
|
|
csr |= MUSB_RXCSR_DMAENAB | MUSB_RXCSR_P_WZC_BITS;
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
if (csr & MUSB_RXCSR_RXPKTRDY) {
|
2012-07-16 23:25:04 +04:00
|
|
|
fifo_count = musb_readw(epio, MUSB_RXCOUNT);
|
2011-07-20 09:11:58 +04:00
|
|
|
|
|
|
|
/*
|
2012-10-26 10:55:31 +04:00
|
|
|
* Enable Mode 1 on RX transfers only when short_not_ok flag
|
|
|
|
* is set. Currently short_not_ok flag is set only from
|
|
|
|
* file_storage and f_mass_storage drivers
|
2011-07-20 09:11:58 +04:00
|
|
|
*/
|
2012-10-26 10:55:31 +04:00
|
|
|
|
|
|
|
if (request->short_not_ok && fifo_count == musb_ep->packet_sz)
|
2011-07-20 09:11:58 +04:00
|
|
|
use_mode_1 = 1;
|
|
|
|
else
|
|
|
|
use_mode_1 = 0;
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
if (request->actual < request->length) {
|
|
|
|
#ifdef CONFIG_USB_INVENTRA_DMA
|
2011-01-04 14:47:02 +03:00
|
|
|
if (is_buffer_mapped(req)) {
|
2008-07-24 13:27:36 +04:00
|
|
|
struct dma_controller *c;
|
|
|
|
struct dma_channel *channel;
|
|
|
|
int use_dma = 0;
|
2013-02-06 12:19:15 +04:00
|
|
|
unsigned int transfer_size;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
c = musb->dma_controller;
|
|
|
|
channel = musb_ep->dma;
|
|
|
|
|
2012-10-26 10:55:31 +04:00
|
|
|
/* We use DMA Req mode 0 in rx_csr, and DMA controller operates in
|
|
|
|
* mode 0 only. So we do not get endpoint interrupts due to DMA
|
|
|
|
* completion. We only get interrupts from DMA controller.
|
|
|
|
*
|
|
|
|
* We could operate in DMA mode 1 if we knew the size of the tranfer
|
|
|
|
* in advance. For mass storage class, request->length = what the host
|
|
|
|
* sends, so that'd work. But for pretty much everything else,
|
|
|
|
* request->length is routinely more than what the host sends. For
|
|
|
|
* most these gadgets, end of is signified either by a short packet,
|
|
|
|
* or filling the last byte of the buffer. (Sending extra data in
|
|
|
|
* that last pckate should trigger an overflow fault.) But in mode 1,
|
|
|
|
* we don't get DMA completion interrupt for short packets.
|
|
|
|
*
|
|
|
|
* Theoretically, we could enable DMAReq irq (MUSB_RXCSR_DMAMODE = 1),
|
|
|
|
* to get endpoint interrupt on every DMA req, but that didn't seem
|
|
|
|
* to work reliably.
|
|
|
|
*
|
|
|
|
* REVISIT an updated g_file_storage can set req->short_not_ok, which
|
|
|
|
* then becomes usable as a runtime "use mode 1" hint...
|
|
|
|
*/
|
|
|
|
|
2011-07-20 09:11:58 +04:00
|
|
|
/* Experimental: Mode1 works with mass storage use cases */
|
|
|
|
if (use_mode_1) {
|
2010-09-25 14:50:43 +04:00
|
|
|
csr |= MUSB_RXCSR_AUTOCLEAR;
|
2011-07-20 09:11:58 +04:00
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
csr |= MUSB_RXCSR_DMAENAB;
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* this special sequence (enabling and then
|
|
|
|
* disabling MUSB_RXCSR_DMAMODE) is required
|
|
|
|
* to get DMAReq to activate
|
|
|
|
*/
|
|
|
|
musb_writew(epio, MUSB_RXCSR,
|
|
|
|
csr | MUSB_RXCSR_DMAMODE);
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
|
2013-02-06 12:19:15 +04:00
|
|
|
transfer_size = min_t(unsigned int,
|
|
|
|
request->length -
|
|
|
|
request->actual,
|
2012-08-07 17:26:32 +04:00
|
|
|
channel->max_len);
|
|
|
|
musb_ep->dma->desired_mode = 1;
|
2011-07-20 09:11:58 +04:00
|
|
|
} else {
|
|
|
|
if (!musb_ep->hb_mult &&
|
|
|
|
musb_ep->hw_ep->rx_double_buffered)
|
|
|
|
csr |= MUSB_RXCSR_AUTOCLEAR;
|
|
|
|
csr |= MUSB_RXCSR_DMAENAB;
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2012-08-07 17:26:32 +04:00
|
|
|
transfer_size = min(request->length - request->actual,
|
2012-07-16 23:25:04 +04:00
|
|
|
(unsigned)fifo_count);
|
2012-08-07 17:26:32 +04:00
|
|
|
musb_ep->dma->desired_mode = 0;
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
2012-08-07 17:26:32 +04:00
|
|
|
use_dma = c->channel_program(
|
|
|
|
channel,
|
|
|
|
musb_ep->packet_sz,
|
|
|
|
channel->desired_mode,
|
|
|
|
request->dma
|
|
|
|
+ request->actual,
|
|
|
|
transfer_size);
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
if (use_dma)
|
2011-03-22 17:55:56 +03:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
#elif defined(CONFIG_USB_UX500_DMA)
|
|
|
|
if ((is_buffer_mapped(req)) &&
|
|
|
|
(request->actual < request->length)) {
|
|
|
|
|
|
|
|
struct dma_controller *c;
|
|
|
|
struct dma_channel *channel;
|
2013-02-06 12:19:15 +04:00
|
|
|
unsigned int transfer_size = 0;
|
2011-03-22 17:55:56 +03:00
|
|
|
|
|
|
|
c = musb->dma_controller;
|
|
|
|
channel = musb_ep->dma;
|
|
|
|
|
|
|
|
/* In case first packet is short */
|
2012-07-16 23:25:04 +04:00
|
|
|
if (fifo_count < musb_ep->packet_sz)
|
|
|
|
transfer_size = fifo_count;
|
2011-03-22 17:55:56 +03:00
|
|
|
else if (request->short_not_ok)
|
2013-02-06 12:19:15 +04:00
|
|
|
transfer_size = min_t(unsigned int,
|
|
|
|
request->length -
|
2011-03-22 17:55:56 +03:00
|
|
|
request->actual,
|
|
|
|
channel->max_len);
|
|
|
|
else
|
2013-02-06 12:19:15 +04:00
|
|
|
transfer_size = min_t(unsigned int,
|
|
|
|
request->length -
|
2011-03-22 17:55:56 +03:00
|
|
|
request->actual,
|
2012-07-16 23:25:04 +04:00
|
|
|
(unsigned)fifo_count);
|
2011-03-22 17:55:56 +03:00
|
|
|
|
|
|
|
csr &= ~MUSB_RXCSR_DMAMODE;
|
|
|
|
csr |= (MUSB_RXCSR_DMAENAB |
|
|
|
|
MUSB_RXCSR_AUTOCLEAR);
|
|
|
|
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
|
|
|
|
if (transfer_size <= musb_ep->packet_sz) {
|
|
|
|
musb_ep->dma->desired_mode = 0;
|
|
|
|
} else {
|
|
|
|
musb_ep->dma->desired_mode = 1;
|
|
|
|
/* Mode must be set after DMAENAB */
|
|
|
|
csr |= MUSB_RXCSR_DMAMODE;
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (c->channel_program(channel,
|
|
|
|
musb_ep->packet_sz,
|
|
|
|
channel->desired_mode,
|
|
|
|
request->dma
|
|
|
|
+ request->actual,
|
|
|
|
transfer_size))
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
#endif /* Mentor's DMA */
|
|
|
|
|
2012-07-16 23:25:04 +04:00
|
|
|
len = request->length - request->actual;
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s OUT/RX pio fifo %d/%d, maxpacket %d\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_ep->end_point.name,
|
2012-07-16 23:25:04 +04:00
|
|
|
fifo_count, len,
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_ep->packet_sz);
|
|
|
|
|
2009-02-22 02:29:42 +03:00
|
|
|
fifo_count = min_t(unsigned, len, fifo_count);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
#ifdef CONFIG_USB_TUSB_OMAP_DMA
|
2011-01-04 14:47:02 +03:00
|
|
|
if (tusb_dma_omap() && is_buffer_mapped(req)) {
|
2008-07-24 13:27:36 +04:00
|
|
|
struct dma_controller *c = musb->dma_controller;
|
|
|
|
struct dma_channel *channel = musb_ep->dma;
|
|
|
|
u32 dma_addr = request->dma + request->actual;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = c->channel_program(channel,
|
|
|
|
musb_ep->packet_sz,
|
|
|
|
channel->desired_mode,
|
|
|
|
dma_addr,
|
|
|
|
fifo_count);
|
|
|
|
if (ret)
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
#endif
|
2010-11-15 13:24:01 +03:00
|
|
|
/*
|
|
|
|
* Unmap the dma buffer back to cpu if dma channel
|
|
|
|
* programming fails. This buffer is mapped if the
|
|
|
|
* channel allocation is successful
|
|
|
|
*/
|
2011-01-04 14:47:02 +03:00
|
|
|
if (is_buffer_mapped(req)) {
|
2010-11-15 13:24:01 +03:00
|
|
|
unmap_dma_buffer(req, musb);
|
|
|
|
|
2010-11-16 18:37:37 +03:00
|
|
|
/*
|
|
|
|
* Clear DMAENAB and AUTOCLEAR for the
|
2010-11-15 13:24:01 +03:00
|
|
|
* PIO mode transfer
|
|
|
|
*/
|
2010-11-16 18:37:37 +03:00
|
|
|
csr &= ~(MUSB_RXCSR_DMAENAB | MUSB_RXCSR_AUTOCLEAR);
|
2010-11-15 13:24:01 +03:00
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
musb_read_fifo(musb_ep->hw_ep, fifo_count, (u8 *)
|
|
|
|
(request->buf + request->actual));
|
|
|
|
request->actual += fifo_count;
|
|
|
|
|
|
|
|
/* REVISIT if we left anything in the fifo, flush
|
|
|
|
* it and report -EOVERFLOW
|
|
|
|
*/
|
|
|
|
|
|
|
|
/* ack the read! */
|
|
|
|
csr |= MUSB_RXCSR_P_WZC_BITS;
|
|
|
|
csr &= ~MUSB_RXCSR_RXPKTRDY;
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* reach the end or short packet detected */
|
2012-07-16 23:25:04 +04:00
|
|
|
if (request->actual == request->length ||
|
|
|
|
fifo_count < musb_ep->packet_sz)
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_g_giveback(musb_ep, request, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Data ready for a request; called from IRQ
|
|
|
|
*/
|
|
|
|
void musb_g_rx(struct musb *musb, u8 epnum)
|
|
|
|
{
|
|
|
|
u16 csr;
|
2011-02-16 13:40:05 +03:00
|
|
|
struct musb_request *req;
|
2008-07-24 13:27:36 +04:00
|
|
|
struct usb_request *request;
|
|
|
|
void __iomem *mbase = musb->mregs;
|
2010-09-20 11:32:01 +04:00
|
|
|
struct musb_ep *musb_ep;
|
2008-07-24 13:27:36 +04:00
|
|
|
void __iomem *epio = musb->endpoints[epnum].regs;
|
|
|
|
struct dma_channel *dma;
|
2010-09-20 11:32:01 +04:00
|
|
|
struct musb_hw_ep *hw_ep = &musb->endpoints[epnum];
|
|
|
|
|
|
|
|
if (hw_ep->is_shared_fifo)
|
|
|
|
musb_ep = &hw_ep->ep_in;
|
|
|
|
else
|
|
|
|
musb_ep = &hw_ep->ep_out;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
musb_ep_select(mbase, epnum);
|
|
|
|
|
2011-02-16 13:40:05 +03:00
|
|
|
req = next_request(musb_ep);
|
|
|
|
if (!req)
|
2009-12-22 13:48:19 +03:00
|
|
|
return;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2011-02-16 13:40:05 +03:00
|
|
|
request = &req->request;
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
csr = musb_readw(epio, MUSB_RXCSR);
|
|
|
|
dma = is_dma_capable() ? musb_ep->dma : NULL;
|
|
|
|
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "<== %s, rxcsr %04x%s %p\n", musb_ep->end_point.name,
|
2008-07-24 13:27:36 +04:00
|
|
|
csr, dma ? " (dma)" : "", request);
|
|
|
|
|
|
|
|
if (csr & MUSB_RXCSR_P_SENTSTALL) {
|
|
|
|
csr |= MUSB_RXCSR_P_WZC_BITS;
|
|
|
|
csr &= ~MUSB_RXCSR_P_SENTSTALL;
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
2009-11-18 22:51:18 +03:00
|
|
|
return;
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
if (csr & MUSB_RXCSR_P_OVERRUN) {
|
|
|
|
/* csr |= MUSB_RXCSR_P_WZC_BITS; */
|
|
|
|
csr &= ~MUSB_RXCSR_P_OVERRUN;
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s iso overrun on %p\n", musb_ep->name, request);
|
2010-09-24 14:44:12 +04:00
|
|
|
if (request->status == -EINPROGRESS)
|
2008-07-24 13:27:36 +04:00
|
|
|
request->status = -EOVERFLOW;
|
|
|
|
}
|
|
|
|
if (csr & MUSB_RXCSR_INCOMPRX) {
|
|
|
|
/* REVISIT not necessarily an error */
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s, incomprx\n", musb_ep->end_point.name);
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
if (dma_channel_status(dma) == MUSB_DMA_STATUS_BUSY) {
|
|
|
|
/* "should not happen"; likely RXPKTRDY pending for DMA */
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s busy, csr %04x\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_ep->end_point.name, csr);
|
2009-11-18 22:51:18 +03:00
|
|
|
return;
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
if (dma && (csr & MUSB_RXCSR_DMAENAB)) {
|
|
|
|
csr &= ~(MUSB_RXCSR_AUTOCLEAR
|
|
|
|
| MUSB_RXCSR_DMAENAB
|
|
|
|
| MUSB_RXCSR_DMAMODE);
|
|
|
|
musb_writew(epio, MUSB_RXCSR,
|
|
|
|
MUSB_RXCSR_P_WZC_BITS | csr);
|
|
|
|
|
|
|
|
request->actual += musb_ep->dma->actual_len;
|
|
|
|
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "RXCSR%d %04x, dma off, %04x, len %zu, req %p\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
epnum, csr,
|
|
|
|
musb_readw(epio, MUSB_RXCSR),
|
|
|
|
musb_ep->dma->actual_len, request);
|
|
|
|
|
2011-03-22 17:55:56 +03:00
|
|
|
#if defined(CONFIG_USB_INVENTRA_DMA) || defined(CONFIG_USB_TUSB_OMAP_DMA) || \
|
|
|
|
defined(CONFIG_USB_UX500_DMA)
|
2008-07-24 13:27:36 +04:00
|
|
|
/* Autoclear doesn't clear RxPktRdy for short packets */
|
2010-09-25 14:50:43 +04:00
|
|
|
if ((dma->desired_mode == 0 && !hw_ep->rx_double_buffered)
|
2008-07-24 13:27:36 +04:00
|
|
|
|| (dma->actual_len
|
|
|
|
& (musb_ep->packet_sz - 1))) {
|
|
|
|
/* ack the read! */
|
|
|
|
csr &= ~MUSB_RXCSR_RXPKTRDY;
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* incomplete, and not short? wait for next IN packet */
|
|
|
|
if ((request->actual < request->length)
|
|
|
|
&& (musb_ep->dma->actual_len
|
2010-09-25 14:50:43 +04:00
|
|
|
== musb_ep->packet_sz)) {
|
|
|
|
/* In double buffer case, continue to unload fifo if
|
|
|
|
* there is Rx packet in FIFO.
|
|
|
|
**/
|
|
|
|
csr = musb_readw(epio, MUSB_RXCSR);
|
|
|
|
if ((csr & MUSB_RXCSR_RXPKTRDY) &&
|
|
|
|
hw_ep->rx_double_buffered)
|
|
|
|
goto exit;
|
2009-11-18 22:51:18 +03:00
|
|
|
return;
|
2010-09-25 14:50:43 +04:00
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
#endif
|
|
|
|
musb_g_giveback(musb_ep, request, 0);
|
2012-02-17 13:24:52 +04:00
|
|
|
/*
|
|
|
|
* In the giveback function the MUSB lock is
|
|
|
|
* released and acquired after sometime. During
|
|
|
|
* this time period the INDEX register could get
|
|
|
|
* changed by the gadget_queue function especially
|
|
|
|
* on SMP systems. Reselect the INDEX to be sure
|
|
|
|
* we are reading/modifying the right registers
|
|
|
|
*/
|
|
|
|
musb_ep_select(mbase, epnum);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2011-02-16 13:40:05 +03:00
|
|
|
req = next_request(musb_ep);
|
|
|
|
if (!req)
|
2009-11-18 22:51:18 +03:00
|
|
|
return;
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
2011-03-22 17:55:56 +03:00
|
|
|
#if defined(CONFIG_USB_INVENTRA_DMA) || defined(CONFIG_USB_TUSB_OMAP_DMA) || \
|
|
|
|
defined(CONFIG_USB_UX500_DMA)
|
2010-09-25 14:50:43 +04:00
|
|
|
exit:
|
2010-11-22 11:52:41 +03:00
|
|
|
#endif
|
2010-09-24 14:44:12 +04:00
|
|
|
/* Analyze request */
|
2011-02-16 13:40:05 +03:00
|
|
|
rxstate(musb, req);
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------ */
|
|
|
|
|
|
|
|
static int musb_gadget_enable(struct usb_ep *ep,
|
|
|
|
const struct usb_endpoint_descriptor *desc)
|
|
|
|
{
|
|
|
|
unsigned long flags;
|
|
|
|
struct musb_ep *musb_ep;
|
|
|
|
struct musb_hw_ep *hw_ep;
|
|
|
|
void __iomem *regs;
|
|
|
|
struct musb *musb;
|
|
|
|
void __iomem *mbase;
|
|
|
|
u8 epnum;
|
|
|
|
u16 csr;
|
|
|
|
unsigned tmp;
|
|
|
|
int status = -EINVAL;
|
|
|
|
|
|
|
|
if (!ep || !desc)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
musb_ep = to_musb_ep(ep);
|
|
|
|
hw_ep = musb_ep->hw_ep;
|
|
|
|
regs = hw_ep->regs;
|
|
|
|
musb = musb_ep->musb;
|
|
|
|
mbase = musb->mregs;
|
|
|
|
epnum = musb_ep->current_epnum;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&musb->lock, flags);
|
|
|
|
|
|
|
|
if (musb_ep->desc) {
|
|
|
|
status = -EBUSY;
|
|
|
|
goto fail;
|
|
|
|
}
|
2009-01-25 04:57:24 +03:00
|
|
|
musb_ep->type = usb_endpoint_type(desc);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* check direction and (later) maxpacket size against endpoint */
|
2009-01-25 04:57:24 +03:00
|
|
|
if (usb_endpoint_num(desc) != epnum)
|
2008-07-24 13:27:36 +04:00
|
|
|
goto fail;
|
|
|
|
|
|
|
|
/* REVISIT this rules out high bandwidth periodic transfers */
|
2011-08-23 14:12:03 +04:00
|
|
|
tmp = usb_endpoint_maxp(desc);
|
2010-09-24 14:44:04 +04:00
|
|
|
if (tmp & ~0x07ff) {
|
|
|
|
int ok;
|
|
|
|
|
|
|
|
if (usb_endpoint_dir_in(desc))
|
|
|
|
ok = musb->hb_iso_tx;
|
|
|
|
else
|
|
|
|
ok = musb->hb_iso_rx;
|
|
|
|
|
|
|
|
if (!ok) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "no support for high bandwidth ISO\n");
|
2010-09-24 14:44:04 +04:00
|
|
|
goto fail;
|
|
|
|
}
|
|
|
|
musb_ep->hb_mult = (tmp >> 11) & 3;
|
|
|
|
} else {
|
|
|
|
musb_ep->hb_mult = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
musb_ep->packet_sz = tmp & 0x7ff;
|
|
|
|
tmp = musb_ep->packet_sz * (musb_ep->hb_mult + 1);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* enable the interrupts for the endpoint, set the endpoint
|
|
|
|
* packet size (or fail), set the mode, clear the fifo
|
|
|
|
*/
|
|
|
|
musb_ep_select(mbase, epnum);
|
2009-01-25 04:57:24 +03:00
|
|
|
if (usb_endpoint_dir_in(desc)) {
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
if (hw_ep->is_shared_fifo)
|
|
|
|
musb_ep->is_in = 1;
|
|
|
|
if (!musb_ep->is_in)
|
|
|
|
goto fail;
|
2010-09-24 14:44:04 +04:00
|
|
|
|
|
|
|
if (tmp > hw_ep->max_packet_sz_tx) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "packet size beyond hardware FIFO size\n");
|
2008-07-24 13:27:36 +04:00
|
|
|
goto fail;
|
2010-09-24 14:44:04 +04:00
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2012-10-30 22:52:26 +04:00
|
|
|
musb->intrtxe |= (1 << epnum);
|
|
|
|
musb_writew(mbase, MUSB_INTRTXE, musb->intrtxe);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* REVISIT if can_bulk_split(), use by updating "tmp";
|
|
|
|
* likewise high bandwidth periodic tx
|
|
|
|
*/
|
2010-01-29 04:44:18 +03:00
|
|
|
/* Set TXMAXP with the FIFO size of the endpoint
|
2010-10-20 04:08:25 +04:00
|
|
|
* to disable double buffering mode.
|
2010-01-29 04:44:18 +03:00
|
|
|
*/
|
2012-12-06 09:42:48 +04:00
|
|
|
if (musb->double_buffer_not_ok) {
|
2011-01-21 08:39:20 +03:00
|
|
|
musb_writew(regs, MUSB_TXMAXP, hw_ep->max_packet_sz_tx);
|
2012-12-06 09:42:48 +04:00
|
|
|
} else {
|
|
|
|
if (can_bulk_split(musb, musb_ep->type))
|
|
|
|
musb_ep->hb_mult = (hw_ep->max_packet_sz_tx /
|
|
|
|
musb_ep->packet_sz) - 1;
|
2011-01-21 08:39:20 +03:00
|
|
|
musb_writew(regs, MUSB_TXMAXP, musb_ep->packet_sz
|
|
|
|
| (musb_ep->hb_mult << 11));
|
2012-12-06 09:42:48 +04:00
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
csr = MUSB_TXCSR_MODE | MUSB_TXCSR_CLRDATATOG;
|
|
|
|
if (musb_readw(regs, MUSB_TXCSR)
|
|
|
|
& MUSB_TXCSR_FIFONOTEMPTY)
|
|
|
|
csr |= MUSB_TXCSR_FLUSHFIFO;
|
|
|
|
if (musb_ep->type == USB_ENDPOINT_XFER_ISOC)
|
|
|
|
csr |= MUSB_TXCSR_P_ISO;
|
|
|
|
|
|
|
|
/* set twice in case of double buffering */
|
|
|
|
musb_writew(regs, MUSB_TXCSR, csr);
|
|
|
|
/* REVISIT may be inappropriate w/o FIFONOTEMPTY ... */
|
|
|
|
musb_writew(regs, MUSB_TXCSR, csr);
|
|
|
|
|
|
|
|
} else {
|
|
|
|
|
|
|
|
if (hw_ep->is_shared_fifo)
|
|
|
|
musb_ep->is_in = 0;
|
|
|
|
if (musb_ep->is_in)
|
|
|
|
goto fail;
|
2010-09-24 14:44:04 +04:00
|
|
|
|
|
|
|
if (tmp > hw_ep->max_packet_sz_rx) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "packet size beyond hardware FIFO size\n");
|
2008-07-24 13:27:36 +04:00
|
|
|
goto fail;
|
2010-09-24 14:44:04 +04:00
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2012-10-30 22:52:25 +04:00
|
|
|
musb->intrrxe |= (1 << epnum);
|
|
|
|
musb_writew(mbase, MUSB_INTRRXE, musb->intrrxe);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* REVISIT if can_bulk_combine() use by updating "tmp"
|
|
|
|
* likewise high bandwidth periodic rx
|
|
|
|
*/
|
2010-01-29 04:44:18 +03:00
|
|
|
/* Set RXMAXP with the FIFO size of the endpoint
|
|
|
|
* to disable double buffering mode.
|
|
|
|
*/
|
2011-01-21 08:39:20 +03:00
|
|
|
if (musb->double_buffer_not_ok)
|
|
|
|
musb_writew(regs, MUSB_RXMAXP, hw_ep->max_packet_sz_tx);
|
|
|
|
else
|
|
|
|
musb_writew(regs, MUSB_RXMAXP, musb_ep->packet_sz
|
|
|
|
| (musb_ep->hb_mult << 11));
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* force shared fifo to OUT-only mode */
|
|
|
|
if (hw_ep->is_shared_fifo) {
|
|
|
|
csr = musb_readw(regs, MUSB_TXCSR);
|
|
|
|
csr &= ~(MUSB_TXCSR_MODE | MUSB_TXCSR_TXPKTRDY);
|
|
|
|
musb_writew(regs, MUSB_TXCSR, csr);
|
|
|
|
}
|
|
|
|
|
|
|
|
csr = MUSB_RXCSR_FLUSHFIFO | MUSB_RXCSR_CLRDATATOG;
|
|
|
|
if (musb_ep->type == USB_ENDPOINT_XFER_ISOC)
|
|
|
|
csr |= MUSB_RXCSR_P_ISO;
|
|
|
|
else if (musb_ep->type == USB_ENDPOINT_XFER_INT)
|
|
|
|
csr |= MUSB_RXCSR_DISNYET;
|
|
|
|
|
|
|
|
/* set twice in case of double buffering */
|
|
|
|
musb_writew(regs, MUSB_RXCSR, csr);
|
|
|
|
musb_writew(regs, MUSB_RXCSR, csr);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* NOTE: all the I/O code _should_ work fine without DMA, in case
|
|
|
|
* for some reason you run out of channels here.
|
|
|
|
*/
|
|
|
|
if (is_dma_capable() && musb->dma_controller) {
|
|
|
|
struct dma_controller *c = musb->dma_controller;
|
|
|
|
|
|
|
|
musb_ep->dma = c->channel_alloc(c, hw_ep,
|
|
|
|
(desc->bEndpointAddress & USB_DIR_IN));
|
|
|
|
} else
|
|
|
|
musb_ep->dma = NULL;
|
|
|
|
|
|
|
|
musb_ep->desc = desc;
|
|
|
|
musb_ep->busy = 0;
|
2009-11-18 22:51:51 +03:00
|
|
|
musb_ep->wedged = 0;
|
2008-07-24 13:27:36 +04:00
|
|
|
status = 0;
|
|
|
|
|
|
|
|
pr_debug("%s periph: enabled %s for %s %s, %smaxpacket %d\n",
|
|
|
|
musb_driver_name, musb_ep->end_point.name,
|
|
|
|
({ char *s; switch (musb_ep->type) {
|
|
|
|
case USB_ENDPOINT_XFER_BULK: s = "bulk"; break;
|
|
|
|
case USB_ENDPOINT_XFER_INT: s = "int"; break;
|
|
|
|
default: s = "iso"; break;
|
2013-10-09 03:01:37 +04:00
|
|
|
} s; }),
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_ep->is_in ? "IN" : "OUT",
|
|
|
|
musb_ep->dma ? "dma, " : "",
|
|
|
|
musb_ep->packet_sz);
|
|
|
|
|
|
|
|
schedule_work(&musb->irq_work);
|
|
|
|
|
|
|
|
fail:
|
|
|
|
spin_unlock_irqrestore(&musb->lock, flags);
|
|
|
|
return status;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Disable an endpoint flushing all requests queued.
|
|
|
|
*/
|
|
|
|
static int musb_gadget_disable(struct usb_ep *ep)
|
|
|
|
{
|
|
|
|
unsigned long flags;
|
|
|
|
struct musb *musb;
|
|
|
|
u8 epnum;
|
|
|
|
struct musb_ep *musb_ep;
|
|
|
|
void __iomem *epio;
|
|
|
|
int status = 0;
|
|
|
|
|
|
|
|
musb_ep = to_musb_ep(ep);
|
|
|
|
musb = musb_ep->musb;
|
|
|
|
epnum = musb_ep->current_epnum;
|
|
|
|
epio = musb->endpoints[epnum].regs;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&musb->lock, flags);
|
|
|
|
musb_ep_select(musb->mregs, epnum);
|
|
|
|
|
|
|
|
/* zero the endpoint sizes */
|
|
|
|
if (musb_ep->is_in) {
|
2012-10-30 22:52:26 +04:00
|
|
|
musb->intrtxe &= ~(1 << epnum);
|
|
|
|
musb_writew(musb->mregs, MUSB_INTRTXE, musb->intrtxe);
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_writew(epio, MUSB_TXMAXP, 0);
|
|
|
|
} else {
|
2012-10-30 22:52:25 +04:00
|
|
|
musb->intrrxe &= ~(1 << epnum);
|
|
|
|
musb_writew(musb->mregs, MUSB_INTRRXE, musb->intrrxe);
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_writew(epio, MUSB_RXMAXP, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
musb_ep->desc = NULL;
|
2012-05-26 01:21:33 +04:00
|
|
|
musb_ep->end_point.desc = NULL;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* abort all pending DMA and requests */
|
|
|
|
nuke(musb_ep, -ESHUTDOWN);
|
|
|
|
|
|
|
|
schedule_work(&musb->irq_work);
|
|
|
|
|
|
|
|
spin_unlock_irqrestore(&(musb->lock), flags);
|
|
|
|
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s\n", musb_ep->end_point.name);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
return status;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Allocate a request for an endpoint.
|
|
|
|
* Reused by ep0 code.
|
|
|
|
*/
|
|
|
|
struct usb_request *musb_alloc_request(struct usb_ep *ep, gfp_t gfp_flags)
|
|
|
|
{
|
|
|
|
struct musb_ep *musb_ep = to_musb_ep(ep);
|
2011-05-11 13:44:08 +04:00
|
|
|
struct musb *musb = musb_ep->musb;
|
2008-07-24 13:27:36 +04:00
|
|
|
struct musb_request *request = NULL;
|
|
|
|
|
|
|
|
request = kzalloc(sizeof *request, gfp_flags);
|
2010-12-01 12:03:54 +03:00
|
|
|
if (!request) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "not enough memory\n");
|
2010-12-01 12:03:54 +03:00
|
|
|
return NULL;
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
2010-12-01 12:03:54 +03:00
|
|
|
request->request.dma = DMA_ADDR_INVALID;
|
|
|
|
request->epnum = musb_ep->current_epnum;
|
|
|
|
request->ep = musb_ep;
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
return &request->request;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Free a request
|
|
|
|
* Reused by ep0 code.
|
|
|
|
*/
|
|
|
|
void musb_free_request(struct usb_ep *ep, struct usb_request *req)
|
|
|
|
{
|
|
|
|
kfree(to_musb_request(req));
|
|
|
|
}
|
|
|
|
|
|
|
|
static LIST_HEAD(buffers);
|
|
|
|
|
|
|
|
struct free_record {
|
|
|
|
struct list_head list;
|
|
|
|
struct device *dev;
|
|
|
|
unsigned bytes;
|
|
|
|
dma_addr_t dma;
|
|
|
|
};
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Context: controller locked, IRQs blocked.
|
|
|
|
*/
|
2010-09-11 22:23:12 +04:00
|
|
|
void musb_ep_restart(struct musb *musb, struct musb_request *req)
|
2008-07-24 13:27:36 +04:00
|
|
|
{
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "<== %s request %p len %u on hw_ep%d\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
req->tx ? "TX/IN" : "RX/OUT",
|
|
|
|
&req->request, req->request.length, req->epnum);
|
|
|
|
|
|
|
|
musb_ep_select(musb->mregs, req->epnum);
|
|
|
|
if (req->tx)
|
|
|
|
txstate(musb, req);
|
|
|
|
else
|
|
|
|
rxstate(musb, req);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int musb_gadget_queue(struct usb_ep *ep, struct usb_request *req,
|
|
|
|
gfp_t gfp_flags)
|
|
|
|
{
|
|
|
|
struct musb_ep *musb_ep;
|
|
|
|
struct musb_request *request;
|
|
|
|
struct musb *musb;
|
|
|
|
int status = 0;
|
|
|
|
unsigned long lockflags;
|
|
|
|
|
|
|
|
if (!ep || !req)
|
|
|
|
return -EINVAL;
|
|
|
|
if (!req->buf)
|
|
|
|
return -ENODATA;
|
|
|
|
|
|
|
|
musb_ep = to_musb_ep(ep);
|
|
|
|
musb = musb_ep->musb;
|
|
|
|
|
|
|
|
request = to_musb_request(req);
|
|
|
|
request->musb = musb;
|
|
|
|
|
|
|
|
if (request->ep != musb_ep)
|
|
|
|
return -EINVAL;
|
|
|
|
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "<== to %s request=%p\n", ep->name, req);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* request is mine now... */
|
|
|
|
request->request.actual = 0;
|
|
|
|
request->request.status = -EINPROGRESS;
|
|
|
|
request->epnum = musb_ep->current_epnum;
|
|
|
|
request->tx = musb_ep->is_in;
|
|
|
|
|
2011-01-04 14:47:02 +03:00
|
|
|
map_dma_buffer(request, musb, musb_ep);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
spin_lock_irqsave(&musb->lock, lockflags);
|
|
|
|
|
|
|
|
/* don't queue if the ep is down */
|
|
|
|
if (!musb_ep->desc) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "req %p queued to %s while ep %s\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
req, ep->name, "disabled");
|
|
|
|
status = -ESHUTDOWN;
|
2013-06-19 19:38:15 +04:00
|
|
|
unmap_dma_buffer(request, musb);
|
|
|
|
goto unlock;
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
/* add request to the list */
|
2011-02-16 13:40:05 +03:00
|
|
|
list_add_tail(&request->list, &musb_ep->req_list);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* it this is the head of the queue, start i/o ... */
|
2011-02-16 13:40:05 +03:00
|
|
|
if (!musb_ep->busy && &request->list == musb_ep->req_list.next)
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_ep_restart(musb, request);
|
|
|
|
|
2013-06-19 19:38:15 +04:00
|
|
|
unlock:
|
2008-07-24 13:27:36 +04:00
|
|
|
spin_unlock_irqrestore(&musb->lock, lockflags);
|
|
|
|
return status;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int musb_gadget_dequeue(struct usb_ep *ep, struct usb_request *request)
|
|
|
|
{
|
|
|
|
struct musb_ep *musb_ep = to_musb_ep(ep);
|
2011-02-28 11:44:50 +03:00
|
|
|
struct musb_request *req = to_musb_request(request);
|
|
|
|
struct musb_request *r;
|
2008-07-24 13:27:36 +04:00
|
|
|
unsigned long flags;
|
|
|
|
int status = 0;
|
|
|
|
struct musb *musb = musb_ep->musb;
|
|
|
|
|
|
|
|
if (!ep || !request || to_musb_request(request)->ep != musb_ep)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&musb->lock, flags);
|
|
|
|
|
|
|
|
list_for_each_entry(r, &musb_ep->req_list, list) {
|
2011-02-28 11:44:50 +03:00
|
|
|
if (r == req)
|
2008-07-24 13:27:36 +04:00
|
|
|
break;
|
|
|
|
}
|
2011-02-28 11:44:50 +03:00
|
|
|
if (r != req) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "request %p not queued to %s\n", request, ep->name);
|
2008-07-24 13:27:36 +04:00
|
|
|
status = -EINVAL;
|
|
|
|
goto done;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* if the hardware doesn't have the request, easy ... */
|
2011-03-22 12:38:49 +03:00
|
|
|
if (musb_ep->req_list.next != &req->list || musb_ep->busy)
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_g_giveback(musb_ep, request, -ECONNRESET);
|
|
|
|
|
|
|
|
/* ... else abort the dma transfer ... */
|
|
|
|
else if (is_dma_capable() && musb_ep->dma) {
|
|
|
|
struct dma_controller *c = musb->dma_controller;
|
|
|
|
|
|
|
|
musb_ep_select(musb->mregs, musb_ep->current_epnum);
|
|
|
|
if (c->channel_abort)
|
|
|
|
status = c->channel_abort(musb_ep->dma);
|
|
|
|
else
|
|
|
|
status = -EBUSY;
|
|
|
|
if (status == 0)
|
|
|
|
musb_g_giveback(musb_ep, request, -ECONNRESET);
|
|
|
|
} else {
|
|
|
|
/* NOTE: by sticking to easily tested hardware/driver states,
|
|
|
|
* we leave counting of in-flight packets imprecise.
|
|
|
|
*/
|
|
|
|
musb_g_giveback(musb_ep, request, -ECONNRESET);
|
|
|
|
}
|
|
|
|
|
|
|
|
done:
|
|
|
|
spin_unlock_irqrestore(&musb->lock, flags);
|
|
|
|
return status;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Set or clear the halt bit of an endpoint. A halted enpoint won't tx/rx any
|
|
|
|
* data but will queue requests.
|
|
|
|
*
|
|
|
|
* exported to ep0 code
|
|
|
|
*/
|
2009-12-04 16:47:46 +03:00
|
|
|
static int musb_gadget_set_halt(struct usb_ep *ep, int value)
|
2008-07-24 13:27:36 +04:00
|
|
|
{
|
|
|
|
struct musb_ep *musb_ep = to_musb_ep(ep);
|
|
|
|
u8 epnum = musb_ep->current_epnum;
|
|
|
|
struct musb *musb = musb_ep->musb;
|
|
|
|
void __iomem *epio = musb->endpoints[epnum].regs;
|
|
|
|
void __iomem *mbase;
|
|
|
|
unsigned long flags;
|
|
|
|
u16 csr;
|
2009-11-18 22:51:18 +03:00
|
|
|
struct musb_request *request;
|
2008-07-24 13:27:36 +04:00
|
|
|
int status = 0;
|
|
|
|
|
|
|
|
if (!ep)
|
|
|
|
return -EINVAL;
|
|
|
|
mbase = musb->mregs;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&musb->lock, flags);
|
|
|
|
|
|
|
|
if ((USB_ENDPOINT_XFER_ISOC == musb_ep->type)) {
|
|
|
|
status = -EINVAL;
|
|
|
|
goto done;
|
|
|
|
}
|
|
|
|
|
|
|
|
musb_ep_select(mbase, epnum);
|
|
|
|
|
2011-02-16 13:40:05 +03:00
|
|
|
request = next_request(musb_ep);
|
2009-11-18 22:51:18 +03:00
|
|
|
if (value) {
|
|
|
|
if (request) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "request in progress, cannot halt %s\n",
|
2009-11-18 22:51:18 +03:00
|
|
|
ep->name);
|
|
|
|
status = -EAGAIN;
|
|
|
|
goto done;
|
|
|
|
}
|
|
|
|
/* Cannot portably stall with non-empty FIFO */
|
|
|
|
if (musb_ep->is_in) {
|
|
|
|
csr = musb_readw(epio, MUSB_TXCSR);
|
|
|
|
if (csr & MUSB_TXCSR_FIFONOTEMPTY) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "FIFO busy, cannot halt %s\n", ep->name);
|
2009-11-18 22:51:18 +03:00
|
|
|
status = -EAGAIN;
|
|
|
|
goto done;
|
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
2009-11-18 22:51:51 +03:00
|
|
|
} else
|
|
|
|
musb_ep->wedged = 0;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* set/clear the stall and toggle bits */
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "%s: %s stall\n", ep->name, value ? "set" : "clear");
|
2008-07-24 13:27:36 +04:00
|
|
|
if (musb_ep->is_in) {
|
|
|
|
csr = musb_readw(epio, MUSB_TXCSR);
|
|
|
|
csr |= MUSB_TXCSR_P_WZC_BITS
|
|
|
|
| MUSB_TXCSR_CLRDATATOG;
|
|
|
|
if (value)
|
|
|
|
csr |= MUSB_TXCSR_P_SENDSTALL;
|
|
|
|
else
|
|
|
|
csr &= ~(MUSB_TXCSR_P_SENDSTALL
|
|
|
|
| MUSB_TXCSR_P_SENTSTALL);
|
|
|
|
csr &= ~MUSB_TXCSR_TXPKTRDY;
|
|
|
|
musb_writew(epio, MUSB_TXCSR, csr);
|
|
|
|
} else {
|
|
|
|
csr = musb_readw(epio, MUSB_RXCSR);
|
|
|
|
csr |= MUSB_RXCSR_P_WZC_BITS
|
|
|
|
| MUSB_RXCSR_FLUSHFIFO
|
|
|
|
| MUSB_RXCSR_CLRDATATOG;
|
|
|
|
if (value)
|
|
|
|
csr |= MUSB_RXCSR_P_SENDSTALL;
|
|
|
|
else
|
|
|
|
csr &= ~(MUSB_RXCSR_P_SENDSTALL
|
|
|
|
| MUSB_RXCSR_P_SENTSTALL);
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* maybe start the first request in the queue */
|
|
|
|
if (!musb_ep->busy && !value && request) {
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "restarting the request\n");
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_ep_restart(musb, request);
|
|
|
|
}
|
|
|
|
|
2009-11-18 22:51:18 +03:00
|
|
|
done:
|
2008-07-24 13:27:36 +04:00
|
|
|
spin_unlock_irqrestore(&musb->lock, flags);
|
|
|
|
return status;
|
|
|
|
}
|
|
|
|
|
2009-11-18 22:51:51 +03:00
|
|
|
/*
|
|
|
|
* Sets the halt feature with the clear requests ignored
|
|
|
|
*/
|
2009-12-04 16:47:46 +03:00
|
|
|
static int musb_gadget_set_wedge(struct usb_ep *ep)
|
2009-11-18 22:51:51 +03:00
|
|
|
{
|
|
|
|
struct musb_ep *musb_ep = to_musb_ep(ep);
|
|
|
|
|
|
|
|
if (!ep)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
musb_ep->wedged = 1;
|
|
|
|
|
|
|
|
return usb_ep_set_halt(ep);
|
|
|
|
}
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
static int musb_gadget_fifo_status(struct usb_ep *ep)
|
|
|
|
{
|
|
|
|
struct musb_ep *musb_ep = to_musb_ep(ep);
|
|
|
|
void __iomem *epio = musb_ep->hw_ep->regs;
|
|
|
|
int retval = -EINVAL;
|
|
|
|
|
|
|
|
if (musb_ep->desc && !musb_ep->is_in) {
|
|
|
|
struct musb *musb = musb_ep->musb;
|
|
|
|
int epnum = musb_ep->current_epnum;
|
|
|
|
void __iomem *mbase = musb->mregs;
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&musb->lock, flags);
|
|
|
|
|
|
|
|
musb_ep_select(mbase, epnum);
|
|
|
|
/* FIXME return zero unless RXPKTRDY is set */
|
|
|
|
retval = musb_readw(epio, MUSB_RXCOUNT);
|
|
|
|
|
|
|
|
spin_unlock_irqrestore(&musb->lock, flags);
|
|
|
|
}
|
|
|
|
return retval;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void musb_gadget_fifo_flush(struct usb_ep *ep)
|
|
|
|
{
|
|
|
|
struct musb_ep *musb_ep = to_musb_ep(ep);
|
|
|
|
struct musb *musb = musb_ep->musb;
|
|
|
|
u8 epnum = musb_ep->current_epnum;
|
|
|
|
void __iomem *epio = musb->endpoints[epnum].regs;
|
|
|
|
void __iomem *mbase;
|
|
|
|
unsigned long flags;
|
2012-10-30 22:52:26 +04:00
|
|
|
u16 csr;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
mbase = musb->mregs;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&musb->lock, flags);
|
|
|
|
musb_ep_select(mbase, (u8) epnum);
|
|
|
|
|
|
|
|
/* disable interrupts */
|
2012-10-30 22:52:26 +04:00
|
|
|
musb_writew(mbase, MUSB_INTRTXE, musb->intrtxe & ~(1 << epnum));
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
if (musb_ep->is_in) {
|
|
|
|
csr = musb_readw(epio, MUSB_TXCSR);
|
|
|
|
if (csr & MUSB_TXCSR_FIFONOTEMPTY) {
|
|
|
|
csr |= MUSB_TXCSR_FLUSHFIFO | MUSB_TXCSR_P_WZC_BITS;
|
2011-06-08 18:12:02 +04:00
|
|
|
/*
|
|
|
|
* Setting both TXPKTRDY and FLUSHFIFO makes controller
|
|
|
|
* to interrupt current FIFO loading, but not flushing
|
|
|
|
* the already loaded ones.
|
|
|
|
*/
|
|
|
|
csr &= ~MUSB_TXCSR_TXPKTRDY;
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_writew(epio, MUSB_TXCSR, csr);
|
|
|
|
/* REVISIT may be inappropriate w/o FIFONOTEMPTY ... */
|
|
|
|
musb_writew(epio, MUSB_TXCSR, csr);
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
csr = musb_readw(epio, MUSB_RXCSR);
|
|
|
|
csr |= MUSB_RXCSR_FLUSHFIFO | MUSB_RXCSR_P_WZC_BITS;
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
musb_writew(epio, MUSB_RXCSR, csr);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* re-enable interrupt */
|
2012-10-30 22:52:26 +04:00
|
|
|
musb_writew(mbase, MUSB_INTRTXE, musb->intrtxe);
|
2008-07-24 13:27:36 +04:00
|
|
|
spin_unlock_irqrestore(&musb->lock, flags);
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct usb_ep_ops musb_ep_ops = {
|
|
|
|
.enable = musb_gadget_enable,
|
|
|
|
.disable = musb_gadget_disable,
|
|
|
|
.alloc_request = musb_alloc_request,
|
|
|
|
.free_request = musb_free_request,
|
|
|
|
.queue = musb_gadget_queue,
|
|
|
|
.dequeue = musb_gadget_dequeue,
|
|
|
|
.set_halt = musb_gadget_set_halt,
|
2009-11-18 22:51:51 +03:00
|
|
|
.set_wedge = musb_gadget_set_wedge,
|
2008-07-24 13:27:36 +04:00
|
|
|
.fifo_status = musb_gadget_fifo_status,
|
|
|
|
.fifo_flush = musb_gadget_fifo_flush
|
|
|
|
};
|
|
|
|
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
|
|
|
|
static int musb_gadget_get_frame(struct usb_gadget *gadget)
|
|
|
|
{
|
|
|
|
struct musb *musb = gadget_to_musb(gadget);
|
|
|
|
|
|
|
|
return (int)musb_readw(musb->mregs, MUSB_FRAME);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int musb_gadget_wakeup(struct usb_gadget *gadget)
|
|
|
|
{
|
|
|
|
struct musb *musb = gadget_to_musb(gadget);
|
|
|
|
void __iomem *mregs = musb->mregs;
|
|
|
|
unsigned long flags;
|
|
|
|
int status = -EINVAL;
|
|
|
|
u8 power, devctl;
|
|
|
|
int retries;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&musb->lock, flags);
|
|
|
|
|
2009-03-31 23:30:04 +04:00
|
|
|
switch (musb->xceiv->state) {
|
2008-07-24 13:27:36 +04:00
|
|
|
case OTG_STATE_B_PERIPHERAL:
|
|
|
|
/* NOTE: OTG state machine doesn't include B_SUSPENDED;
|
|
|
|
* that's part of the standard usb 1.1 state machine, and
|
|
|
|
* doesn't affect OTG transitions.
|
|
|
|
*/
|
|
|
|
if (musb->may_wakeup && musb->is_suspended)
|
|
|
|
break;
|
|
|
|
goto done;
|
|
|
|
case OTG_STATE_B_IDLE:
|
|
|
|
/* Start SRP ... OTG not required. */
|
|
|
|
devctl = musb_readb(mregs, MUSB_DEVCTL);
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "Sending SRP: devctl: %02x\n", devctl);
|
2008-07-24 13:27:36 +04:00
|
|
|
devctl |= MUSB_DEVCTL_SESSION;
|
|
|
|
musb_writeb(mregs, MUSB_DEVCTL, devctl);
|
|
|
|
devctl = musb_readb(mregs, MUSB_DEVCTL);
|
|
|
|
retries = 100;
|
|
|
|
while (!(devctl & MUSB_DEVCTL_SESSION)) {
|
|
|
|
devctl = musb_readb(mregs, MUSB_DEVCTL);
|
|
|
|
if (retries-- < 1)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
retries = 10000;
|
|
|
|
while (devctl & MUSB_DEVCTL_SESSION) {
|
|
|
|
devctl = musb_readb(mregs, MUSB_DEVCTL);
|
|
|
|
if (retries-- < 1)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2011-03-22 14:24:22 +03:00
|
|
|
spin_unlock_irqrestore(&musb->lock, flags);
|
2012-02-13 15:24:20 +04:00
|
|
|
otg_start_srp(musb->xceiv->otg);
|
2011-03-22 14:24:22 +03:00
|
|
|
spin_lock_irqsave(&musb->lock, flags);
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
/* Block idling for at least 1s */
|
|
|
|
musb_platform_try_idle(musb,
|
|
|
|
jiffies + msecs_to_jiffies(1 * HZ));
|
|
|
|
|
|
|
|
status = 0;
|
|
|
|
goto done;
|
|
|
|
default:
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "Unhandled wake: %s\n",
|
2013-03-07 12:39:57 +04:00
|
|
|
usb_otg_state_string(musb->xceiv->state));
|
2008-07-24 13:27:36 +04:00
|
|
|
goto done;
|
|
|
|
}
|
|
|
|
|
|
|
|
status = 0;
|
|
|
|
|
|
|
|
power = musb_readb(mregs, MUSB_POWER);
|
|
|
|
power |= MUSB_POWER_RESUME;
|
|
|
|
musb_writeb(mregs, MUSB_POWER, power);
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "issue wakeup\n");
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* FIXME do this next chunk in a timer callback, no udelay */
|
|
|
|
mdelay(2);
|
|
|
|
|
|
|
|
power = musb_readb(mregs, MUSB_POWER);
|
|
|
|
power &= ~MUSB_POWER_RESUME;
|
|
|
|
musb_writeb(mregs, MUSB_POWER, power);
|
|
|
|
done:
|
|
|
|
spin_unlock_irqrestore(&musb->lock, flags);
|
|
|
|
return status;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
|
|
|
musb_gadget_set_self_powered(struct usb_gadget *gadget, int is_selfpowered)
|
|
|
|
{
|
|
|
|
struct musb *musb = gadget_to_musb(gadget);
|
|
|
|
|
|
|
|
musb->is_self_powered = !!is_selfpowered;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void musb_pullup(struct musb *musb, int is_on)
|
|
|
|
{
|
|
|
|
u8 power;
|
|
|
|
|
|
|
|
power = musb_readb(musb->mregs, MUSB_POWER);
|
|
|
|
if (is_on)
|
|
|
|
power |= MUSB_POWER_SOFTCONN;
|
|
|
|
else
|
|
|
|
power &= ~MUSB_POWER_SOFTCONN;
|
|
|
|
|
|
|
|
/* FIXME if on, HdrcStart; if off, HdrcStop */
|
|
|
|
|
2011-06-23 16:26:16 +04:00
|
|
|
dev_dbg(musb->controller, "gadget D+ pullup %s\n",
|
|
|
|
is_on ? "on" : "off");
|
2008-07-24 13:27:36 +04:00
|
|
|
musb_writeb(musb->mregs, MUSB_POWER, power);
|
|
|
|
}
|
|
|
|
|
|
|
|
#if 0
|
|
|
|
static int musb_gadget_vbus_session(struct usb_gadget *gadget, int is_active)
|
|
|
|
{
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "<= %s =>\n", __func__);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/*
|
|
|
|
* FIXME iff driver's softconnect flag is set (as it is during probe,
|
|
|
|
* though that can clear it), just musb_pullup().
|
|
|
|
*/
|
|
|
|
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
static int musb_gadget_vbus_draw(struct usb_gadget *gadget, unsigned mA)
|
|
|
|
{
|
|
|
|
struct musb *musb = gadget_to_musb(gadget);
|
|
|
|
|
2009-03-31 23:30:04 +04:00
|
|
|
if (!musb->xceiv->set_power)
|
2008-07-24 13:27:36 +04:00
|
|
|
return -EOPNOTSUPP;
|
2012-02-13 15:24:18 +04:00
|
|
|
return usb_phy_set_power(musb->xceiv, mA);
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
static int musb_gadget_pullup(struct usb_gadget *gadget, int is_on)
|
|
|
|
{
|
|
|
|
struct musb *musb = gadget_to_musb(gadget);
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
is_on = !!is_on;
|
|
|
|
|
2011-07-21 04:09:34 +04:00
|
|
|
pm_runtime_get_sync(musb->controller);
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
/* NOTE: this assumes we are sensing vbus; we'd rather
|
|
|
|
* not pullup unless the B-session is active.
|
|
|
|
*/
|
|
|
|
spin_lock_irqsave(&musb->lock, flags);
|
|
|
|
if (is_on != musb->softconnect) {
|
|
|
|
musb->softconnect = is_on;
|
|
|
|
musb_pullup(musb, is_on);
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore(&musb->lock, flags);
|
2011-07-21 04:09:34 +04:00
|
|
|
|
|
|
|
pm_runtime_put(musb->controller);
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2011-06-23 16:26:16 +04:00
|
|
|
static int musb_gadget_start(struct usb_gadget *g,
|
|
|
|
struct usb_gadget_driver *driver);
|
|
|
|
static int musb_gadget_stop(struct usb_gadget *g,
|
|
|
|
struct usb_gadget_driver *driver);
|
2011-06-28 17:33:47 +04:00
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
static const struct usb_gadget_ops musb_gadget_operations = {
|
|
|
|
.get_frame = musb_gadget_get_frame,
|
|
|
|
.wakeup = musb_gadget_wakeup,
|
|
|
|
.set_selfpowered = musb_gadget_set_self_powered,
|
|
|
|
/* .vbus_session = musb_gadget_vbus_session, */
|
|
|
|
.vbus_draw = musb_gadget_vbus_draw,
|
|
|
|
.pullup = musb_gadget_pullup,
|
2011-06-23 16:26:16 +04:00
|
|
|
.udc_start = musb_gadget_start,
|
|
|
|
.udc_stop = musb_gadget_stop,
|
2008-07-24 13:27:36 +04:00
|
|
|
};
|
|
|
|
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
|
|
|
|
/* Registration */
|
|
|
|
|
|
|
|
/* Only this registration code "knows" the rule (from USB standards)
|
|
|
|
* about there being only one external upstream port. It assumes
|
|
|
|
* all peripheral ports are external...
|
|
|
|
*/
|
|
|
|
|
2012-11-19 22:21:48 +04:00
|
|
|
static void
|
2008-07-24 13:27:36 +04:00
|
|
|
init_peripheral_ep(struct musb *musb, struct musb_ep *ep, u8 epnum, int is_in)
|
|
|
|
{
|
|
|
|
struct musb_hw_ep *hw_ep = musb->endpoints + epnum;
|
|
|
|
|
|
|
|
memset(ep, 0, sizeof *ep);
|
|
|
|
|
|
|
|
ep->current_epnum = epnum;
|
|
|
|
ep->musb = musb;
|
|
|
|
ep->hw_ep = hw_ep;
|
|
|
|
ep->is_in = is_in;
|
|
|
|
|
|
|
|
INIT_LIST_HEAD(&ep->req_list);
|
|
|
|
|
|
|
|
sprintf(ep->name, "ep%d%s", epnum,
|
|
|
|
(!epnum || hw_ep->is_shared_fifo) ? "" : (
|
|
|
|
is_in ? "in" : "out"));
|
|
|
|
ep->end_point.name = ep->name;
|
|
|
|
INIT_LIST_HEAD(&ep->end_point.ep_list);
|
|
|
|
if (!epnum) {
|
|
|
|
ep->end_point.maxpacket = 64;
|
|
|
|
ep->end_point.ops = &musb_g_ep0_ops;
|
|
|
|
musb->g.ep0 = &ep->end_point;
|
|
|
|
} else {
|
|
|
|
if (is_in)
|
|
|
|
ep->end_point.maxpacket = hw_ep->max_packet_sz_tx;
|
|
|
|
else
|
|
|
|
ep->end_point.maxpacket = hw_ep->max_packet_sz_rx;
|
|
|
|
ep->end_point.ops = &musb_ep_ops;
|
|
|
|
list_add_tail(&ep->end_point.ep_list, &musb->g.ep_list);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Initialize the endpoints exposed to peripheral drivers, with backlinks
|
|
|
|
* to the rest of the driver state.
|
|
|
|
*/
|
2012-11-19 22:21:48 +04:00
|
|
|
static inline void musb_g_init_endpoints(struct musb *musb)
|
2008-07-24 13:27:36 +04:00
|
|
|
{
|
|
|
|
u8 epnum;
|
|
|
|
struct musb_hw_ep *hw_ep;
|
|
|
|
unsigned count = 0;
|
|
|
|
|
tree-wide: fix comment/printk typos
"gadget", "through", "command", "maintain", "maintain", "controller", "address",
"between", "initiali[zs]e", "instead", "function", "select", "already",
"equal", "access", "management", "hierarchy", "registration", "interest",
"relative", "memory", "offset", "already",
Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de>
Signed-off-by: Jiri Kosina <jkosina@suse.cz>
2010-11-01 22:38:34 +03:00
|
|
|
/* initialize endpoint list just once */
|
2008-07-24 13:27:36 +04:00
|
|
|
INIT_LIST_HEAD(&(musb->g.ep_list));
|
|
|
|
|
|
|
|
for (epnum = 0, hw_ep = musb->endpoints;
|
|
|
|
epnum < musb->nr_endpoints;
|
|
|
|
epnum++, hw_ep++) {
|
|
|
|
if (hw_ep->is_shared_fifo /* || !epnum */) {
|
|
|
|
init_peripheral_ep(musb, &hw_ep->ep_in, epnum, 0);
|
|
|
|
count++;
|
|
|
|
} else {
|
|
|
|
if (hw_ep->max_packet_sz_tx) {
|
|
|
|
init_peripheral_ep(musb, &hw_ep->ep_in,
|
|
|
|
epnum, 1);
|
|
|
|
count++;
|
|
|
|
}
|
|
|
|
if (hw_ep->max_packet_sz_rx) {
|
|
|
|
init_peripheral_ep(musb, &hw_ep->ep_out,
|
|
|
|
epnum, 0);
|
|
|
|
count++;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* called once during driver setup to initialize and link into
|
|
|
|
* the driver model; memory is zeroed.
|
|
|
|
*/
|
2012-11-19 22:21:48 +04:00
|
|
|
int musb_gadget_setup(struct musb *musb)
|
2008-07-24 13:27:36 +04:00
|
|
|
{
|
|
|
|
int status;
|
|
|
|
|
|
|
|
/* REVISIT minor race: if (erroneously) setting up two
|
|
|
|
* musb peripherals at the same time, only the bus lock
|
|
|
|
* is probably held.
|
|
|
|
*/
|
|
|
|
|
|
|
|
musb->g.ops = &musb_gadget_operations;
|
2011-11-19 21:27:37 +04:00
|
|
|
musb->g.max_speed = USB_SPEED_HIGH;
|
2008-07-24 13:27:36 +04:00
|
|
|
musb->g.speed = USB_SPEED_UNKNOWN;
|
|
|
|
|
2013-09-17 21:43:13 +04:00
|
|
|
MUSB_DEV_MODE(musb);
|
|
|
|
musb->xceiv->otg->default_a = 0;
|
|
|
|
musb->xceiv->state = OTG_STATE_B_IDLE;
|
|
|
|
|
2008-07-24 13:27:36 +04:00
|
|
|
/* this "gadget" abstracts/virtualizes the controller */
|
|
|
|
musb->g.name = musb_driver_name;
|
2011-11-24 17:46:26 +04:00
|
|
|
musb->g.is_otg = 1;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
musb_g_init_endpoints(musb);
|
|
|
|
|
|
|
|
musb->is_active = 0;
|
|
|
|
musb_platform_try_idle(musb, 0);
|
|
|
|
|
2011-06-28 17:33:47 +04:00
|
|
|
status = usb_add_gadget_udc(musb->controller, &musb->g);
|
|
|
|
if (status)
|
|
|
|
goto err;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
err:
|
2011-08-10 13:01:57 +04:00
|
|
|
musb->g.dev.parent = NULL;
|
2011-06-28 17:33:47 +04:00
|
|
|
device_unregister(&musb->g.dev);
|
2008-07-24 13:27:36 +04:00
|
|
|
return status;
|
|
|
|
}
|
|
|
|
|
|
|
|
void musb_gadget_cleanup(struct musb *musb)
|
|
|
|
{
|
2013-08-20 20:35:44 +04:00
|
|
|
if (musb->port_mode == MUSB_PORT_MODE_HOST)
|
|
|
|
return;
|
2011-06-28 17:33:47 +04:00
|
|
|
usb_del_gadget_udc(&musb->g);
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Register the gadget driver. Used by gadget drivers when
|
|
|
|
* registering themselves with the controller.
|
|
|
|
*
|
|
|
|
* -EINVAL something went wrong (not driver)
|
|
|
|
* -EBUSY another gadget is already using the controller
|
tree-wide: fix comment/printk typos
"gadget", "through", "command", "maintain", "maintain", "controller", "address",
"between", "initiali[zs]e", "instead", "function", "select", "already",
"equal", "access", "management", "hierarchy", "registration", "interest",
"relative", "memory", "offset", "already",
Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de>
Signed-off-by: Jiri Kosina <jkosina@suse.cz>
2010-11-01 22:38:34 +03:00
|
|
|
* -ENOMEM no memory to perform the operation
|
2008-07-24 13:27:36 +04:00
|
|
|
*
|
|
|
|
* @param driver the gadget driver
|
|
|
|
* @return <0 if error, 0 if everything is fine
|
|
|
|
*/
|
2011-06-23 16:26:16 +04:00
|
|
|
static int musb_gadget_start(struct usb_gadget *g,
|
|
|
|
struct usb_gadget_driver *driver)
|
2008-07-24 13:27:36 +04:00
|
|
|
{
|
2011-06-23 16:26:16 +04:00
|
|
|
struct musb *musb = gadget_to_musb(g);
|
2012-02-13 15:24:15 +04:00
|
|
|
struct usb_otg *otg = musb->xceiv->otg;
|
2011-01-17 11:34:38 +03:00
|
|
|
unsigned long flags;
|
2011-11-24 17:46:26 +04:00
|
|
|
int retval = 0;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2011-11-24 17:46:26 +04:00
|
|
|
if (driver->max_speed < USB_SPEED_HIGH) {
|
|
|
|
retval = -EINVAL;
|
|
|
|
goto err;
|
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
|
usb: musb: Idle path retention and offmode support for OMAP3
This patch supports the retention and offmode support in the idle path for
musb driver using runtime pm APIs.
This is restricted to support offmode and retention only when device not
connected.When device/cable connected with gadget driver loaded,configured
to no idle/standby which will not allow the core transition to retention
or off.
There is no context save/restore done by hardware for musb in OMAP3
and OMAP4,driver has to take care of saving and restoring the context
during offmode.
Musb has a requirement of configuring sysconfig register to force
idle/standby mode and set the ENFORCE bit in module STANDBY register
for retention and offmode support.
Runtime pm and hwmod frameworks will take care of configuring to force
idle/standby when pm_runtime_put_sync is called and back to no
idle/standby when pm_runeime_get_sync is called.
Compile, boot tested and also tested the retention in the idle path on
OMAP3630Zoom3. And tested the global suspend/resume with offmode enabled.
Usb basic functionality tested on OMAP4430SDP.
There is some problem with idle path offmode in mainline, I could not test
with offmode. But I have tested this patch with resetting the controller
in the idle path when wakeup from retention just to make sure that the
context is lost, and restore path is working fine.
Removed .suspend/.resume fnction pointers and functions because there
is no need of having these functions as all required work is done
at runtime in the driver.
There is no need to call the runtime pm api with glue driver device
as glue layer device is the parent of musb core device, when runtime apis
are called for the child, parent device runtime functionality
will be invoked.
Design overview:
pm_runtime_get_sync: When called with musb core device takes care of
enabling the clock, calling runtime callback function of omap2430 glue
layer, runtime call back of musb driver and configure the musb sysconfig
to no idle/standby
pm_runtime_put: Takes care of calling runtime callback function of omap2430
glue layer, runtime call back of musb driver, Configure the musb sysconfig
to force idle/standby and disable the clock.
During musb driver load: Call pm_runtime_get_sync.
End of musb driver load: Call pm_runtime_put
During gadget driver load: Call pm_runtime_get_sync,
End of gadget driver load: Call pm_runtime_put if there is no device
or cable is connected.
During unload of the gadget driver:Call pm_runtime_get_sync if cable/device
is not connected.
End of the gadget driver unload : pm_runtime_put
During unload of musb driver : Call pm_runtime_get_sync
End of unload: Call pm_runtime_put
On connect of usb cable/device -> transceiver notification(VBUS and ID-GND):
pm_runtime_get_sync only if the gadget driver loaded.
On disconnect of the cable/device -> Disconnect Notification:
pm_runtime_put if the gadget driver is loaded.
Signed-off-by: Hema HK <hemahk@ti.com>
Signed-off-by: Felipe Balbi <balbi@ti.com>
2011-02-28 11:49:34 +03:00
|
|
|
pm_runtime_get_sync(musb->controller);
|
|
|
|
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "registering driver %s\n", driver->function);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2011-06-23 16:26:16 +04:00
|
|
|
musb->softconnect = 0;
|
2011-01-17 11:34:38 +03:00
|
|
|
musb->gadget_driver = driver;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2011-01-17 11:34:38 +03:00
|
|
|
spin_lock_irqsave(&musb->lock, flags);
|
2013-10-15 00:06:15 +04:00
|
|
|
musb->is_active = 1;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2012-02-13 15:24:20 +04:00
|
|
|
otg_set_peripheral(otg, &musb->g);
|
2011-01-17 11:34:38 +03:00
|
|
|
musb->xceiv->state = OTG_STATE_B_IDLE;
|
|
|
|
spin_unlock_irqrestore(&musb->lock, flags);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2013-10-11 12:38:13 +04:00
|
|
|
musb_start(musb);
|
|
|
|
|
2011-11-24 17:46:26 +04:00
|
|
|
/* REVISIT: funcall to other code, which also
|
|
|
|
* handles power budgeting ... this way also
|
|
|
|
* ensures HdrcStart is indirectly called.
|
|
|
|
*/
|
2013-03-24 19:36:55 +04:00
|
|
|
if (musb->xceiv->last_event == USB_EVENT_ID)
|
|
|
|
musb_platform_set_vbus(musb, 1);
|
2011-01-17 11:34:38 +03:00
|
|
|
|
2011-04-29 17:17:35 +04:00
|
|
|
if (musb->xceiv->last_event == USB_EVENT_NONE)
|
|
|
|
pm_runtime_put(musb->controller);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2011-01-17 11:34:38 +03:00
|
|
|
return 0;
|
|
|
|
|
2011-11-24 17:46:26 +04:00
|
|
|
err:
|
2008-07-24 13:27:36 +04:00
|
|
|
return retval;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void stop_activity(struct musb *musb, struct usb_gadget_driver *driver)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
struct musb_hw_ep *hw_ep;
|
|
|
|
|
|
|
|
/* don't disconnect if it's not connected */
|
|
|
|
if (musb->g.speed == USB_SPEED_UNKNOWN)
|
|
|
|
driver = NULL;
|
|
|
|
else
|
|
|
|
musb->g.speed = USB_SPEED_UNKNOWN;
|
|
|
|
|
|
|
|
/* deactivate the hardware */
|
|
|
|
if (musb->softconnect) {
|
|
|
|
musb->softconnect = 0;
|
|
|
|
musb_pullup(musb, 0);
|
|
|
|
}
|
|
|
|
musb_stop(musb);
|
|
|
|
|
|
|
|
/* killing any outstanding requests will quiesce the driver;
|
|
|
|
* then report disconnect
|
|
|
|
*/
|
|
|
|
if (driver) {
|
|
|
|
for (i = 0, hw_ep = musb->endpoints;
|
|
|
|
i < musb->nr_endpoints;
|
|
|
|
i++, hw_ep++) {
|
|
|
|
musb_ep_select(musb->mregs, i);
|
|
|
|
if (hw_ep->is_shared_fifo /* || !epnum */) {
|
|
|
|
nuke(&hw_ep->ep_in, -ESHUTDOWN);
|
|
|
|
} else {
|
|
|
|
if (hw_ep->max_packet_sz_tx)
|
|
|
|
nuke(&hw_ep->ep_in, -ESHUTDOWN);
|
|
|
|
if (hw_ep->max_packet_sz_rx)
|
|
|
|
nuke(&hw_ep->ep_out, -ESHUTDOWN);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Unregister the gadget driver. Used by gadget drivers when
|
|
|
|
* unregistering themselves from the controller.
|
|
|
|
*
|
|
|
|
* @param driver the gadget driver to unregister
|
|
|
|
*/
|
2011-06-23 16:26:16 +04:00
|
|
|
static int musb_gadget_stop(struct usb_gadget *g,
|
|
|
|
struct usb_gadget_driver *driver)
|
2008-07-24 13:27:36 +04:00
|
|
|
{
|
2011-06-23 16:26:16 +04:00
|
|
|
struct musb *musb = gadget_to_musb(g);
|
2011-01-17 11:34:38 +03:00
|
|
|
unsigned long flags;
|
2008-07-24 13:27:36 +04:00
|
|
|
|
usb: musb: Idle path retention and offmode support for OMAP3
This patch supports the retention and offmode support in the idle path for
musb driver using runtime pm APIs.
This is restricted to support offmode and retention only when device not
connected.When device/cable connected with gadget driver loaded,configured
to no idle/standby which will not allow the core transition to retention
or off.
There is no context save/restore done by hardware for musb in OMAP3
and OMAP4,driver has to take care of saving and restoring the context
during offmode.
Musb has a requirement of configuring sysconfig register to force
idle/standby mode and set the ENFORCE bit in module STANDBY register
for retention and offmode support.
Runtime pm and hwmod frameworks will take care of configuring to force
idle/standby when pm_runtime_put_sync is called and back to no
idle/standby when pm_runeime_get_sync is called.
Compile, boot tested and also tested the retention in the idle path on
OMAP3630Zoom3. And tested the global suspend/resume with offmode enabled.
Usb basic functionality tested on OMAP4430SDP.
There is some problem with idle path offmode in mainline, I could not test
with offmode. But I have tested this patch with resetting the controller
in the idle path when wakeup from retention just to make sure that the
context is lost, and restore path is working fine.
Removed .suspend/.resume fnction pointers and functions because there
is no need of having these functions as all required work is done
at runtime in the driver.
There is no need to call the runtime pm api with glue driver device
as glue layer device is the parent of musb core device, when runtime apis
are called for the child, parent device runtime functionality
will be invoked.
Design overview:
pm_runtime_get_sync: When called with musb core device takes care of
enabling the clock, calling runtime callback function of omap2430 glue
layer, runtime call back of musb driver and configure the musb sysconfig
to no idle/standby
pm_runtime_put: Takes care of calling runtime callback function of omap2430
glue layer, runtime call back of musb driver, Configure the musb sysconfig
to force idle/standby and disable the clock.
During musb driver load: Call pm_runtime_get_sync.
End of musb driver load: Call pm_runtime_put
During gadget driver load: Call pm_runtime_get_sync,
End of gadget driver load: Call pm_runtime_put if there is no device
or cable is connected.
During unload of the gadget driver:Call pm_runtime_get_sync if cable/device
is not connected.
End of the gadget driver unload : pm_runtime_put
During unload of musb driver : Call pm_runtime_get_sync
End of unload: Call pm_runtime_put
On connect of usb cable/device -> transceiver notification(VBUS and ID-GND):
pm_runtime_get_sync only if the gadget driver loaded.
On disconnect of the cable/device -> Disconnect Notification:
pm_runtime_put if the gadget driver is loaded.
Signed-off-by: Hema HK <hemahk@ti.com>
Signed-off-by: Felipe Balbi <balbi@ti.com>
2011-02-28 11:49:34 +03:00
|
|
|
if (musb->xceiv->last_event == USB_EVENT_NONE)
|
|
|
|
pm_runtime_get_sync(musb->controller);
|
|
|
|
|
2011-01-17 11:34:38 +03:00
|
|
|
/*
|
|
|
|
* REVISIT always use otg_set_peripheral() here too;
|
2008-07-24 13:27:36 +04:00
|
|
|
* this needs to shut down the OTG engine.
|
|
|
|
*/
|
|
|
|
|
|
|
|
spin_lock_irqsave(&musb->lock, flags);
|
|
|
|
|
|
|
|
musb_hnp_stop(musb);
|
|
|
|
|
2011-01-17 11:34:38 +03:00
|
|
|
(void) musb_gadget_vbus_draw(&musb->g, 0);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2011-01-17 11:34:38 +03:00
|
|
|
musb->xceiv->state = OTG_STATE_UNDEFINED;
|
|
|
|
stop_activity(musb, driver);
|
2012-02-13 15:24:20 +04:00
|
|
|
otg_set_peripheral(musb->xceiv->otg, NULL);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2013-08-19 10:24:08 +04:00
|
|
|
dev_dbg(musb->controller, "unregistering driver %s\n",
|
|
|
|
driver ? driver->function : "(removed)");
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2011-01-17 11:34:38 +03:00
|
|
|
musb->is_active = 0;
|
2013-03-10 04:49:14 +04:00
|
|
|
musb->gadget_driver = NULL;
|
2011-01-17 11:34:38 +03:00
|
|
|
musb_platform_try_idle(musb, 0);
|
2008-07-24 13:27:36 +04:00
|
|
|
spin_unlock_irqrestore(&musb->lock, flags);
|
|
|
|
|
2011-11-24 17:46:26 +04:00
|
|
|
/*
|
|
|
|
* FIXME we need to be able to register another
|
|
|
|
* gadget driver here and have everything work;
|
|
|
|
* that currently misbehaves.
|
|
|
|
*/
|
2011-01-17 11:34:38 +03:00
|
|
|
|
usb: musb: Idle path retention and offmode support for OMAP3
This patch supports the retention and offmode support in the idle path for
musb driver using runtime pm APIs.
This is restricted to support offmode and retention only when device not
connected.When device/cable connected with gadget driver loaded,configured
to no idle/standby which will not allow the core transition to retention
or off.
There is no context save/restore done by hardware for musb in OMAP3
and OMAP4,driver has to take care of saving and restoring the context
during offmode.
Musb has a requirement of configuring sysconfig register to force
idle/standby mode and set the ENFORCE bit in module STANDBY register
for retention and offmode support.
Runtime pm and hwmod frameworks will take care of configuring to force
idle/standby when pm_runtime_put_sync is called and back to no
idle/standby when pm_runeime_get_sync is called.
Compile, boot tested and also tested the retention in the idle path on
OMAP3630Zoom3. And tested the global suspend/resume with offmode enabled.
Usb basic functionality tested on OMAP4430SDP.
There is some problem with idle path offmode in mainline, I could not test
with offmode. But I have tested this patch with resetting the controller
in the idle path when wakeup from retention just to make sure that the
context is lost, and restore path is working fine.
Removed .suspend/.resume fnction pointers and functions because there
is no need of having these functions as all required work is done
at runtime in the driver.
There is no need to call the runtime pm api with glue driver device
as glue layer device is the parent of musb core device, when runtime apis
are called for the child, parent device runtime functionality
will be invoked.
Design overview:
pm_runtime_get_sync: When called with musb core device takes care of
enabling the clock, calling runtime callback function of omap2430 glue
layer, runtime call back of musb driver and configure the musb sysconfig
to no idle/standby
pm_runtime_put: Takes care of calling runtime callback function of omap2430
glue layer, runtime call back of musb driver, Configure the musb sysconfig
to force idle/standby and disable the clock.
During musb driver load: Call pm_runtime_get_sync.
End of musb driver load: Call pm_runtime_put
During gadget driver load: Call pm_runtime_get_sync,
End of gadget driver load: Call pm_runtime_put if there is no device
or cable is connected.
During unload of the gadget driver:Call pm_runtime_get_sync if cable/device
is not connected.
End of the gadget driver unload : pm_runtime_put
During unload of musb driver : Call pm_runtime_get_sync
End of unload: Call pm_runtime_put
On connect of usb cable/device -> transceiver notification(VBUS and ID-GND):
pm_runtime_get_sync only if the gadget driver loaded.
On disconnect of the cable/device -> Disconnect Notification:
pm_runtime_put if the gadget driver is loaded.
Signed-off-by: Hema HK <hemahk@ti.com>
Signed-off-by: Felipe Balbi <balbi@ti.com>
2011-02-28 11:49:34 +03:00
|
|
|
pm_runtime_put(musb->controller);
|
|
|
|
|
2011-01-17 11:34:38 +03:00
|
|
|
return 0;
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
|
|
|
|
/* lifecycle operations called through plat_uds.c */
|
|
|
|
|
|
|
|
void musb_g_resume(struct musb *musb)
|
|
|
|
{
|
|
|
|
musb->is_suspended = 0;
|
2009-03-31 23:30:04 +04:00
|
|
|
switch (musb->xceiv->state) {
|
2008-07-24 13:27:36 +04:00
|
|
|
case OTG_STATE_B_IDLE:
|
|
|
|
break;
|
|
|
|
case OTG_STATE_B_WAIT_ACON:
|
|
|
|
case OTG_STATE_B_PERIPHERAL:
|
|
|
|
musb->is_active = 1;
|
|
|
|
if (musb->gadget_driver && musb->gadget_driver->resume) {
|
|
|
|
spin_unlock(&musb->lock);
|
|
|
|
musb->gadget_driver->resume(&musb->g);
|
|
|
|
spin_lock(&musb->lock);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
WARNING("unhandled RESUME transition (%s)\n",
|
2013-03-07 12:39:57 +04:00
|
|
|
usb_otg_state_string(musb->xceiv->state));
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* called when SOF packets stop for 3+ msec */
|
|
|
|
void musb_g_suspend(struct musb *musb)
|
|
|
|
{
|
|
|
|
u8 devctl;
|
|
|
|
|
|
|
|
devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "devctl %02x\n", devctl);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
2009-03-31 23:30:04 +04:00
|
|
|
switch (musb->xceiv->state) {
|
2008-07-24 13:27:36 +04:00
|
|
|
case OTG_STATE_B_IDLE:
|
|
|
|
if ((devctl & MUSB_DEVCTL_VBUS) == MUSB_DEVCTL_VBUS)
|
2009-03-31 23:30:04 +04:00
|
|
|
musb->xceiv->state = OTG_STATE_B_PERIPHERAL;
|
2008-07-24 13:27:36 +04:00
|
|
|
break;
|
|
|
|
case OTG_STATE_B_PERIPHERAL:
|
|
|
|
musb->is_suspended = 1;
|
|
|
|
if (musb->gadget_driver && musb->gadget_driver->suspend) {
|
|
|
|
spin_unlock(&musb->lock);
|
|
|
|
musb->gadget_driver->suspend(&musb->g);
|
|
|
|
spin_lock(&musb->lock);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
/* REVISIT if B_HOST, clear DEVCTL.HOSTREQ;
|
|
|
|
* A_PERIPHERAL may need care too
|
|
|
|
*/
|
|
|
|
WARNING("unhandled SUSPEND transition (%s)\n",
|
2013-03-07 12:39:57 +04:00
|
|
|
usb_otg_state_string(musb->xceiv->state));
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Called during SRP */
|
|
|
|
void musb_g_wakeup(struct musb *musb)
|
|
|
|
{
|
|
|
|
musb_gadget_wakeup(&musb->g);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* called when VBUS drops below session threshold, and in other cases */
|
|
|
|
void musb_g_disconnect(struct musb *musb)
|
|
|
|
{
|
|
|
|
void __iomem *mregs = musb->mregs;
|
|
|
|
u8 devctl = musb_readb(mregs, MUSB_DEVCTL);
|
|
|
|
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "devctl %02x\n", devctl);
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* clear HR */
|
|
|
|
musb_writeb(mregs, MUSB_DEVCTL, devctl & MUSB_DEVCTL_SESSION);
|
|
|
|
|
|
|
|
/* don't draw vbus until new b-default session */
|
|
|
|
(void) musb_gadget_vbus_draw(&musb->g, 0);
|
|
|
|
|
|
|
|
musb->g.speed = USB_SPEED_UNKNOWN;
|
|
|
|
if (musb->gadget_driver && musb->gadget_driver->disconnect) {
|
|
|
|
spin_unlock(&musb->lock);
|
|
|
|
musb->gadget_driver->disconnect(&musb->g);
|
|
|
|
spin_lock(&musb->lock);
|
|
|
|
}
|
|
|
|
|
2009-03-31 23:30:04 +04:00
|
|
|
switch (musb->xceiv->state) {
|
2008-07-24 13:27:36 +04:00
|
|
|
default:
|
2011-05-11 13:44:08 +04:00
|
|
|
dev_dbg(musb->controller, "Unhandled disconnect %s, setting a_idle\n",
|
2013-03-07 12:39:57 +04:00
|
|
|
usb_otg_state_string(musb->xceiv->state));
|
2009-03-31 23:30:04 +04:00
|
|
|
musb->xceiv->state = OTG_STATE_A_IDLE;
|
2009-03-31 23:35:09 +04:00
|
|
|
MUSB_HST_MODE(musb);
|
2008-07-24 13:27:36 +04:00
|
|
|
break;
|
|
|
|
case OTG_STATE_A_PERIPHERAL:
|
2009-04-02 21:16:11 +04:00
|
|
|
musb->xceiv->state = OTG_STATE_A_WAIT_BCON;
|
2009-03-31 23:35:09 +04:00
|
|
|
MUSB_HST_MODE(musb);
|
2008-07-24 13:27:36 +04:00
|
|
|
break;
|
|
|
|
case OTG_STATE_B_WAIT_ACON:
|
|
|
|
case OTG_STATE_B_HOST:
|
|
|
|
case OTG_STATE_B_PERIPHERAL:
|
|
|
|
case OTG_STATE_B_IDLE:
|
2009-03-31 23:30:04 +04:00
|
|
|
musb->xceiv->state = OTG_STATE_B_IDLE;
|
2008-07-24 13:27:36 +04:00
|
|
|
break;
|
|
|
|
case OTG_STATE_B_SRP_INIT:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
musb->is_active = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
void musb_g_reset(struct musb *musb)
|
|
|
|
__releases(musb->lock)
|
|
|
|
__acquires(musb->lock)
|
|
|
|
{
|
|
|
|
void __iomem *mbase = musb->mregs;
|
|
|
|
u8 devctl = musb_readb(mbase, MUSB_DEVCTL);
|
|
|
|
u8 power;
|
|
|
|
|
2012-10-30 22:52:24 +04:00
|
|
|
dev_dbg(musb->controller, "<== %s driver '%s'\n",
|
2008-07-24 13:27:36 +04:00
|
|
|
(devctl & MUSB_DEVCTL_BDEVICE)
|
|
|
|
? "B-Device" : "A-Device",
|
|
|
|
musb->gadget_driver
|
|
|
|
? musb->gadget_driver->driver.name
|
|
|
|
: NULL
|
|
|
|
);
|
|
|
|
|
|
|
|
/* report disconnect, if we didn't already (flushing EP state) */
|
|
|
|
if (musb->g.speed != USB_SPEED_UNKNOWN)
|
|
|
|
musb_g_disconnect(musb);
|
|
|
|
|
|
|
|
/* clear HR */
|
|
|
|
else if (devctl & MUSB_DEVCTL_HR)
|
|
|
|
musb_writeb(mbase, MUSB_DEVCTL, MUSB_DEVCTL_SESSION);
|
|
|
|
|
|
|
|
|
|
|
|
/* what speed did we negotiate? */
|
|
|
|
power = musb_readb(mbase, MUSB_POWER);
|
|
|
|
musb->g.speed = (power & MUSB_POWER_HSMODE)
|
|
|
|
? USB_SPEED_HIGH : USB_SPEED_FULL;
|
|
|
|
|
|
|
|
/* start in USB_STATE_DEFAULT */
|
|
|
|
musb->is_active = 1;
|
|
|
|
musb->is_suspended = 0;
|
|
|
|
MUSB_DEV_MODE(musb);
|
|
|
|
musb->address = 0;
|
|
|
|
musb->ep0_state = MUSB_EP0_STAGE_SETUP;
|
|
|
|
|
|
|
|
musb->may_wakeup = 0;
|
|
|
|
musb->g.b_hnp_enable = 0;
|
|
|
|
musb->g.a_alt_hnp_support = 0;
|
|
|
|
musb->g.a_hnp_support = 0;
|
|
|
|
|
|
|
|
/* Normal reset, as B-Device;
|
|
|
|
* or else after HNP, as A-Device
|
|
|
|
*/
|
|
|
|
if (devctl & MUSB_DEVCTL_BDEVICE) {
|
2009-03-31 23:30:04 +04:00
|
|
|
musb->xceiv->state = OTG_STATE_B_PERIPHERAL;
|
2008-07-24 13:27:36 +04:00
|
|
|
musb->g.is_a_peripheral = 0;
|
2011-11-24 17:46:26 +04:00
|
|
|
} else {
|
2009-03-31 23:30:04 +04:00
|
|
|
musb->xceiv->state = OTG_STATE_A_PERIPHERAL;
|
2008-07-24 13:27:36 +04:00
|
|
|
musb->g.is_a_peripheral = 1;
|
2011-11-24 17:46:26 +04:00
|
|
|
}
|
2008-07-24 13:27:36 +04:00
|
|
|
|
|
|
|
/* start with default limits on VBUS power draw */
|
2011-11-24 17:46:26 +04:00
|
|
|
(void) musb_gadget_vbus_draw(&musb->g, 8);
|
2008-07-24 13:27:36 +04:00
|
|
|
}
|