2017-11-03 17:28:30 +07:00
|
|
|
// SPDX-License-Identifier: GPL-2.0
|
2007-05-10 11:18:23 +07:00
|
|
|
/*
|
|
|
|
* M66592 UDC (USB gadget)
|
|
|
|
*
|
|
|
|
* Copyright (C) 2006-2007 Renesas Solutions Corp.
|
|
|
|
*
|
2011-07-07 07:59:07 +07:00
|
|
|
* Author : Yoshihiro Shimoda <yoshihiro.shimoda.uh@renesas.com>
|
2007-05-10 11:18:23 +07:00
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/interrupt.h>
|
2007-07-17 19:01:17 +07:00
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/io.h>
|
2007-05-10 11:18:23 +07:00
|
|
|
#include <linux/platform_device.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 15:04:11 +07:00
|
|
|
#include <linux/slab.h>
|
2009-08-24 20:45:15 +07:00
|
|
|
#include <linux/err.h>
|
2007-05-10 11:18:23 +07:00
|
|
|
#include <linux/usb/ch9.h>
|
2007-10-05 08:05:17 +07:00
|
|
|
#include <linux/usb/gadget.h>
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
#include "m66592-udc.h"
|
|
|
|
|
2007-07-17 19:01:17 +07:00
|
|
|
MODULE_DESCRIPTION("M66592 USB gadget driver");
|
2007-05-10 11:18:23 +07:00
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
MODULE_AUTHOR("Yoshihiro Shimoda");
|
2008-04-11 11:29:21 +07:00
|
|
|
MODULE_ALIAS("platform:m66592_udc");
|
2007-05-10 11:18:23 +07:00
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
#define DRIVER_VERSION "21 July 2009"
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
static const char udc_name[] = "m66592_udc";
|
|
|
|
static const char *m66592_ep_name[] = {
|
|
|
|
"ep0", "ep1", "ep2", "ep3", "ep4", "ep5", "ep6", "ep7"
|
|
|
|
};
|
|
|
|
|
|
|
|
static void disable_controller(struct m66592 *m66592);
|
|
|
|
static void irq_ep0_write(struct m66592_ep *ep, struct m66592_request *req);
|
|
|
|
static void irq_packet_write(struct m66592_ep *ep, struct m66592_request *req);
|
|
|
|
static int m66592_queue(struct usb_ep *_ep, struct usb_request *_req,
|
|
|
|
gfp_t gfp_flags);
|
|
|
|
|
|
|
|
static void transfer_complete(struct m66592_ep *ep,
|
2007-07-17 19:01:17 +07:00
|
|
|
struct m66592_request *req, int status);
|
|
|
|
|
2007-05-10 11:18:23 +07:00
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
static inline u16 get_usb_speed(struct m66592 *m66592)
|
|
|
|
{
|
|
|
|
return (m66592_read(m66592, M66592_DVSTCTR) & M66592_RHST);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void enable_pipe_irq(struct m66592 *m66592, u16 pipenum,
|
2007-07-17 19:01:17 +07:00
|
|
|
unsigned long reg)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
|
|
|
u16 tmp;
|
|
|
|
|
|
|
|
tmp = m66592_read(m66592, M66592_INTENB0);
|
|
|
|
m66592_bclr(m66592, M66592_BEMPE | M66592_NRDYE | M66592_BRDYE,
|
2007-07-17 19:01:17 +07:00
|
|
|
M66592_INTENB0);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592_bset(m66592, (1 << pipenum), reg);
|
|
|
|
m66592_write(m66592, tmp, M66592_INTENB0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void disable_pipe_irq(struct m66592 *m66592, u16 pipenum,
|
2007-07-17 19:01:17 +07:00
|
|
|
unsigned long reg)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
|
|
|
u16 tmp;
|
|
|
|
|
|
|
|
tmp = m66592_read(m66592, M66592_INTENB0);
|
|
|
|
m66592_bclr(m66592, M66592_BEMPE | M66592_NRDYE | M66592_BRDYE,
|
2007-07-17 19:01:17 +07:00
|
|
|
M66592_INTENB0);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592_bclr(m66592, (1 << pipenum), reg);
|
|
|
|
m66592_write(m66592, tmp, M66592_INTENB0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void m66592_usb_connect(struct m66592 *m66592)
|
|
|
|
{
|
|
|
|
m66592_bset(m66592, M66592_CTRE, M66592_INTENB0);
|
|
|
|
m66592_bset(m66592, M66592_WDST | M66592_RDST | M66592_CMPL,
|
2007-07-17 19:01:17 +07:00
|
|
|
M66592_INTENB0);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592_bset(m66592, M66592_BEMPE | M66592_BRDYE, M66592_INTENB0);
|
|
|
|
|
|
|
|
m66592_bset(m66592, M66592_DPRPU, M66592_SYSCFG);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void m66592_usb_disconnect(struct m66592 *m66592)
|
2007-07-17 19:01:17 +07:00
|
|
|
__releases(m66592->lock)
|
|
|
|
__acquires(m66592->lock)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
|
|
|
m66592_bclr(m66592, M66592_CTRE, M66592_INTENB0);
|
|
|
|
m66592_bclr(m66592, M66592_WDST | M66592_RDST | M66592_CMPL,
|
2007-07-17 19:01:17 +07:00
|
|
|
M66592_INTENB0);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592_bclr(m66592, M66592_BEMPE | M66592_BRDYE, M66592_INTENB0);
|
|
|
|
m66592_bclr(m66592, M66592_DPRPU, M66592_SYSCFG);
|
|
|
|
|
|
|
|
m66592->gadget.speed = USB_SPEED_UNKNOWN;
|
|
|
|
spin_unlock(&m66592->lock);
|
|
|
|
m66592->driver->disconnect(&m66592->gadget);
|
|
|
|
spin_lock(&m66592->lock);
|
|
|
|
|
|
|
|
disable_controller(m66592);
|
|
|
|
INIT_LIST_HEAD(&m66592->ep[0].queue);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline u16 control_reg_get_pid(struct m66592 *m66592, u16 pipenum)
|
|
|
|
{
|
|
|
|
u16 pid = 0;
|
|
|
|
unsigned long offset;
|
|
|
|
|
|
|
|
if (pipenum == 0)
|
|
|
|
pid = m66592_read(m66592, M66592_DCPCTR) & M66592_PID;
|
|
|
|
else if (pipenum < M66592_MAX_NUM_PIPE) {
|
|
|
|
offset = get_pipectr_addr(pipenum);
|
|
|
|
pid = m66592_read(m66592, offset) & M66592_PID;
|
|
|
|
} else
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("unexpect pipe num (%d)\n", pipenum);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
return pid;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void control_reg_set_pid(struct m66592 *m66592, u16 pipenum,
|
2007-07-17 19:01:17 +07:00
|
|
|
u16 pid)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
|
|
|
unsigned long offset;
|
|
|
|
|
|
|
|
if (pipenum == 0)
|
|
|
|
m66592_mdfy(m66592, pid, M66592_PID, M66592_DCPCTR);
|
|
|
|
else if (pipenum < M66592_MAX_NUM_PIPE) {
|
|
|
|
offset = get_pipectr_addr(pipenum);
|
|
|
|
m66592_mdfy(m66592, pid, M66592_PID, offset);
|
|
|
|
} else
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("unexpect pipe num (%d)\n", pipenum);
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
static inline void pipe_start(struct m66592 *m66592, u16 pipenum)
|
|
|
|
{
|
|
|
|
control_reg_set_pid(m66592, pipenum, M66592_PID_BUF);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void pipe_stop(struct m66592 *m66592, u16 pipenum)
|
|
|
|
{
|
|
|
|
control_reg_set_pid(m66592, pipenum, M66592_PID_NAK);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void pipe_stall(struct m66592 *m66592, u16 pipenum)
|
|
|
|
{
|
|
|
|
control_reg_set_pid(m66592, pipenum, M66592_PID_STALL);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline u16 control_reg_get(struct m66592 *m66592, u16 pipenum)
|
|
|
|
{
|
|
|
|
u16 ret = 0;
|
|
|
|
unsigned long offset;
|
|
|
|
|
|
|
|
if (pipenum == 0)
|
|
|
|
ret = m66592_read(m66592, M66592_DCPCTR);
|
|
|
|
else if (pipenum < M66592_MAX_NUM_PIPE) {
|
|
|
|
offset = get_pipectr_addr(pipenum);
|
|
|
|
ret = m66592_read(m66592, offset);
|
|
|
|
} else
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("unexpect pipe num (%d)\n", pipenum);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void control_reg_sqclr(struct m66592 *m66592, u16 pipenum)
|
|
|
|
{
|
|
|
|
unsigned long offset;
|
|
|
|
|
|
|
|
pipe_stop(m66592, pipenum);
|
|
|
|
|
|
|
|
if (pipenum == 0)
|
|
|
|
m66592_bset(m66592, M66592_SQCLR, M66592_DCPCTR);
|
|
|
|
else if (pipenum < M66592_MAX_NUM_PIPE) {
|
|
|
|
offset = get_pipectr_addr(pipenum);
|
|
|
|
m66592_bset(m66592, M66592_SQCLR, offset);
|
|
|
|
} else
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("unexpect pipe num(%d)\n", pipenum);
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
static inline int get_buffer_size(struct m66592 *m66592, u16 pipenum)
|
|
|
|
{
|
|
|
|
u16 tmp;
|
|
|
|
int size;
|
|
|
|
|
|
|
|
if (pipenum == 0) {
|
|
|
|
tmp = m66592_read(m66592, M66592_DCPCFG);
|
|
|
|
if ((tmp & M66592_CNTMD) != 0)
|
|
|
|
size = 256;
|
|
|
|
else {
|
|
|
|
tmp = m66592_read(m66592, M66592_DCPMAXP);
|
|
|
|
size = tmp & M66592_MAXP;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
m66592_write(m66592, pipenum, M66592_PIPESEL);
|
|
|
|
tmp = m66592_read(m66592, M66592_PIPECFG);
|
|
|
|
if ((tmp & M66592_CNTMD) != 0) {
|
|
|
|
tmp = m66592_read(m66592, M66592_PIPEBUF);
|
|
|
|
size = ((tmp >> 10) + 1) * 64;
|
|
|
|
} else {
|
|
|
|
tmp = m66592_read(m66592, M66592_PIPEMAXP);
|
|
|
|
size = tmp & M66592_MXPS;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return size;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void pipe_change(struct m66592 *m66592, u16 pipenum)
|
|
|
|
{
|
|
|
|
struct m66592_ep *ep = m66592->pipenum2ep[pipenum];
|
2009-07-22 21:41:35 +07:00
|
|
|
unsigned short mbw;
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
if (ep->use_dma)
|
|
|
|
return;
|
|
|
|
|
|
|
|
m66592_mdfy(m66592, pipenum, M66592_CURPIPE, ep->fifosel);
|
|
|
|
|
|
|
|
ndelay(450);
|
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
if (m66592->pdata->on_chip)
|
|
|
|
mbw = M66592_MBW_32;
|
|
|
|
else
|
|
|
|
mbw = M66592_MBW_16;
|
|
|
|
|
|
|
|
m66592_bset(m66592, mbw, ep->fifosel);
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
static int pipe_buffer_setting(struct m66592 *m66592,
|
2007-07-17 19:01:17 +07:00
|
|
|
struct m66592_pipe_info *info)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
|
|
|
u16 bufnum = 0, buf_bsize = 0;
|
|
|
|
u16 pipecfg = 0;
|
|
|
|
|
|
|
|
if (info->pipe == 0)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
m66592_write(m66592, info->pipe, M66592_PIPESEL);
|
|
|
|
|
|
|
|
if (info->dir_in)
|
|
|
|
pipecfg |= M66592_DIR;
|
|
|
|
pipecfg |= info->type;
|
|
|
|
pipecfg |= info->epnum;
|
|
|
|
switch (info->type) {
|
|
|
|
case M66592_INT:
|
|
|
|
bufnum = 4 + (info->pipe - M66592_BASE_PIPENUM_INT);
|
|
|
|
buf_bsize = 0;
|
|
|
|
break;
|
|
|
|
case M66592_BULK:
|
2009-06-26 13:59:17 +07:00
|
|
|
/* isochronous pipes may be used as bulk pipes */
|
2011-02-21 10:55:32 +07:00
|
|
|
if (info->pipe >= M66592_BASE_PIPENUM_BULK)
|
2009-06-26 13:59:17 +07:00
|
|
|
bufnum = info->pipe - M66592_BASE_PIPENUM_BULK;
|
|
|
|
else
|
|
|
|
bufnum = info->pipe - M66592_BASE_PIPENUM_ISOC;
|
|
|
|
|
|
|
|
bufnum = M66592_BASE_BUFNUM + (bufnum * 16);
|
2007-05-10 11:18:23 +07:00
|
|
|
buf_bsize = 7;
|
|
|
|
pipecfg |= M66592_DBLB;
|
|
|
|
if (!info->dir_in)
|
|
|
|
pipecfg |= M66592_SHTNAK;
|
|
|
|
break;
|
|
|
|
case M66592_ISO:
|
2009-06-26 13:59:17 +07:00
|
|
|
bufnum = M66592_BASE_BUFNUM +
|
2007-05-10 11:18:23 +07:00
|
|
|
(info->pipe - M66592_BASE_PIPENUM_ISOC) * 16;
|
|
|
|
buf_bsize = 7;
|
|
|
|
break;
|
|
|
|
}
|
2009-06-26 13:59:17 +07:00
|
|
|
|
|
|
|
if (buf_bsize && ((bufnum + 16) >= M66592_MAX_BUFNUM)) {
|
|
|
|
pr_err("m66592 pipe memory is insufficient\n");
|
2007-05-10 11:18:23 +07:00
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
m66592_write(m66592, pipecfg, M66592_PIPECFG);
|
|
|
|
m66592_write(m66592, (buf_bsize << 10) | (bufnum), M66592_PIPEBUF);
|
|
|
|
m66592_write(m66592, info->maxpacket, M66592_PIPEMAXP);
|
|
|
|
if (info->interval)
|
|
|
|
info->interval--;
|
|
|
|
m66592_write(m66592, info->interval, M66592_PIPEPERI);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pipe_buffer_release(struct m66592 *m66592,
|
|
|
|
struct m66592_pipe_info *info)
|
|
|
|
{
|
|
|
|
if (info->pipe == 0)
|
|
|
|
return;
|
|
|
|
|
|
|
|
if (is_bulk_pipe(info->pipe)) {
|
|
|
|
m66592->bulk--;
|
|
|
|
} else if (is_interrupt_pipe(info->pipe))
|
|
|
|
m66592->interrupt--;
|
|
|
|
else if (is_isoc_pipe(info->pipe)) {
|
|
|
|
m66592->isochronous--;
|
|
|
|
if (info->type == M66592_BULK)
|
|
|
|
m66592->bulk--;
|
|
|
|
} else
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("ep_release: unexpect pipenum (%d)\n",
|
2007-07-17 19:01:17 +07:00
|
|
|
info->pipe);
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
static void pipe_initialize(struct m66592_ep *ep)
|
|
|
|
{
|
|
|
|
struct m66592 *m66592 = ep->m66592;
|
2009-07-22 21:41:35 +07:00
|
|
|
unsigned short mbw;
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
m66592_mdfy(m66592, 0, M66592_CURPIPE, ep->fifosel);
|
|
|
|
|
|
|
|
m66592_write(m66592, M66592_ACLRM, ep->pipectr);
|
|
|
|
m66592_write(m66592, 0, ep->pipectr);
|
|
|
|
m66592_write(m66592, M66592_SQCLR, ep->pipectr);
|
|
|
|
if (ep->use_dma) {
|
|
|
|
m66592_mdfy(m66592, ep->pipenum, M66592_CURPIPE, ep->fifosel);
|
|
|
|
|
|
|
|
ndelay(450);
|
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
if (m66592->pdata->on_chip)
|
|
|
|
mbw = M66592_MBW_32;
|
|
|
|
else
|
|
|
|
mbw = M66592_MBW_16;
|
|
|
|
|
|
|
|
m66592_bset(m66592, mbw, ep->fifosel);
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void m66592_ep_setting(struct m66592 *m66592, struct m66592_ep *ep,
|
2007-07-17 19:01:17 +07:00
|
|
|
const struct usb_endpoint_descriptor *desc,
|
|
|
|
u16 pipenum, int dma)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
|
|
|
if ((pipenum != 0) && dma) {
|
|
|
|
if (m66592->num_dma == 0) {
|
|
|
|
m66592->num_dma++;
|
|
|
|
ep->use_dma = 1;
|
|
|
|
ep->fifoaddr = M66592_D0FIFO;
|
|
|
|
ep->fifosel = M66592_D0FIFOSEL;
|
|
|
|
ep->fifoctr = M66592_D0FIFOCTR;
|
|
|
|
ep->fifotrn = M66592_D0FIFOTRN;
|
2009-07-22 21:41:35 +07:00
|
|
|
} else if (!m66592->pdata->on_chip && m66592->num_dma == 1) {
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592->num_dma++;
|
|
|
|
ep->use_dma = 1;
|
|
|
|
ep->fifoaddr = M66592_D1FIFO;
|
|
|
|
ep->fifosel = M66592_D1FIFOSEL;
|
|
|
|
ep->fifoctr = M66592_D1FIFOCTR;
|
|
|
|
ep->fifotrn = M66592_D1FIFOTRN;
|
|
|
|
} else {
|
|
|
|
ep->use_dma = 0;
|
|
|
|
ep->fifoaddr = M66592_CFIFO;
|
|
|
|
ep->fifosel = M66592_CFIFOSEL;
|
|
|
|
ep->fifoctr = M66592_CFIFOCTR;
|
|
|
|
ep->fifotrn = 0;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
ep->use_dma = 0;
|
|
|
|
ep->fifoaddr = M66592_CFIFO;
|
|
|
|
ep->fifosel = M66592_CFIFOSEL;
|
|
|
|
ep->fifoctr = M66592_CFIFOCTR;
|
|
|
|
ep->fifotrn = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
ep->pipectr = get_pipectr_addr(pipenum);
|
|
|
|
ep->pipenum = pipenum;
|
2011-08-23 17:12:03 +07:00
|
|
|
ep->ep.maxpacket = usb_endpoint_maxp(desc);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592->pipenum2ep[pipenum] = ep;
|
|
|
|
m66592->epaddr2ep[desc->bEndpointAddress&USB_ENDPOINT_NUMBER_MASK] = ep;
|
|
|
|
INIT_LIST_HEAD(&ep->queue);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void m66592_ep_release(struct m66592_ep *ep)
|
|
|
|
{
|
|
|
|
struct m66592 *m66592 = ep->m66592;
|
|
|
|
u16 pipenum = ep->pipenum;
|
|
|
|
|
|
|
|
if (pipenum == 0)
|
|
|
|
return;
|
|
|
|
|
|
|
|
if (ep->use_dma)
|
|
|
|
m66592->num_dma--;
|
|
|
|
ep->pipenum = 0;
|
|
|
|
ep->busy = 0;
|
|
|
|
ep->use_dma = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int alloc_pipe_config(struct m66592_ep *ep,
|
2007-07-17 19:01:17 +07:00
|
|
|
const struct usb_endpoint_descriptor *desc)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
|
|
|
struct m66592 *m66592 = ep->m66592;
|
|
|
|
struct m66592_pipe_info info;
|
|
|
|
int dma = 0;
|
|
|
|
int *counter;
|
|
|
|
int ret;
|
|
|
|
|
2012-03-13 01:25:33 +07:00
|
|
|
ep->ep.desc = desc;
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
BUG_ON(ep->pipenum);
|
|
|
|
|
2007-07-17 19:01:17 +07:00
|
|
|
switch (desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) {
|
2007-05-10 11:18:23 +07:00
|
|
|
case USB_ENDPOINT_XFER_BULK:
|
|
|
|
if (m66592->bulk >= M66592_MAX_NUM_BULK) {
|
|
|
|
if (m66592->isochronous >= M66592_MAX_NUM_ISOC) {
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("bulk pipe is insufficient\n");
|
2007-05-10 11:18:23 +07:00
|
|
|
return -ENODEV;
|
|
|
|
} else {
|
2007-07-17 19:01:17 +07:00
|
|
|
info.pipe = M66592_BASE_PIPENUM_ISOC
|
|
|
|
+ m66592->isochronous;
|
2007-05-10 11:18:23 +07:00
|
|
|
counter = &m66592->isochronous;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
info.pipe = M66592_BASE_PIPENUM_BULK + m66592->bulk;
|
|
|
|
counter = &m66592->bulk;
|
|
|
|
}
|
|
|
|
info.type = M66592_BULK;
|
|
|
|
dma = 1;
|
|
|
|
break;
|
|
|
|
case USB_ENDPOINT_XFER_INT:
|
|
|
|
if (m66592->interrupt >= M66592_MAX_NUM_INT) {
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("interrupt pipe is insufficient\n");
|
2007-05-10 11:18:23 +07:00
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
info.pipe = M66592_BASE_PIPENUM_INT + m66592->interrupt;
|
|
|
|
info.type = M66592_INT;
|
|
|
|
counter = &m66592->interrupt;
|
|
|
|
break;
|
|
|
|
case USB_ENDPOINT_XFER_ISOC:
|
|
|
|
if (m66592->isochronous >= M66592_MAX_NUM_ISOC) {
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("isochronous pipe is insufficient\n");
|
2007-05-10 11:18:23 +07:00
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
info.pipe = M66592_BASE_PIPENUM_ISOC + m66592->isochronous;
|
|
|
|
info.type = M66592_ISO;
|
|
|
|
counter = &m66592->isochronous;
|
|
|
|
break;
|
|
|
|
default:
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("unexpect xfer type\n");
|
2007-05-10 11:18:23 +07:00
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
ep->type = info.type;
|
|
|
|
|
|
|
|
info.epnum = desc->bEndpointAddress & USB_ENDPOINT_NUMBER_MASK;
|
2011-08-23 17:12:03 +07:00
|
|
|
info.maxpacket = usb_endpoint_maxp(desc);
|
2007-05-10 11:18:23 +07:00
|
|
|
info.interval = desc->bInterval;
|
|
|
|
if (desc->bEndpointAddress & USB_ENDPOINT_DIR_MASK)
|
|
|
|
info.dir_in = 1;
|
|
|
|
else
|
|
|
|
info.dir_in = 0;
|
|
|
|
|
|
|
|
ret = pipe_buffer_setting(m66592, &info);
|
|
|
|
if (ret < 0) {
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("pipe_buffer_setting fail\n");
|
2007-05-10 11:18:23 +07:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
(*counter)++;
|
|
|
|
if ((counter == &m66592->isochronous) && info.type == M66592_BULK)
|
|
|
|
m66592->bulk++;
|
|
|
|
|
|
|
|
m66592_ep_setting(m66592, ep, desc, info.pipe, dma);
|
|
|
|
pipe_initialize(ep);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int free_pipe_config(struct m66592_ep *ep)
|
|
|
|
{
|
|
|
|
struct m66592 *m66592 = ep->m66592;
|
|
|
|
struct m66592_pipe_info info;
|
|
|
|
|
|
|
|
info.pipe = ep->pipenum;
|
|
|
|
info.type = ep->type;
|
|
|
|
pipe_buffer_release(m66592, &info);
|
|
|
|
m66592_ep_release(ep);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
static void pipe_irq_enable(struct m66592 *m66592, u16 pipenum)
|
|
|
|
{
|
|
|
|
enable_irq_ready(m66592, pipenum);
|
|
|
|
enable_irq_nrdy(m66592, pipenum);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void pipe_irq_disable(struct m66592 *m66592, u16 pipenum)
|
|
|
|
{
|
|
|
|
disable_irq_ready(m66592, pipenum);
|
|
|
|
disable_irq_nrdy(m66592, pipenum);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* if complete is true, gadget driver complete function is not call */
|
|
|
|
static void control_end(struct m66592 *m66592, unsigned ccpl)
|
|
|
|
{
|
|
|
|
m66592->ep[0].internal_ccpl = ccpl;
|
|
|
|
pipe_start(m66592, 0);
|
|
|
|
m66592_bset(m66592, M66592_CCPL, M66592_DCPCTR);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void start_ep0_write(struct m66592_ep *ep, struct m66592_request *req)
|
|
|
|
{
|
|
|
|
struct m66592 *m66592 = ep->m66592;
|
|
|
|
|
|
|
|
pipe_change(m66592, ep->pipenum);
|
|
|
|
m66592_mdfy(m66592, M66592_ISEL | M66592_PIPE0,
|
2007-07-17 19:01:17 +07:00
|
|
|
(M66592_ISEL | M66592_CURPIPE),
|
|
|
|
M66592_CFIFOSEL);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592_write(m66592, M66592_BCLR, ep->fifoctr);
|
|
|
|
if (req->req.length == 0) {
|
|
|
|
m66592_bset(m66592, M66592_BVAL, ep->fifoctr);
|
|
|
|
pipe_start(m66592, 0);
|
|
|
|
transfer_complete(ep, req, 0);
|
|
|
|
} else {
|
|
|
|
m66592_write(m66592, ~M66592_BEMP0, M66592_BEMPSTS);
|
|
|
|
irq_ep0_write(ep, req);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void start_packet_write(struct m66592_ep *ep, struct m66592_request *req)
|
|
|
|
{
|
|
|
|
struct m66592 *m66592 = ep->m66592;
|
|
|
|
u16 tmp;
|
|
|
|
|
|
|
|
pipe_change(m66592, ep->pipenum);
|
|
|
|
disable_irq_empty(m66592, ep->pipenum);
|
|
|
|
pipe_start(m66592, ep->pipenum);
|
|
|
|
|
|
|
|
tmp = m66592_read(m66592, ep->fifoctr);
|
|
|
|
if (unlikely((tmp & M66592_FRDY) == 0))
|
|
|
|
pipe_irq_enable(m66592, ep->pipenum);
|
|
|
|
else
|
|
|
|
irq_packet_write(ep, req);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void start_packet_read(struct m66592_ep *ep, struct m66592_request *req)
|
|
|
|
{
|
|
|
|
struct m66592 *m66592 = ep->m66592;
|
|
|
|
u16 pipenum = ep->pipenum;
|
|
|
|
|
|
|
|
if (ep->pipenum == 0) {
|
|
|
|
m66592_mdfy(m66592, M66592_PIPE0,
|
2007-07-17 19:01:17 +07:00
|
|
|
(M66592_ISEL | M66592_CURPIPE),
|
|
|
|
M66592_CFIFOSEL);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592_write(m66592, M66592_BCLR, ep->fifoctr);
|
|
|
|
pipe_start(m66592, pipenum);
|
|
|
|
pipe_irq_enable(m66592, pipenum);
|
|
|
|
} else {
|
|
|
|
if (ep->use_dma) {
|
|
|
|
m66592_bset(m66592, M66592_TRCLR, ep->fifosel);
|
|
|
|
pipe_change(m66592, pipenum);
|
|
|
|
m66592_bset(m66592, M66592_TRENB, ep->fifosel);
|
|
|
|
m66592_write(m66592,
|
2007-07-17 19:01:17 +07:00
|
|
|
(req->req.length + ep->ep.maxpacket - 1)
|
|
|
|
/ ep->ep.maxpacket,
|
|
|
|
ep->fifotrn);
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
pipe_start(m66592, pipenum); /* trigger once */
|
|
|
|
pipe_irq_enable(m66592, pipenum);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void start_packet(struct m66592_ep *ep, struct m66592_request *req)
|
|
|
|
{
|
2012-03-13 01:25:33 +07:00
|
|
|
if (ep->ep.desc->bEndpointAddress & USB_DIR_IN)
|
2007-05-10 11:18:23 +07:00
|
|
|
start_packet_write(ep, req);
|
|
|
|
else
|
|
|
|
start_packet_read(ep, req);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void start_ep0(struct m66592_ep *ep, struct m66592_request *req)
|
|
|
|
{
|
|
|
|
u16 ctsq;
|
|
|
|
|
|
|
|
ctsq = m66592_read(ep->m66592, M66592_INTSTS0) & M66592_CTSQ;
|
|
|
|
|
|
|
|
switch (ctsq) {
|
|
|
|
case M66592_CS_RDDS:
|
|
|
|
start_ep0_write(ep, req);
|
|
|
|
break;
|
|
|
|
case M66592_CS_WRDS:
|
|
|
|
start_packet_read(ep, req);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case M66592_CS_WRND:
|
|
|
|
control_end(ep->m66592, 0);
|
|
|
|
break;
|
|
|
|
default:
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("start_ep0: unexpect ctsq(%x)\n", ctsq);
|
2007-05-10 11:18:23 +07:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2007-11-22 19:00:30 +07:00
|
|
|
static void init_controller(struct m66592 *m66592)
|
|
|
|
{
|
2009-07-22 21:41:35 +07:00
|
|
|
unsigned int endian;
|
2007-11-22 19:00:30 +07:00
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
if (m66592->pdata->on_chip) {
|
|
|
|
if (m66592->pdata->endian)
|
|
|
|
endian = 0; /* big endian */
|
|
|
|
else
|
|
|
|
endian = M66592_LITTLE; /* little endian */
|
2007-11-22 19:00:30 +07:00
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
m66592_bset(m66592, M66592_HSE, M66592_SYSCFG); /* High spd */
|
|
|
|
m66592_bclr(m66592, M66592_USBE, M66592_SYSCFG);
|
|
|
|
m66592_bclr(m66592, M66592_DPRPU, M66592_SYSCFG);
|
|
|
|
m66592_bset(m66592, M66592_USBE, M66592_SYSCFG);
|
2007-11-22 19:00:30 +07:00
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
/* This is a workaound for SH7722 2nd cut */
|
|
|
|
m66592_bset(m66592, 0x8000, M66592_DVSTCTR);
|
|
|
|
m66592_bset(m66592, 0x1000, M66592_TESTMODE);
|
|
|
|
m66592_bclr(m66592, 0x8000, M66592_DVSTCTR);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
m66592_bset(m66592, M66592_INTL, M66592_INTENB1);
|
|
|
|
|
|
|
|
m66592_write(m66592, 0, M66592_CFBCFG);
|
|
|
|
m66592_write(m66592, 0, M66592_D0FBCFG);
|
|
|
|
m66592_bset(m66592, endian, M66592_CFBCFG);
|
|
|
|
m66592_bset(m66592, endian, M66592_D0FBCFG);
|
|
|
|
} else {
|
|
|
|
unsigned int clock, vif, irq_sense;
|
|
|
|
|
|
|
|
if (m66592->pdata->endian)
|
|
|
|
endian = M66592_BIGEND; /* big endian */
|
|
|
|
else
|
|
|
|
endian = 0; /* little endian */
|
|
|
|
|
|
|
|
if (m66592->pdata->vif)
|
|
|
|
vif = M66592_LDRV; /* 3.3v */
|
|
|
|
else
|
|
|
|
vif = 0; /* 1.5v */
|
|
|
|
|
|
|
|
switch (m66592->pdata->xtal) {
|
|
|
|
case M66592_PLATDATA_XTAL_12MHZ:
|
|
|
|
clock = M66592_XTAL12;
|
|
|
|
break;
|
|
|
|
case M66592_PLATDATA_XTAL_24MHZ:
|
|
|
|
clock = M66592_XTAL24;
|
|
|
|
break;
|
|
|
|
case M66592_PLATDATA_XTAL_48MHZ:
|
|
|
|
clock = M66592_XTAL48;
|
|
|
|
break;
|
|
|
|
default:
|
2016-09-27 23:16:59 +07:00
|
|
|
pr_warn("m66592-udc: xtal configuration error\n");
|
2009-07-22 21:41:35 +07:00
|
|
|
clock = 0;
|
|
|
|
}
|
2007-05-10 11:18:23 +07:00
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
switch (m66592->irq_trigger) {
|
|
|
|
case IRQF_TRIGGER_LOW:
|
|
|
|
irq_sense = M66592_INTL;
|
|
|
|
break;
|
|
|
|
case IRQF_TRIGGER_FALLING:
|
|
|
|
irq_sense = 0;
|
|
|
|
break;
|
|
|
|
default:
|
2016-09-27 23:16:59 +07:00
|
|
|
pr_warn("m66592-udc: irq trigger config error\n");
|
2009-07-22 21:41:35 +07:00
|
|
|
irq_sense = 0;
|
|
|
|
}
|
2007-05-10 11:18:23 +07:00
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
m66592_bset(m66592,
|
|
|
|
(vif & M66592_LDRV) | (endian & M66592_BIGEND),
|
|
|
|
M66592_PINCFG);
|
|
|
|
m66592_bset(m66592, M66592_HSE, M66592_SYSCFG); /* High spd */
|
|
|
|
m66592_mdfy(m66592, clock & M66592_XTAL, M66592_XTAL,
|
|
|
|
M66592_SYSCFG);
|
|
|
|
m66592_bclr(m66592, M66592_USBE, M66592_SYSCFG);
|
|
|
|
m66592_bclr(m66592, M66592_DPRPU, M66592_SYSCFG);
|
|
|
|
m66592_bset(m66592, M66592_USBE, M66592_SYSCFG);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
m66592_bset(m66592, M66592_XCKE, M66592_SYSCFG);
|
|
|
|
|
|
|
|
msleep(3);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
m66592_bset(m66592, M66592_RCKE | M66592_PLLC, M66592_SYSCFG);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
msleep(1);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
m66592_bset(m66592, M66592_SCKE, M66592_SYSCFG);
|
|
|
|
|
|
|
|
m66592_bset(m66592, irq_sense & M66592_INTL, M66592_INTENB1);
|
|
|
|
m66592_write(m66592, M66592_BURST | M66592_CPU_ADR_RD_WR,
|
|
|
|
M66592_DMA0CFG);
|
|
|
|
}
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
static void disable_controller(struct m66592 *m66592)
|
|
|
|
{
|
2011-07-08 12:51:33 +07:00
|
|
|
m66592_bclr(m66592, M66592_UTST, M66592_TESTMODE);
|
2009-07-22 21:41:35 +07:00
|
|
|
if (!m66592->pdata->on_chip) {
|
|
|
|
m66592_bclr(m66592, M66592_SCKE, M66592_SYSCFG);
|
|
|
|
udelay(1);
|
|
|
|
m66592_bclr(m66592, M66592_PLLC, M66592_SYSCFG);
|
|
|
|
udelay(1);
|
|
|
|
m66592_bclr(m66592, M66592_RCKE, M66592_SYSCFG);
|
|
|
|
udelay(1);
|
|
|
|
m66592_bclr(m66592, M66592_XCKE, M66592_SYSCFG);
|
|
|
|
}
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
static void m66592_start_xclock(struct m66592 *m66592)
|
|
|
|
{
|
|
|
|
u16 tmp;
|
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
if (!m66592->pdata->on_chip) {
|
|
|
|
tmp = m66592_read(m66592, M66592_SYSCFG);
|
|
|
|
if (!(tmp & M66592_XCKE))
|
|
|
|
m66592_bset(m66592, M66592_XCKE, M66592_SYSCFG);
|
|
|
|
}
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
static void transfer_complete(struct m66592_ep *ep,
|
2007-07-17 19:01:17 +07:00
|
|
|
struct m66592_request *req, int status)
|
|
|
|
__releases(m66592->lock)
|
|
|
|
__acquires(m66592->lock)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
|
|
|
int restart = 0;
|
|
|
|
|
|
|
|
if (unlikely(ep->pipenum == 0)) {
|
|
|
|
if (ep->internal_ccpl) {
|
|
|
|
ep->internal_ccpl = 0;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
list_del_init(&req->queue);
|
|
|
|
if (ep->m66592->gadget.speed == USB_SPEED_UNKNOWN)
|
|
|
|
req->req.status = -ESHUTDOWN;
|
|
|
|
else
|
|
|
|
req->req.status = status;
|
|
|
|
|
|
|
|
if (!list_empty(&ep->queue))
|
|
|
|
restart = 1;
|
|
|
|
|
2007-07-17 19:01:17 +07:00
|
|
|
spin_unlock(&ep->m66592->lock);
|
2014-09-25 03:43:19 +07:00
|
|
|
usb_gadget_giveback_request(&ep->ep, &req->req);
|
2007-07-17 19:01:17 +07:00
|
|
|
spin_lock(&ep->m66592->lock);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
if (restart) {
|
|
|
|
req = list_entry(ep->queue.next, struct m66592_request, queue);
|
2012-03-13 01:25:33 +07:00
|
|
|
if (ep->ep.desc)
|
2007-05-10 11:18:23 +07:00
|
|
|
start_packet(ep, req);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void irq_ep0_write(struct m66592_ep *ep, struct m66592_request *req)
|
|
|
|
{
|
|
|
|
int i;
|
2007-07-17 19:01:17 +07:00
|
|
|
u16 tmp;
|
2007-05-10 11:18:23 +07:00
|
|
|
unsigned bufsize;
|
|
|
|
size_t size;
|
|
|
|
void *buf;
|
|
|
|
u16 pipenum = ep->pipenum;
|
|
|
|
struct m66592 *m66592 = ep->m66592;
|
|
|
|
|
|
|
|
pipe_change(m66592, pipenum);
|
|
|
|
m66592_bset(m66592, M66592_ISEL, ep->fifosel);
|
|
|
|
|
|
|
|
i = 0;
|
|
|
|
do {
|
|
|
|
tmp = m66592_read(m66592, ep->fifoctr);
|
|
|
|
if (i++ > 100000) {
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("pipe0 is busy. maybe cpu i/o bus "
|
2007-05-10 11:18:23 +07:00
|
|
|
"conflict. please power off this controller.");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
ndelay(1);
|
|
|
|
} while ((tmp & M66592_FRDY) == 0);
|
|
|
|
|
|
|
|
/* prepare parameters */
|
|
|
|
bufsize = get_buffer_size(m66592, pipenum);
|
|
|
|
buf = req->req.buf + req->req.actual;
|
|
|
|
size = min(bufsize, req->req.length - req->req.actual);
|
|
|
|
|
|
|
|
/* write fifo */
|
|
|
|
if (req->req.buf) {
|
|
|
|
if (size > 0)
|
2011-07-07 07:58:43 +07:00
|
|
|
m66592_write_fifo(m66592, ep, buf, size);
|
2007-05-10 11:18:23 +07:00
|
|
|
if ((size == 0) || ((size % ep->ep.maxpacket) != 0))
|
|
|
|
m66592_bset(m66592, M66592_BVAL, ep->fifoctr);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* update parameters */
|
|
|
|
req->req.actual += size;
|
|
|
|
|
|
|
|
/* check transfer finish */
|
2007-07-17 19:01:17 +07:00
|
|
|
if ((!req->req.zero && (req->req.actual == req->req.length))
|
|
|
|
|| (size % ep->ep.maxpacket)
|
|
|
|
|| (size == 0)) {
|
2007-05-10 11:18:23 +07:00
|
|
|
disable_irq_ready(m66592, pipenum);
|
|
|
|
disable_irq_empty(m66592, pipenum);
|
|
|
|
} else {
|
|
|
|
disable_irq_ready(m66592, pipenum);
|
|
|
|
enable_irq_empty(m66592, pipenum);
|
|
|
|
}
|
|
|
|
pipe_start(m66592, pipenum);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void irq_packet_write(struct m66592_ep *ep, struct m66592_request *req)
|
|
|
|
{
|
|
|
|
u16 tmp;
|
|
|
|
unsigned bufsize;
|
|
|
|
size_t size;
|
|
|
|
void *buf;
|
|
|
|
u16 pipenum = ep->pipenum;
|
|
|
|
struct m66592 *m66592 = ep->m66592;
|
|
|
|
|
|
|
|
pipe_change(m66592, pipenum);
|
|
|
|
tmp = m66592_read(m66592, ep->fifoctr);
|
|
|
|
if (unlikely((tmp & M66592_FRDY) == 0)) {
|
|
|
|
pipe_stop(m66592, pipenum);
|
|
|
|
pipe_irq_disable(m66592, pipenum);
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("write fifo not ready. pipnum=%d\n", pipenum);
|
2007-05-10 11:18:23 +07:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* prepare parameters */
|
|
|
|
bufsize = get_buffer_size(m66592, pipenum);
|
|
|
|
buf = req->req.buf + req->req.actual;
|
|
|
|
size = min(bufsize, req->req.length - req->req.actual);
|
|
|
|
|
|
|
|
/* write fifo */
|
|
|
|
if (req->req.buf) {
|
2011-07-07 07:58:43 +07:00
|
|
|
m66592_write_fifo(m66592, ep, buf, size);
|
2007-07-17 19:01:17 +07:00
|
|
|
if ((size == 0)
|
|
|
|
|| ((size % ep->ep.maxpacket) != 0)
|
|
|
|
|| ((bufsize != ep->ep.maxpacket)
|
|
|
|
&& (bufsize > size)))
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592_bset(m66592, M66592_BVAL, ep->fifoctr);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* update parameters */
|
|
|
|
req->req.actual += size;
|
|
|
|
/* check transfer finish */
|
2007-07-17 19:01:17 +07:00
|
|
|
if ((!req->req.zero && (req->req.actual == req->req.length))
|
|
|
|
|| (size % ep->ep.maxpacket)
|
|
|
|
|| (size == 0)) {
|
2007-05-10 11:18:23 +07:00
|
|
|
disable_irq_ready(m66592, pipenum);
|
|
|
|
enable_irq_empty(m66592, pipenum);
|
|
|
|
} else {
|
|
|
|
disable_irq_empty(m66592, pipenum);
|
|
|
|
pipe_irq_enable(m66592, pipenum);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void irq_packet_read(struct m66592_ep *ep, struct m66592_request *req)
|
|
|
|
{
|
|
|
|
u16 tmp;
|
|
|
|
int rcv_len, bufsize, req_len;
|
|
|
|
int size;
|
|
|
|
void *buf;
|
|
|
|
u16 pipenum = ep->pipenum;
|
|
|
|
struct m66592 *m66592 = ep->m66592;
|
|
|
|
int finish = 0;
|
|
|
|
|
|
|
|
pipe_change(m66592, pipenum);
|
|
|
|
tmp = m66592_read(m66592, ep->fifoctr);
|
|
|
|
if (unlikely((tmp & M66592_FRDY) == 0)) {
|
|
|
|
req->req.status = -EPIPE;
|
|
|
|
pipe_stop(m66592, pipenum);
|
|
|
|
pipe_irq_disable(m66592, pipenum);
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("read fifo not ready");
|
2007-05-10 11:18:23 +07:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* prepare parameters */
|
|
|
|
rcv_len = tmp & M66592_DTLN;
|
|
|
|
bufsize = get_buffer_size(m66592, pipenum);
|
|
|
|
|
|
|
|
buf = req->req.buf + req->req.actual;
|
|
|
|
req_len = req->req.length - req->req.actual;
|
|
|
|
if (rcv_len < bufsize)
|
|
|
|
size = min(rcv_len, req_len);
|
|
|
|
else
|
|
|
|
size = min(bufsize, req_len);
|
|
|
|
|
|
|
|
/* update parameters */
|
|
|
|
req->req.actual += size;
|
|
|
|
|
|
|
|
/* check transfer finish */
|
2007-07-17 19:01:17 +07:00
|
|
|
if ((!req->req.zero && (req->req.actual == req->req.length))
|
|
|
|
|| (size % ep->ep.maxpacket)
|
|
|
|
|| (size == 0)) {
|
2007-05-10 11:18:23 +07:00
|
|
|
pipe_stop(m66592, pipenum);
|
|
|
|
pipe_irq_disable(m66592, pipenum);
|
|
|
|
finish = 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* read fifo */
|
|
|
|
if (req->req.buf) {
|
|
|
|
if (size == 0)
|
|
|
|
m66592_write(m66592, M66592_BCLR, ep->fifoctr);
|
|
|
|
else
|
|
|
|
m66592_read_fifo(m66592, ep->fifoaddr, buf, size);
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((ep->pipenum != 0) && finish)
|
|
|
|
transfer_complete(ep, req, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void irq_pipe_ready(struct m66592 *m66592, u16 status, u16 enb)
|
|
|
|
{
|
|
|
|
u16 check;
|
|
|
|
u16 pipenum;
|
|
|
|
struct m66592_ep *ep;
|
|
|
|
struct m66592_request *req;
|
|
|
|
|
|
|
|
if ((status & M66592_BRDY0) && (enb & M66592_BRDY0)) {
|
|
|
|
m66592_write(m66592, ~M66592_BRDY0, M66592_BRDYSTS);
|
|
|
|
m66592_mdfy(m66592, M66592_PIPE0, M66592_CURPIPE,
|
2007-07-17 19:01:17 +07:00
|
|
|
M66592_CFIFOSEL);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
ep = &m66592->ep[0];
|
|
|
|
req = list_entry(ep->queue.next, struct m66592_request, queue);
|
|
|
|
irq_packet_read(ep, req);
|
|
|
|
} else {
|
|
|
|
for (pipenum = 1; pipenum < M66592_MAX_NUM_PIPE; pipenum++) {
|
|
|
|
check = 1 << pipenum;
|
|
|
|
if ((status & check) && (enb & check)) {
|
|
|
|
m66592_write(m66592, ~check, M66592_BRDYSTS);
|
|
|
|
ep = m66592->pipenum2ep[pipenum];
|
|
|
|
req = list_entry(ep->queue.next,
|
|
|
|
struct m66592_request, queue);
|
2012-03-13 01:25:33 +07:00
|
|
|
if (ep->ep.desc->bEndpointAddress & USB_DIR_IN)
|
2007-05-10 11:18:23 +07:00
|
|
|
irq_packet_write(ep, req);
|
|
|
|
else
|
|
|
|
irq_packet_read(ep, req);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void irq_pipe_empty(struct m66592 *m66592, u16 status, u16 enb)
|
|
|
|
{
|
|
|
|
u16 tmp;
|
|
|
|
u16 check;
|
|
|
|
u16 pipenum;
|
|
|
|
struct m66592_ep *ep;
|
|
|
|
struct m66592_request *req;
|
|
|
|
|
|
|
|
if ((status & M66592_BEMP0) && (enb & M66592_BEMP0)) {
|
|
|
|
m66592_write(m66592, ~M66592_BEMP0, M66592_BEMPSTS);
|
|
|
|
|
|
|
|
ep = &m66592->ep[0];
|
|
|
|
req = list_entry(ep->queue.next, struct m66592_request, queue);
|
|
|
|
irq_ep0_write(ep, req);
|
|
|
|
} else {
|
|
|
|
for (pipenum = 1; pipenum < M66592_MAX_NUM_PIPE; pipenum++) {
|
|
|
|
check = 1 << pipenum;
|
|
|
|
if ((status & check) && (enb & check)) {
|
|
|
|
m66592_write(m66592, ~check, M66592_BEMPSTS);
|
|
|
|
tmp = control_reg_get(m66592, pipenum);
|
|
|
|
if ((tmp & M66592_INBUFM) == 0) {
|
|
|
|
disable_irq_empty(m66592, pipenum);
|
|
|
|
pipe_irq_disable(m66592, pipenum);
|
|
|
|
pipe_stop(m66592, pipenum);
|
|
|
|
ep = m66592->pipenum2ep[pipenum];
|
|
|
|
req = list_entry(ep->queue.next,
|
|
|
|
struct m66592_request,
|
|
|
|
queue);
|
|
|
|
if (!list_empty(&ep->queue))
|
|
|
|
transfer_complete(ep, req, 0);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void get_status(struct m66592 *m66592, struct usb_ctrlrequest *ctrl)
|
2007-07-17 19:01:17 +07:00
|
|
|
__releases(m66592->lock)
|
|
|
|
__acquires(m66592->lock)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
|
|
|
struct m66592_ep *ep;
|
|
|
|
u16 pid;
|
|
|
|
u16 status = 0;
|
2007-07-17 19:01:17 +07:00
|
|
|
u16 w_index = le16_to_cpu(ctrl->wIndex);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
switch (ctrl->bRequestType & USB_RECIP_MASK) {
|
|
|
|
case USB_RECIP_DEVICE:
|
2007-07-17 19:01:17 +07:00
|
|
|
status = 1 << USB_DEVICE_SELF_POWERED;
|
2007-05-10 11:18:23 +07:00
|
|
|
break;
|
|
|
|
case USB_RECIP_INTERFACE:
|
|
|
|
status = 0;
|
|
|
|
break;
|
|
|
|
case USB_RECIP_ENDPOINT:
|
2007-07-17 19:01:17 +07:00
|
|
|
ep = m66592->epaddr2ep[w_index & USB_ENDPOINT_NUMBER_MASK];
|
2007-05-10 11:18:23 +07:00
|
|
|
pid = control_reg_get_pid(m66592, ep->pipenum);
|
|
|
|
if (pid == M66592_PID_STALL)
|
2007-07-17 19:01:17 +07:00
|
|
|
status = 1 << USB_ENDPOINT_HALT;
|
2007-05-10 11:18:23 +07:00
|
|
|
else
|
|
|
|
status = 0;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
pipe_stall(m66592, 0);
|
|
|
|
return; /* exit */
|
|
|
|
}
|
|
|
|
|
2007-07-17 19:01:17 +07:00
|
|
|
m66592->ep0_data = cpu_to_le16(status);
|
|
|
|
m66592->ep0_req->buf = &m66592->ep0_data;
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592->ep0_req->length = 2;
|
2007-07-16 02:59:22 +07:00
|
|
|
/* AV: what happens if we get called again before that gets through? */
|
2007-07-17 19:01:17 +07:00
|
|
|
spin_unlock(&m66592->lock);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592_queue(m66592->gadget.ep0, m66592->ep0_req, GFP_KERNEL);
|
2007-07-17 19:01:17 +07:00
|
|
|
spin_lock(&m66592->lock);
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
static void clear_feature(struct m66592 *m66592, struct usb_ctrlrequest *ctrl)
|
|
|
|
{
|
|
|
|
switch (ctrl->bRequestType & USB_RECIP_MASK) {
|
|
|
|
case USB_RECIP_DEVICE:
|
|
|
|
control_end(m66592, 1);
|
|
|
|
break;
|
|
|
|
case USB_RECIP_INTERFACE:
|
|
|
|
control_end(m66592, 1);
|
|
|
|
break;
|
|
|
|
case USB_RECIP_ENDPOINT: {
|
|
|
|
struct m66592_ep *ep;
|
|
|
|
struct m66592_request *req;
|
2007-07-17 19:01:17 +07:00
|
|
|
u16 w_index = le16_to_cpu(ctrl->wIndex);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
2007-07-17 19:01:17 +07:00
|
|
|
ep = m66592->epaddr2ep[w_index & USB_ENDPOINT_NUMBER_MASK];
|
2007-05-10 11:18:23 +07:00
|
|
|
pipe_stop(m66592, ep->pipenum);
|
|
|
|
control_reg_sqclr(m66592, ep->pipenum);
|
|
|
|
|
|
|
|
control_end(m66592, 1);
|
|
|
|
|
|
|
|
req = list_entry(ep->queue.next,
|
|
|
|
struct m66592_request, queue);
|
|
|
|
if (ep->busy) {
|
|
|
|
ep->busy = 0;
|
|
|
|
if (list_empty(&ep->queue))
|
|
|
|
break;
|
|
|
|
start_packet(ep, req);
|
|
|
|
} else if (!list_empty(&ep->queue))
|
|
|
|
pipe_start(m66592, ep->pipenum);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
pipe_stall(m66592, 0);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void set_feature(struct m66592 *m66592, struct usb_ctrlrequest *ctrl)
|
|
|
|
{
|
2011-07-08 12:51:33 +07:00
|
|
|
u16 tmp;
|
|
|
|
int timeout = 3000;
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
switch (ctrl->bRequestType & USB_RECIP_MASK) {
|
|
|
|
case USB_RECIP_DEVICE:
|
2011-07-08 12:51:33 +07:00
|
|
|
switch (le16_to_cpu(ctrl->wValue)) {
|
|
|
|
case USB_DEVICE_TEST_MODE:
|
|
|
|
control_end(m66592, 1);
|
|
|
|
/* Wait for the completion of status stage */
|
|
|
|
do {
|
|
|
|
tmp = m66592_read(m66592, M66592_INTSTS0) &
|
|
|
|
M66592_CTSQ;
|
|
|
|
udelay(1);
|
2015-07-30 04:30:58 +07:00
|
|
|
} while (tmp != M66592_CS_IDST && timeout-- > 0);
|
2011-07-08 12:51:33 +07:00
|
|
|
|
|
|
|
if (tmp == M66592_CS_IDST)
|
|
|
|
m66592_bset(m66592,
|
|
|
|
le16_to_cpu(ctrl->wIndex >> 8),
|
|
|
|
M66592_TESTMODE);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
pipe_stall(m66592, 0);
|
|
|
|
break;
|
|
|
|
}
|
2007-05-10 11:18:23 +07:00
|
|
|
break;
|
|
|
|
case USB_RECIP_INTERFACE:
|
|
|
|
control_end(m66592, 1);
|
|
|
|
break;
|
|
|
|
case USB_RECIP_ENDPOINT: {
|
|
|
|
struct m66592_ep *ep;
|
2007-07-17 19:01:17 +07:00
|
|
|
u16 w_index = le16_to_cpu(ctrl->wIndex);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
2007-07-17 19:01:17 +07:00
|
|
|
ep = m66592->epaddr2ep[w_index & USB_ENDPOINT_NUMBER_MASK];
|
2007-05-10 11:18:23 +07:00
|
|
|
pipe_stall(m66592, ep->pipenum);
|
|
|
|
|
|
|
|
control_end(m66592, 1);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
pipe_stall(m66592, 0);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* if return value is true, call class driver's setup() */
|
|
|
|
static int setup_packet(struct m66592 *m66592, struct usb_ctrlrequest *ctrl)
|
|
|
|
{
|
|
|
|
u16 *p = (u16 *)ctrl;
|
|
|
|
unsigned long offset = M66592_USBREQ;
|
|
|
|
int i, ret = 0;
|
|
|
|
|
|
|
|
/* read fifo */
|
|
|
|
m66592_write(m66592, ~M66592_VALID, M66592_INTSTS0);
|
|
|
|
|
|
|
|
for (i = 0; i < 4; i++)
|
|
|
|
p[i] = m66592_read(m66592, offset + i*2);
|
|
|
|
|
|
|
|
/* check request */
|
|
|
|
if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) {
|
|
|
|
switch (ctrl->bRequest) {
|
|
|
|
case USB_REQ_GET_STATUS:
|
|
|
|
get_status(m66592, ctrl);
|
|
|
|
break;
|
|
|
|
case USB_REQ_CLEAR_FEATURE:
|
|
|
|
clear_feature(m66592, ctrl);
|
|
|
|
break;
|
|
|
|
case USB_REQ_SET_FEATURE:
|
|
|
|
set_feature(m66592, ctrl);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
ret = 1;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
} else
|
|
|
|
ret = 1;
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void m66592_update_usb_speed(struct m66592 *m66592)
|
|
|
|
{
|
|
|
|
u16 speed = get_usb_speed(m66592);
|
|
|
|
|
|
|
|
switch (speed) {
|
|
|
|
case M66592_HSMODE:
|
|
|
|
m66592->gadget.speed = USB_SPEED_HIGH;
|
|
|
|
break;
|
|
|
|
case M66592_FSMODE:
|
|
|
|
m66592->gadget.speed = USB_SPEED_FULL;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
m66592->gadget.speed = USB_SPEED_UNKNOWN;
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("USB speed unknown\n");
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void irq_device_state(struct m66592 *m66592)
|
|
|
|
{
|
|
|
|
u16 dvsq;
|
|
|
|
|
|
|
|
dvsq = m66592_read(m66592, M66592_INTSTS0) & M66592_DVSQ;
|
|
|
|
m66592_write(m66592, ~M66592_DVST, M66592_INTSTS0);
|
|
|
|
|
|
|
|
if (dvsq == M66592_DS_DFLT) { /* bus reset */
|
2014-11-06 13:28:00 +07:00
|
|
|
usb_gadget_udc_reset(&m66592->gadget, m66592->driver);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592_update_usb_speed(m66592);
|
|
|
|
}
|
|
|
|
if (m66592->old_dvsq == M66592_DS_CNFG && dvsq != M66592_DS_CNFG)
|
|
|
|
m66592_update_usb_speed(m66592);
|
2007-07-17 19:01:17 +07:00
|
|
|
if ((dvsq == M66592_DS_CNFG || dvsq == M66592_DS_ADDS)
|
|
|
|
&& m66592->gadget.speed == USB_SPEED_UNKNOWN)
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592_update_usb_speed(m66592);
|
|
|
|
|
|
|
|
m66592->old_dvsq = dvsq;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void irq_control_stage(struct m66592 *m66592)
|
2007-07-17 19:01:17 +07:00
|
|
|
__releases(m66592->lock)
|
|
|
|
__acquires(m66592->lock)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
|
|
|
struct usb_ctrlrequest ctrl;
|
|
|
|
u16 ctsq;
|
|
|
|
|
|
|
|
ctsq = m66592_read(m66592, M66592_INTSTS0) & M66592_CTSQ;
|
|
|
|
m66592_write(m66592, ~M66592_CTRT, M66592_INTSTS0);
|
|
|
|
|
|
|
|
switch (ctsq) {
|
|
|
|
case M66592_CS_IDST: {
|
|
|
|
struct m66592_ep *ep;
|
|
|
|
struct m66592_request *req;
|
|
|
|
ep = &m66592->ep[0];
|
|
|
|
req = list_entry(ep->queue.next, struct m66592_request, queue);
|
|
|
|
transfer_complete(ep, req, 0);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case M66592_CS_RDDS:
|
|
|
|
case M66592_CS_WRDS:
|
|
|
|
case M66592_CS_WRND:
|
|
|
|
if (setup_packet(m66592, &ctrl)) {
|
2007-07-17 19:01:17 +07:00
|
|
|
spin_unlock(&m66592->lock);
|
2007-05-10 11:18:23 +07:00
|
|
|
if (m66592->driver->setup(&m66592->gadget, &ctrl) < 0)
|
|
|
|
pipe_stall(m66592, 0);
|
2007-07-17 19:01:17 +07:00
|
|
|
spin_lock(&m66592->lock);
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
case M66592_CS_RDSS:
|
|
|
|
case M66592_CS_WRSS:
|
|
|
|
control_end(m66592, 0);
|
|
|
|
break;
|
|
|
|
default:
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("ctrl_stage: unexpect ctsq(%x)\n", ctsq);
|
2007-05-10 11:18:23 +07:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static irqreturn_t m66592_irq(int irq, void *_m66592)
|
|
|
|
{
|
|
|
|
struct m66592 *m66592 = _m66592;
|
|
|
|
u16 intsts0;
|
|
|
|
u16 intenb0;
|
|
|
|
u16 savepipe;
|
|
|
|
u16 mask0;
|
|
|
|
|
2007-07-17 19:01:17 +07:00
|
|
|
spin_lock(&m66592->lock);
|
|
|
|
|
2007-05-10 11:18:23 +07:00
|
|
|
intsts0 = m66592_read(m66592, M66592_INTSTS0);
|
|
|
|
intenb0 = m66592_read(m66592, M66592_INTENB0);
|
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
if (m66592->pdata->on_chip && !intsts0 && !intenb0) {
|
2007-11-22 19:00:30 +07:00
|
|
|
/*
|
|
|
|
* When USB clock stops, it cannot read register. Even if a
|
|
|
|
* clock stops, the interrupt occurs. So this driver turn on
|
|
|
|
* a clock by this timing and do re-reading of register.
|
|
|
|
*/
|
|
|
|
m66592_start_xclock(m66592);
|
|
|
|
intsts0 = m66592_read(m66592, M66592_INTSTS0);
|
|
|
|
intenb0 = m66592_read(m66592, M66592_INTENB0);
|
|
|
|
}
|
|
|
|
|
2007-05-10 11:18:23 +07:00
|
|
|
savepipe = m66592_read(m66592, M66592_CFIFOSEL);
|
|
|
|
|
|
|
|
mask0 = intsts0 & intenb0;
|
|
|
|
if (mask0) {
|
2016-05-31 19:17:22 +07:00
|
|
|
u16 brdysts = m66592_read(m66592, M66592_BRDYSTS);
|
|
|
|
u16 bempsts = m66592_read(m66592, M66592_BEMPSTS);
|
|
|
|
u16 brdyenb = m66592_read(m66592, M66592_BRDYENB);
|
|
|
|
u16 bempenb = m66592_read(m66592, M66592_BEMPENB);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
if (mask0 & M66592_VBINT) {
|
2007-07-17 19:01:17 +07:00
|
|
|
m66592_write(m66592, 0xffff & ~M66592_VBINT,
|
|
|
|
M66592_INTSTS0);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592_start_xclock(m66592);
|
|
|
|
|
|
|
|
/* start vbus sampling */
|
|
|
|
m66592->old_vbus = m66592_read(m66592, M66592_INTSTS0)
|
2007-07-17 19:01:17 +07:00
|
|
|
& M66592_VBSTS;
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592->scount = M66592_MAX_SAMPLING;
|
|
|
|
|
|
|
|
mod_timer(&m66592->timer,
|
2007-07-17 19:01:17 +07:00
|
|
|
jiffies + msecs_to_jiffies(50));
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
if (intsts0 & M66592_DVSQ)
|
|
|
|
irq_device_state(m66592);
|
|
|
|
|
2007-07-17 19:01:17 +07:00
|
|
|
if ((intsts0 & M66592_BRDY) && (intenb0 & M66592_BRDYE)
|
|
|
|
&& (brdysts & brdyenb)) {
|
2007-05-10 11:18:23 +07:00
|
|
|
irq_pipe_ready(m66592, brdysts, brdyenb);
|
|
|
|
}
|
2007-07-17 19:01:17 +07:00
|
|
|
if ((intsts0 & M66592_BEMP) && (intenb0 & M66592_BEMPE)
|
|
|
|
&& (bempsts & bempenb)) {
|
2007-05-10 11:18:23 +07:00
|
|
|
irq_pipe_empty(m66592, bempsts, bempenb);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (intsts0 & M66592_CTRT)
|
|
|
|
irq_control_stage(m66592);
|
|
|
|
}
|
|
|
|
|
|
|
|
m66592_write(m66592, savepipe, M66592_CFIFOSEL);
|
|
|
|
|
2007-07-17 19:01:17 +07:00
|
|
|
spin_unlock(&m66592->lock);
|
2007-05-10 11:18:23 +07:00
|
|
|
return IRQ_HANDLED;
|
|
|
|
}
|
|
|
|
|
treewide: setup_timer() -> timer_setup()
This converts all remaining cases of the old setup_timer() API into using
timer_setup(), where the callback argument is the structure already
holding the struct timer_list. These should have no behavioral changes,
since they just change which pointer is passed into the callback with
the same available pointers after conversion. It handles the following
examples, in addition to some other variations.
Casting from unsigned long:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
setup_timer(&ptr->my_timer, my_callback, ptr);
and forced object casts:
void my_callback(struct something *ptr)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, (unsigned long)ptr);
become:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
Direct function assignments:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
ptr->my_timer.function = my_callback;
have a temporary cast added, along with converting the args:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
ptr->my_timer.function = (TIMER_FUNC_TYPE)my_callback;
And finally, callbacks without a data assignment:
void my_callback(unsigned long data)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, 0);
have their argument renamed to verify they're unused during conversion:
void my_callback(struct timer_list *unused)
{
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
The conversion is done with the following Coccinelle script:
spatch --very-quiet --all-includes --include-headers \
-I ./arch/x86/include -I ./arch/x86/include/generated \
-I ./include -I ./arch/x86/include/uapi \
-I ./arch/x86/include/generated/uapi -I ./include/uapi \
-I ./include/generated/uapi --include ./include/linux/kconfig.h \
--dir . \
--cocci-file ~/src/data/timer_setup.cocci
@fix_address_of@
expression e;
@@
setup_timer(
-&(e)
+&e
, ...)
// Update any raw setup_timer() usages that have a NULL callback, but
// would otherwise match change_timer_function_usage, since the latter
// will update all function assignments done in the face of a NULL
// function initialization in setup_timer().
@change_timer_function_usage_NULL@
expression _E;
identifier _timer;
type _cast_data;
@@
(
-setup_timer(&_E->_timer, NULL, _E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E->_timer, NULL, (_cast_data)_E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, &_E);
+timer_setup(&_E._timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, (_cast_data)&_E);
+timer_setup(&_E._timer, NULL, 0);
)
@change_timer_function_usage@
expression _E;
identifier _timer;
struct timer_list _stl;
identifier _callback;
type _cast_func, _cast_data;
@@
(
-setup_timer(&_E->_timer, _callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
_E->_timer@_stl.function = _callback;
|
_E->_timer@_stl.function = &_callback;
|
_E->_timer@_stl.function = (_cast_func)_callback;
|
_E->_timer@_stl.function = (_cast_func)&_callback;
|
_E._timer@_stl.function = _callback;
|
_E._timer@_stl.function = &_callback;
|
_E._timer@_stl.function = (_cast_func)_callback;
|
_E._timer@_stl.function = (_cast_func)&_callback;
)
// callback(unsigned long arg)
@change_callback_handle_cast
depends on change_timer_function_usage@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
identifier _handle;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
(
... when != _origarg
_handletype *_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
)
}
// callback(unsigned long arg) without existing variable
@change_callback_handle_cast_no_arg
depends on change_timer_function_usage &&
!change_callback_handle_cast@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
+ _handletype *_origarg = from_timer(_origarg, t, _timer);
+
... when != _origarg
- (_handletype *)_origarg
+ _origarg
... when != _origarg
}
// Avoid already converted callbacks.
@match_callback_converted
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier t;
@@
void _callback(struct timer_list *t)
{ ... }
// callback(struct something *handle)
@change_callback_handle_arg
depends on change_timer_function_usage &&
!match_callback_converted &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
@@
void _callback(
-_handletype *_handle
+struct timer_list *t
)
{
+ _handletype *_handle = from_timer(_handle, t, _timer);
...
}
// If change_callback_handle_arg ran on an empty function, remove
// the added handler.
@unchange_callback_handle_arg
depends on change_timer_function_usage &&
change_callback_handle_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
identifier t;
@@
void _callback(struct timer_list *t)
{
- _handletype *_handle = from_timer(_handle, t, _timer);
}
// We only want to refactor the setup_timer() data argument if we've found
// the matching callback. This undoes changes in change_timer_function_usage.
@unchange_timer_function_usage
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg &&
!change_callback_handle_arg@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type change_timer_function_usage._cast_data;
@@
(
-timer_setup(&_E->_timer, _callback, 0);
+setup_timer(&_E->_timer, _callback, (_cast_data)_E);
|
-timer_setup(&_E._timer, _callback, 0);
+setup_timer(&_E._timer, _callback, (_cast_data)&_E);
)
// If we fixed a callback from a .function assignment, fix the
// assignment cast now.
@change_timer_function_assignment
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_func;
typedef TIMER_FUNC_TYPE;
@@
(
_E->_timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-&_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
)
// Sometimes timer functions are called directly. Replace matched args.
@change_timer_function_calls
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression _E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_data;
@@
_callback(
(
-(_cast_data)_E
+&_E->_timer
|
-(_cast_data)&_E
+&_E._timer
|
-_E
+&_E->_timer
)
)
// If a timer has been configured without a data argument, it can be
// converted without regard to the callback argument, since it is unused.
@match_timer_function_unused_data@
expression _E;
identifier _timer;
identifier _callback;
@@
(
-setup_timer(&_E->_timer, _callback, 0);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0L);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0UL);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0L);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0UL);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0L);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0UL);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0L);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0UL);
+timer_setup(_timer, _callback, 0);
)
@change_callback_unused_data
depends on match_timer_function_unused_data@
identifier match_timer_function_unused_data._callback;
type _origtype;
identifier _origarg;
@@
void _callback(
-_origtype _origarg
+struct timer_list *unused
)
{
... when != _origarg
}
Signed-off-by: Kees Cook <keescook@chromium.org>
2017-10-17 04:43:17 +07:00
|
|
|
static void m66592_timer(struct timer_list *t)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
treewide: setup_timer() -> timer_setup()
This converts all remaining cases of the old setup_timer() API into using
timer_setup(), where the callback argument is the structure already
holding the struct timer_list. These should have no behavioral changes,
since they just change which pointer is passed into the callback with
the same available pointers after conversion. It handles the following
examples, in addition to some other variations.
Casting from unsigned long:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
setup_timer(&ptr->my_timer, my_callback, ptr);
and forced object casts:
void my_callback(struct something *ptr)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, (unsigned long)ptr);
become:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
Direct function assignments:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
ptr->my_timer.function = my_callback;
have a temporary cast added, along with converting the args:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
ptr->my_timer.function = (TIMER_FUNC_TYPE)my_callback;
And finally, callbacks without a data assignment:
void my_callback(unsigned long data)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, 0);
have their argument renamed to verify they're unused during conversion:
void my_callback(struct timer_list *unused)
{
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
The conversion is done with the following Coccinelle script:
spatch --very-quiet --all-includes --include-headers \
-I ./arch/x86/include -I ./arch/x86/include/generated \
-I ./include -I ./arch/x86/include/uapi \
-I ./arch/x86/include/generated/uapi -I ./include/uapi \
-I ./include/generated/uapi --include ./include/linux/kconfig.h \
--dir . \
--cocci-file ~/src/data/timer_setup.cocci
@fix_address_of@
expression e;
@@
setup_timer(
-&(e)
+&e
, ...)
// Update any raw setup_timer() usages that have a NULL callback, but
// would otherwise match change_timer_function_usage, since the latter
// will update all function assignments done in the face of a NULL
// function initialization in setup_timer().
@change_timer_function_usage_NULL@
expression _E;
identifier _timer;
type _cast_data;
@@
(
-setup_timer(&_E->_timer, NULL, _E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E->_timer, NULL, (_cast_data)_E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, &_E);
+timer_setup(&_E._timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, (_cast_data)&_E);
+timer_setup(&_E._timer, NULL, 0);
)
@change_timer_function_usage@
expression _E;
identifier _timer;
struct timer_list _stl;
identifier _callback;
type _cast_func, _cast_data;
@@
(
-setup_timer(&_E->_timer, _callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
_E->_timer@_stl.function = _callback;
|
_E->_timer@_stl.function = &_callback;
|
_E->_timer@_stl.function = (_cast_func)_callback;
|
_E->_timer@_stl.function = (_cast_func)&_callback;
|
_E._timer@_stl.function = _callback;
|
_E._timer@_stl.function = &_callback;
|
_E._timer@_stl.function = (_cast_func)_callback;
|
_E._timer@_stl.function = (_cast_func)&_callback;
)
// callback(unsigned long arg)
@change_callback_handle_cast
depends on change_timer_function_usage@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
identifier _handle;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
(
... when != _origarg
_handletype *_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
)
}
// callback(unsigned long arg) without existing variable
@change_callback_handle_cast_no_arg
depends on change_timer_function_usage &&
!change_callback_handle_cast@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
+ _handletype *_origarg = from_timer(_origarg, t, _timer);
+
... when != _origarg
- (_handletype *)_origarg
+ _origarg
... when != _origarg
}
// Avoid already converted callbacks.
@match_callback_converted
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier t;
@@
void _callback(struct timer_list *t)
{ ... }
// callback(struct something *handle)
@change_callback_handle_arg
depends on change_timer_function_usage &&
!match_callback_converted &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
@@
void _callback(
-_handletype *_handle
+struct timer_list *t
)
{
+ _handletype *_handle = from_timer(_handle, t, _timer);
...
}
// If change_callback_handle_arg ran on an empty function, remove
// the added handler.
@unchange_callback_handle_arg
depends on change_timer_function_usage &&
change_callback_handle_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
identifier t;
@@
void _callback(struct timer_list *t)
{
- _handletype *_handle = from_timer(_handle, t, _timer);
}
// We only want to refactor the setup_timer() data argument if we've found
// the matching callback. This undoes changes in change_timer_function_usage.
@unchange_timer_function_usage
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg &&
!change_callback_handle_arg@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type change_timer_function_usage._cast_data;
@@
(
-timer_setup(&_E->_timer, _callback, 0);
+setup_timer(&_E->_timer, _callback, (_cast_data)_E);
|
-timer_setup(&_E._timer, _callback, 0);
+setup_timer(&_E._timer, _callback, (_cast_data)&_E);
)
// If we fixed a callback from a .function assignment, fix the
// assignment cast now.
@change_timer_function_assignment
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_func;
typedef TIMER_FUNC_TYPE;
@@
(
_E->_timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-&_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
)
// Sometimes timer functions are called directly. Replace matched args.
@change_timer_function_calls
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression _E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_data;
@@
_callback(
(
-(_cast_data)_E
+&_E->_timer
|
-(_cast_data)&_E
+&_E._timer
|
-_E
+&_E->_timer
)
)
// If a timer has been configured without a data argument, it can be
// converted without regard to the callback argument, since it is unused.
@match_timer_function_unused_data@
expression _E;
identifier _timer;
identifier _callback;
@@
(
-setup_timer(&_E->_timer, _callback, 0);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0L);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0UL);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0L);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0UL);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0L);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0UL);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0L);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0UL);
+timer_setup(_timer, _callback, 0);
)
@change_callback_unused_data
depends on match_timer_function_unused_data@
identifier match_timer_function_unused_data._callback;
type _origtype;
identifier _origarg;
@@
void _callback(
-_origtype _origarg
+struct timer_list *unused
)
{
... when != _origarg
}
Signed-off-by: Kees Cook <keescook@chromium.org>
2017-10-17 04:43:17 +07:00
|
|
|
struct m66592 *m66592 = from_timer(m66592, t, timer);
|
2007-05-10 11:18:23 +07:00
|
|
|
unsigned long flags;
|
|
|
|
u16 tmp;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&m66592->lock, flags);
|
|
|
|
tmp = m66592_read(m66592, M66592_SYSCFG);
|
|
|
|
if (!(tmp & M66592_RCKE)) {
|
|
|
|
m66592_bset(m66592, M66592_RCKE | M66592_PLLC, M66592_SYSCFG);
|
|
|
|
udelay(10);
|
|
|
|
m66592_bset(m66592, M66592_SCKE, M66592_SYSCFG);
|
|
|
|
}
|
|
|
|
if (m66592->scount > 0) {
|
|
|
|
tmp = m66592_read(m66592, M66592_INTSTS0) & M66592_VBSTS;
|
|
|
|
if (tmp == m66592->old_vbus) {
|
|
|
|
m66592->scount--;
|
|
|
|
if (m66592->scount == 0) {
|
|
|
|
if (tmp == M66592_VBSTS)
|
|
|
|
m66592_usb_connect(m66592);
|
|
|
|
else
|
|
|
|
m66592_usb_disconnect(m66592);
|
|
|
|
} else {
|
|
|
|
mod_timer(&m66592->timer,
|
2007-07-17 19:01:17 +07:00
|
|
|
jiffies + msecs_to_jiffies(50));
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
} else {
|
|
|
|
m66592->scount = M66592_MAX_SAMPLING;
|
|
|
|
m66592->old_vbus = tmp;
|
|
|
|
mod_timer(&m66592->timer,
|
2007-07-17 19:01:17 +07:00
|
|
|
jiffies + msecs_to_jiffies(50));
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore(&m66592->lock, flags);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
static int m66592_enable(struct usb_ep *_ep,
|
|
|
|
const struct usb_endpoint_descriptor *desc)
|
|
|
|
{
|
|
|
|
struct m66592_ep *ep;
|
|
|
|
|
|
|
|
ep = container_of(_ep, struct m66592_ep, ep);
|
|
|
|
return alloc_pipe_config(ep, desc);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int m66592_disable(struct usb_ep *_ep)
|
|
|
|
{
|
|
|
|
struct m66592_ep *ep;
|
|
|
|
struct m66592_request *req;
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
ep = container_of(_ep, struct m66592_ep, ep);
|
|
|
|
BUG_ON(!ep);
|
|
|
|
|
|
|
|
while (!list_empty(&ep->queue)) {
|
|
|
|
req = list_entry(ep->queue.next, struct m66592_request, queue);
|
|
|
|
spin_lock_irqsave(&ep->m66592->lock, flags);
|
|
|
|
transfer_complete(ep, req, -ECONNRESET);
|
|
|
|
spin_unlock_irqrestore(&ep->m66592->lock, flags);
|
|
|
|
}
|
|
|
|
|
|
|
|
pipe_irq_disable(ep->m66592, ep->pipenum);
|
|
|
|
return free_pipe_config(ep);
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct usb_request *m66592_alloc_request(struct usb_ep *_ep,
|
|
|
|
gfp_t gfp_flags)
|
|
|
|
{
|
|
|
|
struct m66592_request *req;
|
|
|
|
|
|
|
|
req = kzalloc(sizeof(struct m66592_request), gfp_flags);
|
|
|
|
if (!req)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
INIT_LIST_HEAD(&req->queue);
|
|
|
|
|
|
|
|
return &req->req;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void m66592_free_request(struct usb_ep *_ep, struct usb_request *_req)
|
|
|
|
{
|
|
|
|
struct m66592_request *req;
|
|
|
|
|
|
|
|
req = container_of(_req, struct m66592_request, req);
|
|
|
|
kfree(req);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int m66592_queue(struct usb_ep *_ep, struct usb_request *_req,
|
|
|
|
gfp_t gfp_flags)
|
|
|
|
{
|
|
|
|
struct m66592_ep *ep;
|
|
|
|
struct m66592_request *req;
|
|
|
|
unsigned long flags;
|
|
|
|
int request = 0;
|
|
|
|
|
|
|
|
ep = container_of(_ep, struct m66592_ep, ep);
|
|
|
|
req = container_of(_req, struct m66592_request, req);
|
|
|
|
|
|
|
|
if (ep->m66592->gadget.speed == USB_SPEED_UNKNOWN)
|
|
|
|
return -ESHUTDOWN;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&ep->m66592->lock, flags);
|
|
|
|
|
|
|
|
if (list_empty(&ep->queue))
|
|
|
|
request = 1;
|
|
|
|
|
|
|
|
list_add_tail(&req->queue, &ep->queue);
|
|
|
|
req->req.actual = 0;
|
|
|
|
req->req.status = -EINPROGRESS;
|
|
|
|
|
2012-03-13 01:25:33 +07:00
|
|
|
if (ep->ep.desc == NULL) /* control */
|
2007-05-10 11:18:23 +07:00
|
|
|
start_ep0(ep, req);
|
|
|
|
else {
|
|
|
|
if (request && !ep->busy)
|
|
|
|
start_packet(ep, req);
|
|
|
|
}
|
|
|
|
|
|
|
|
spin_unlock_irqrestore(&ep->m66592->lock, flags);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int m66592_dequeue(struct usb_ep *_ep, struct usb_request *_req)
|
|
|
|
{
|
|
|
|
struct m66592_ep *ep;
|
|
|
|
struct m66592_request *req;
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
ep = container_of(_ep, struct m66592_ep, ep);
|
|
|
|
req = container_of(_req, struct m66592_request, req);
|
|
|
|
|
|
|
|
spin_lock_irqsave(&ep->m66592->lock, flags);
|
|
|
|
if (!list_empty(&ep->queue))
|
|
|
|
transfer_complete(ep, req, -ECONNRESET);
|
|
|
|
spin_unlock_irqrestore(&ep->m66592->lock, flags);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int m66592_set_halt(struct usb_ep *_ep, int value)
|
|
|
|
{
|
2016-05-31 19:17:22 +07:00
|
|
|
struct m66592_ep *ep = container_of(_ep, struct m66592_ep, ep);
|
2007-05-10 11:18:23 +07:00
|
|
|
unsigned long flags;
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&ep->m66592->lock, flags);
|
|
|
|
if (!list_empty(&ep->queue)) {
|
|
|
|
ret = -EAGAIN;
|
2016-05-31 19:17:22 +07:00
|
|
|
} else if (value) {
|
2007-05-10 11:18:23 +07:00
|
|
|
ep->busy = 1;
|
|
|
|
pipe_stall(ep->m66592, ep->pipenum);
|
|
|
|
} else {
|
|
|
|
ep->busy = 0;
|
|
|
|
pipe_stop(ep->m66592, ep->pipenum);
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore(&ep->m66592->lock, flags);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void m66592_fifo_flush(struct usb_ep *_ep)
|
|
|
|
{
|
|
|
|
struct m66592_ep *ep;
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
ep = container_of(_ep, struct m66592_ep, ep);
|
|
|
|
spin_lock_irqsave(&ep->m66592->lock, flags);
|
|
|
|
if (list_empty(&ep->queue) && !ep->busy) {
|
|
|
|
pipe_stop(ep->m66592, ep->pipenum);
|
|
|
|
m66592_bclr(ep->m66592, M66592_BCLR, ep->fifoctr);
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore(&ep->m66592->lock, flags);
|
|
|
|
}
|
|
|
|
|
2017-01-24 00:26:04 +07:00
|
|
|
static const struct usb_ep_ops m66592_ep_ops = {
|
2007-05-10 11:18:23 +07:00
|
|
|
.enable = m66592_enable,
|
|
|
|
.disable = m66592_disable,
|
|
|
|
|
|
|
|
.alloc_request = m66592_alloc_request,
|
|
|
|
.free_request = m66592_free_request,
|
|
|
|
|
|
|
|
.queue = m66592_queue,
|
|
|
|
.dequeue = m66592_dequeue,
|
|
|
|
|
|
|
|
.set_halt = m66592_set_halt,
|
|
|
|
.fifo_flush = m66592_fifo_flush,
|
|
|
|
};
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
2013-01-24 15:49:17 +07:00
|
|
|
static int m66592_udc_start(struct usb_gadget *g,
|
|
|
|
struct usb_gadget_driver *driver)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
2013-01-24 15:49:17 +07:00
|
|
|
struct m66592 *m66592 = to_m66592(g);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
/* hook up the driver */
|
|
|
|
driver->driver.bus = NULL;
|
|
|
|
m66592->driver = driver;
|
|
|
|
|
|
|
|
m66592_bset(m66592, M66592_VBSE | M66592_URST, M66592_INTENB0);
|
|
|
|
if (m66592_read(m66592, M66592_INTSTS0) & M66592_VBSTS) {
|
|
|
|
m66592_start_xclock(m66592);
|
|
|
|
/* start vbus sampling */
|
|
|
|
m66592->old_vbus = m66592_read(m66592,
|
|
|
|
M66592_INTSTS0) & M66592_VBSTS;
|
|
|
|
m66592->scount = M66592_MAX_SAMPLING;
|
2007-07-17 19:01:17 +07:00
|
|
|
mod_timer(&m66592->timer, jiffies + msecs_to_jiffies(50));
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-10-18 00:05:12 +07:00
|
|
|
static int m66592_udc_stop(struct usb_gadget *g)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
2013-01-24 15:49:17 +07:00
|
|
|
struct m66592 *m66592 = to_m66592(g);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
m66592_bclr(m66592, M66592_VBSE | M66592_URST, M66592_INTENB0);
|
|
|
|
|
|
|
|
init_controller(m66592);
|
|
|
|
disable_controller(m66592);
|
|
|
|
|
|
|
|
m66592->driver = NULL;
|
2013-01-24 15:49:17 +07:00
|
|
|
|
2007-05-10 11:18:23 +07:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
static int m66592_get_frame(struct usb_gadget *_gadget)
|
|
|
|
{
|
|
|
|
struct m66592 *m66592 = gadget_to_m66592(_gadget);
|
|
|
|
return m66592_read(m66592, M66592_FRMNUM) & 0x03FF;
|
|
|
|
}
|
|
|
|
|
2011-07-07 07:58:50 +07:00
|
|
|
static int m66592_pullup(struct usb_gadget *gadget, int is_on)
|
|
|
|
{
|
|
|
|
struct m66592 *m66592 = gadget_to_m66592(gadget);
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
spin_lock_irqsave(&m66592->lock, flags);
|
|
|
|
if (is_on)
|
|
|
|
m66592_bset(m66592, M66592_DPRPU, M66592_SYSCFG);
|
|
|
|
else
|
|
|
|
m66592_bclr(m66592, M66592_DPRPU, M66592_SYSCFG);
|
|
|
|
spin_unlock_irqrestore(&m66592->lock, flags);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2013-01-24 22:58:16 +07:00
|
|
|
static const struct usb_gadget_ops m66592_gadget_ops = {
|
2007-05-10 11:18:23 +07:00
|
|
|
.get_frame = m66592_get_frame,
|
2013-01-24 15:49:17 +07:00
|
|
|
.udc_start = m66592_udc_start,
|
|
|
|
.udc_stop = m66592_udc_stop,
|
2011-07-07 07:58:50 +07:00
|
|
|
.pullup = m66592_pullup,
|
2007-05-10 11:18:23 +07:00
|
|
|
};
|
|
|
|
|
2015-04-11 05:14:21 +07:00
|
|
|
static int m66592_remove(struct platform_device *pdev)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
2013-05-23 17:19:22 +07:00
|
|
|
struct m66592 *m66592 = platform_get_drvdata(pdev);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
2011-06-28 20:33:47 +07:00
|
|
|
usb_del_gadget_udc(&m66592->gadget);
|
|
|
|
|
2007-05-10 11:18:23 +07:00
|
|
|
del_timer_sync(&m66592->timer);
|
|
|
|
iounmap(m66592->reg);
|
|
|
|
free_irq(platform_get_irq(pdev, 0), m66592);
|
2007-07-17 19:01:17 +07:00
|
|
|
m66592_free_request(&m66592->ep[0].ep, m66592->ep0_req);
|
2009-07-22 21:41:35 +07:00
|
|
|
if (m66592->pdata->on_chip) {
|
|
|
|
clk_disable(m66592->clk);
|
|
|
|
clk_put(m66592->clk);
|
|
|
|
}
|
2007-05-10 11:18:23 +07:00
|
|
|
kfree(m66592);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2007-07-17 19:01:17 +07:00
|
|
|
static void nop_completion(struct usb_ep *ep, struct usb_request *r)
|
|
|
|
{
|
|
|
|
}
|
|
|
|
|
2014-05-18 14:19:05 +07:00
|
|
|
static int m66592_probe(struct platform_device *pdev)
|
2007-05-10 11:18:23 +07:00
|
|
|
{
|
2009-07-22 21:41:35 +07:00
|
|
|
struct resource *res, *ires;
|
2007-05-10 11:18:23 +07:00
|
|
|
void __iomem *reg = NULL;
|
|
|
|
struct m66592 *m66592 = NULL;
|
2008-10-31 18:22:13 +07:00
|
|
|
char clk_name[8];
|
2007-05-10 11:18:23 +07:00
|
|
|
int ret = 0;
|
|
|
|
int i;
|
|
|
|
|
2008-11-13 13:46:37 +07:00
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
2007-05-10 11:18:23 +07:00
|
|
|
if (!res) {
|
|
|
|
ret = -ENODEV;
|
2008-11-13 13:46:37 +07:00
|
|
|
pr_err("platform_get_resource error.\n");
|
2007-05-10 11:18:23 +07:00
|
|
|
goto clean_up;
|
|
|
|
}
|
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
ires = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
|
|
|
|
if (!ires) {
|
2007-05-10 11:18:23 +07:00
|
|
|
ret = -ENODEV;
|
2009-07-22 21:41:35 +07:00
|
|
|
dev_err(&pdev->dev,
|
|
|
|
"platform_get_resource IORESOURCE_IRQ error.\n");
|
2007-05-10 11:18:23 +07:00
|
|
|
goto clean_up;
|
|
|
|
}
|
|
|
|
|
2008-11-13 13:46:37 +07:00
|
|
|
reg = ioremap(res->start, resource_size(res));
|
2007-05-10 11:18:23 +07:00
|
|
|
if (reg == NULL) {
|
|
|
|
ret = -ENOMEM;
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("ioremap error.\n");
|
2007-05-10 11:18:23 +07:00
|
|
|
goto clean_up;
|
|
|
|
}
|
|
|
|
|
2013-07-30 15:00:51 +07:00
|
|
|
if (dev_get_platdata(&pdev->dev) == NULL) {
|
2009-07-22 21:41:35 +07:00
|
|
|
dev_err(&pdev->dev, "no platform data\n");
|
|
|
|
ret = -ENODEV;
|
|
|
|
goto clean_up;
|
|
|
|
}
|
|
|
|
|
2007-05-10 11:18:23 +07:00
|
|
|
/* initialize ucd */
|
|
|
|
m66592 = kzalloc(sizeof(struct m66592), GFP_KERNEL);
|
|
|
|
if (m66592 == NULL) {
|
2010-08-11 17:10:48 +07:00
|
|
|
ret = -ENOMEM;
|
2007-05-10 11:18:23 +07:00
|
|
|
goto clean_up;
|
|
|
|
}
|
|
|
|
|
2013-07-30 15:00:51 +07:00
|
|
|
m66592->pdata = dev_get_platdata(&pdev->dev);
|
2009-07-22 21:41:35 +07:00
|
|
|
m66592->irq_trigger = ires->flags & IRQF_TRIGGER_MASK;
|
|
|
|
|
2007-05-10 11:18:23 +07:00
|
|
|
spin_lock_init(&m66592->lock);
|
2013-05-23 17:19:22 +07:00
|
|
|
platform_set_drvdata(pdev, m66592);
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
m66592->gadget.ops = &m66592_gadget_ops;
|
2011-11-20 00:27:37 +07:00
|
|
|
m66592->gadget.max_speed = USB_SPEED_HIGH;
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592->gadget.name = udc_name;
|
|
|
|
|
treewide: setup_timer() -> timer_setup()
This converts all remaining cases of the old setup_timer() API into using
timer_setup(), where the callback argument is the structure already
holding the struct timer_list. These should have no behavioral changes,
since they just change which pointer is passed into the callback with
the same available pointers after conversion. It handles the following
examples, in addition to some other variations.
Casting from unsigned long:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
setup_timer(&ptr->my_timer, my_callback, ptr);
and forced object casts:
void my_callback(struct something *ptr)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, (unsigned long)ptr);
become:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
Direct function assignments:
void my_callback(unsigned long data)
{
struct something *ptr = (struct something *)data;
...
}
...
ptr->my_timer.function = my_callback;
have a temporary cast added, along with converting the args:
void my_callback(struct timer_list *t)
{
struct something *ptr = from_timer(ptr, t, my_timer);
...
}
...
ptr->my_timer.function = (TIMER_FUNC_TYPE)my_callback;
And finally, callbacks without a data assignment:
void my_callback(unsigned long data)
{
...
}
...
setup_timer(&ptr->my_timer, my_callback, 0);
have their argument renamed to verify they're unused during conversion:
void my_callback(struct timer_list *unused)
{
...
}
...
timer_setup(&ptr->my_timer, my_callback, 0);
The conversion is done with the following Coccinelle script:
spatch --very-quiet --all-includes --include-headers \
-I ./arch/x86/include -I ./arch/x86/include/generated \
-I ./include -I ./arch/x86/include/uapi \
-I ./arch/x86/include/generated/uapi -I ./include/uapi \
-I ./include/generated/uapi --include ./include/linux/kconfig.h \
--dir . \
--cocci-file ~/src/data/timer_setup.cocci
@fix_address_of@
expression e;
@@
setup_timer(
-&(e)
+&e
, ...)
// Update any raw setup_timer() usages that have a NULL callback, but
// would otherwise match change_timer_function_usage, since the latter
// will update all function assignments done in the face of a NULL
// function initialization in setup_timer().
@change_timer_function_usage_NULL@
expression _E;
identifier _timer;
type _cast_data;
@@
(
-setup_timer(&_E->_timer, NULL, _E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E->_timer, NULL, (_cast_data)_E);
+timer_setup(&_E->_timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, &_E);
+timer_setup(&_E._timer, NULL, 0);
|
-setup_timer(&_E._timer, NULL, (_cast_data)&_E);
+timer_setup(&_E._timer, NULL, 0);
)
@change_timer_function_usage@
expression _E;
identifier _timer;
struct timer_list _stl;
identifier _callback;
type _cast_func, _cast_data;
@@
(
-setup_timer(&_E->_timer, _callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, &_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, _E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, &_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)_E);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, (_cast_func)&_callback, (_cast_data)&_E);
+timer_setup(&_E._timer, _callback, 0);
|
_E->_timer@_stl.function = _callback;
|
_E->_timer@_stl.function = &_callback;
|
_E->_timer@_stl.function = (_cast_func)_callback;
|
_E->_timer@_stl.function = (_cast_func)&_callback;
|
_E._timer@_stl.function = _callback;
|
_E._timer@_stl.function = &_callback;
|
_E._timer@_stl.function = (_cast_func)_callback;
|
_E._timer@_stl.function = (_cast_func)&_callback;
)
// callback(unsigned long arg)
@change_callback_handle_cast
depends on change_timer_function_usage@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
identifier _handle;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
(
... when != _origarg
_handletype *_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(_handletype *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
|
... when != _origarg
_handletype *_handle;
... when != _handle
_handle =
-(void *)_origarg;
+from_timer(_handle, t, _timer);
... when != _origarg
)
}
// callback(unsigned long arg) without existing variable
@change_callback_handle_cast_no_arg
depends on change_timer_function_usage &&
!change_callback_handle_cast@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _origtype;
identifier _origarg;
type _handletype;
@@
void _callback(
-_origtype _origarg
+struct timer_list *t
)
{
+ _handletype *_origarg = from_timer(_origarg, t, _timer);
+
... when != _origarg
- (_handletype *)_origarg
+ _origarg
... when != _origarg
}
// Avoid already converted callbacks.
@match_callback_converted
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier t;
@@
void _callback(struct timer_list *t)
{ ... }
// callback(struct something *handle)
@change_callback_handle_arg
depends on change_timer_function_usage &&
!match_callback_converted &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
@@
void _callback(
-_handletype *_handle
+struct timer_list *t
)
{
+ _handletype *_handle = from_timer(_handle, t, _timer);
...
}
// If change_callback_handle_arg ran on an empty function, remove
// the added handler.
@unchange_callback_handle_arg
depends on change_timer_function_usage &&
change_callback_handle_arg@
identifier change_timer_function_usage._callback;
identifier change_timer_function_usage._timer;
type _handletype;
identifier _handle;
identifier t;
@@
void _callback(struct timer_list *t)
{
- _handletype *_handle = from_timer(_handle, t, _timer);
}
// We only want to refactor the setup_timer() data argument if we've found
// the matching callback. This undoes changes in change_timer_function_usage.
@unchange_timer_function_usage
depends on change_timer_function_usage &&
!change_callback_handle_cast &&
!change_callback_handle_cast_no_arg &&
!change_callback_handle_arg@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type change_timer_function_usage._cast_data;
@@
(
-timer_setup(&_E->_timer, _callback, 0);
+setup_timer(&_E->_timer, _callback, (_cast_data)_E);
|
-timer_setup(&_E._timer, _callback, 0);
+setup_timer(&_E._timer, _callback, (_cast_data)&_E);
)
// If we fixed a callback from a .function assignment, fix the
// assignment cast now.
@change_timer_function_assignment
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression change_timer_function_usage._E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_func;
typedef TIMER_FUNC_TYPE;
@@
(
_E->_timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E->_timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-&_callback;
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)_callback
+(TIMER_FUNC_TYPE)_callback
;
|
_E._timer.function =
-(_cast_func)&_callback
+(TIMER_FUNC_TYPE)_callback
;
)
// Sometimes timer functions are called directly. Replace matched args.
@change_timer_function_calls
depends on change_timer_function_usage &&
(change_callback_handle_cast ||
change_callback_handle_cast_no_arg ||
change_callback_handle_arg)@
expression _E;
identifier change_timer_function_usage._timer;
identifier change_timer_function_usage._callback;
type _cast_data;
@@
_callback(
(
-(_cast_data)_E
+&_E->_timer
|
-(_cast_data)&_E
+&_E._timer
|
-_E
+&_E->_timer
)
)
// If a timer has been configured without a data argument, it can be
// converted without regard to the callback argument, since it is unused.
@match_timer_function_unused_data@
expression _E;
identifier _timer;
identifier _callback;
@@
(
-setup_timer(&_E->_timer, _callback, 0);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0L);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E->_timer, _callback, 0UL);
+timer_setup(&_E->_timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0L);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_E._timer, _callback, 0UL);
+timer_setup(&_E._timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0L);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(&_timer, _callback, 0UL);
+timer_setup(&_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0L);
+timer_setup(_timer, _callback, 0);
|
-setup_timer(_timer, _callback, 0UL);
+timer_setup(_timer, _callback, 0);
)
@change_callback_unused_data
depends on match_timer_function_unused_data@
identifier match_timer_function_unused_data._callback;
type _origtype;
identifier _origarg;
@@
void _callback(
-_origtype _origarg
+struct timer_list *unused
)
{
... when != _origarg
}
Signed-off-by: Kees Cook <keescook@chromium.org>
2017-10-17 04:43:17 +07:00
|
|
|
timer_setup(&m66592->timer, m66592_timer, 0);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592->reg = reg;
|
|
|
|
|
2011-09-07 15:10:52 +07:00
|
|
|
ret = request_irq(ires->start, m66592_irq, IRQF_SHARED,
|
2007-07-17 19:01:17 +07:00
|
|
|
udc_name, m66592);
|
2007-05-10 11:18:23 +07:00
|
|
|
if (ret < 0) {
|
2007-11-20 03:58:36 +07:00
|
|
|
pr_err("request_irq error (%d)\n", ret);
|
2007-05-10 11:18:23 +07:00
|
|
|
goto clean_up;
|
|
|
|
}
|
|
|
|
|
2009-07-22 21:41:35 +07:00
|
|
|
if (m66592->pdata->on_chip) {
|
|
|
|
snprintf(clk_name, sizeof(clk_name), "usbf%d", pdev->id);
|
|
|
|
m66592->clk = clk_get(&pdev->dev, clk_name);
|
|
|
|
if (IS_ERR(m66592->clk)) {
|
|
|
|
dev_err(&pdev->dev, "cannot get clock \"%s\"\n",
|
|
|
|
clk_name);
|
|
|
|
ret = PTR_ERR(m66592->clk);
|
|
|
|
goto clean_up2;
|
|
|
|
}
|
|
|
|
clk_enable(m66592->clk);
|
2008-10-31 18:22:13 +07:00
|
|
|
}
|
2012-07-31 04:39:43 +07:00
|
|
|
|
2007-05-10 11:18:23 +07:00
|
|
|
INIT_LIST_HEAD(&m66592->gadget.ep_list);
|
|
|
|
m66592->gadget.ep0 = &m66592->ep[0].ep;
|
|
|
|
INIT_LIST_HEAD(&m66592->gadget.ep0->ep_list);
|
|
|
|
for (i = 0; i < M66592_MAX_NUM_PIPE; i++) {
|
|
|
|
struct m66592_ep *ep = &m66592->ep[i];
|
|
|
|
|
|
|
|
if (i != 0) {
|
|
|
|
INIT_LIST_HEAD(&m66592->ep[i].ep.ep_list);
|
|
|
|
list_add_tail(&m66592->ep[i].ep.ep_list,
|
2007-07-17 19:01:17 +07:00
|
|
|
&m66592->gadget.ep_list);
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
|
|
|
ep->m66592 = m66592;
|
|
|
|
INIT_LIST_HEAD(&ep->queue);
|
|
|
|
ep->ep.name = m66592_ep_name[i];
|
|
|
|
ep->ep.ops = &m66592_ep_ops;
|
2013-12-13 18:23:38 +07:00
|
|
|
usb_ep_set_maxpacket_limit(&ep->ep, 512);
|
2015-07-31 21:00:32 +07:00
|
|
|
|
|
|
|
if (i == 0) {
|
|
|
|
ep->ep.caps.type_control = true;
|
|
|
|
} else {
|
|
|
|
ep->ep.caps.type_iso = true;
|
|
|
|
ep->ep.caps.type_bulk = true;
|
|
|
|
ep->ep.caps.type_int = true;
|
|
|
|
}
|
|
|
|
|
|
|
|
ep->ep.caps.dir_in = true;
|
|
|
|
ep->ep.caps.dir_out = true;
|
2007-05-10 11:18:23 +07:00
|
|
|
}
|
2013-12-13 18:23:38 +07:00
|
|
|
usb_ep_set_maxpacket_limit(&m66592->ep[0].ep, 64);
|
2007-05-10 11:18:23 +07:00
|
|
|
m66592->ep[0].pipenum = 0;
|
|
|
|
m66592->ep[0].fifoaddr = M66592_CFIFO;
|
|
|
|
m66592->ep[0].fifosel = M66592_CFIFOSEL;
|
|
|
|
m66592->ep[0].fifoctr = M66592_CFIFOCTR;
|
|
|
|
m66592->ep[0].fifotrn = 0;
|
|
|
|
m66592->ep[0].pipectr = get_pipectr_addr(0);
|
|
|
|
m66592->pipenum2ep[0] = &m66592->ep[0];
|
|
|
|
m66592->epaddr2ep[0] = &m66592->ep[0];
|
|
|
|
|
|
|
|
m66592->ep0_req = m66592_alloc_request(&m66592->ep[0].ep, GFP_KERNEL);
|
2013-05-07 18:49:08 +07:00
|
|
|
if (m66592->ep0_req == NULL) {
|
|
|
|
ret = -ENOMEM;
|
2008-10-31 18:22:13 +07:00
|
|
|
goto clean_up3;
|
2013-05-07 18:49:08 +07:00
|
|
|
}
|
2007-07-17 19:01:17 +07:00
|
|
|
m66592->ep0_req->complete = nop_completion;
|
2007-05-10 11:18:23 +07:00
|
|
|
|
|
|
|
init_controller(m66592);
|
|
|
|
|
2011-06-28 20:33:47 +07:00
|
|
|
ret = usb_add_gadget_udc(&pdev->dev, &m66592->gadget);
|
|
|
|
if (ret)
|
|
|
|
goto err_add_udc;
|
|
|
|
|
2007-07-17 19:01:17 +07:00
|
|
|
dev_info(&pdev->dev, "version %s\n", DRIVER_VERSION);
|
2007-05-10 11:18:23 +07:00
|
|
|
return 0;
|
|
|
|
|
2011-06-28 20:33:47 +07:00
|
|
|
err_add_udc:
|
|
|
|
m66592_free_request(&m66592->ep[0].ep, m66592->ep0_req);
|
|
|
|
|
2008-10-31 18:22:13 +07:00
|
|
|
clean_up3:
|
2009-07-22 21:41:35 +07:00
|
|
|
if (m66592->pdata->on_chip) {
|
|
|
|
clk_disable(m66592->clk);
|
|
|
|
clk_put(m66592->clk);
|
|
|
|
}
|
2007-07-17 19:01:17 +07:00
|
|
|
clean_up2:
|
2009-07-22 21:41:35 +07:00
|
|
|
free_irq(ires->start, m66592);
|
2007-05-10 11:18:23 +07:00
|
|
|
clean_up:
|
|
|
|
if (m66592) {
|
|
|
|
if (m66592->ep0_req)
|
|
|
|
m66592_free_request(&m66592->ep[0].ep, m66592->ep0_req);
|
|
|
|
kfree(m66592);
|
|
|
|
}
|
|
|
|
if (reg)
|
|
|
|
iounmap(reg);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
static struct platform_driver m66592_driver = {
|
2015-04-11 05:14:21 +07:00
|
|
|
.remove = m66592_remove,
|
2007-05-10 11:18:23 +07:00
|
|
|
.driver = {
|
|
|
|
.name = (char *) udc_name,
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
2013-01-09 18:15:28 +07:00
|
|
|
module_platform_driver_probe(m66592_driver, m66592_probe);
|