mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-25 21:54:06 +08:00
e73a9891b3
USB DMA was installed on "normal DMAC" when SH7724 or older SuperH, but the "USB-DMAC" was prepared on recent SuperH. These 2 DMAC have a little bit different behavior. This patch add DMAEngine code for "normal DMAC", but it is still using PIO fifo. The DMA fifo will be formally supported in the future. You can enable DMA fifo by local fixup usbhs_fifo_pio_push_handler -> usbhs_fifo_dma_push_handler usbhs_fifo_pio_pop_handler -> usbhs_fifo_dma_pop_handler on usbhsg_ep_enable. This DMAEngine was tested by g_file_storage on SH7724 Ecovec board Signed-off-by: Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
716 lines
15 KiB
C
716 lines
15 KiB
C
/*
|
|
* Renesas USB driver
|
|
*
|
|
* Copyright (C) 2011 Renesas Solutions Corp.
|
|
* Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*
|
|
*/
|
|
#include <linux/delay.h>
|
|
#include <linux/slab.h>
|
|
#include "./common.h"
|
|
#include "./pipe.h"
|
|
|
|
/*
|
|
* macros
|
|
*/
|
|
#define usbhsp_addr_offset(p) ((usbhs_pipe_number(p) - 1) * 2)
|
|
|
|
#define usbhsp_flags_set(p, f) ((p)->flags |= USBHS_PIPE_FLAGS_##f)
|
|
#define usbhsp_flags_clr(p, f) ((p)->flags &= ~USBHS_PIPE_FLAGS_##f)
|
|
#define usbhsp_flags_has(p, f) ((p)->flags & USBHS_PIPE_FLAGS_##f)
|
|
#define usbhsp_flags_init(p) do {(p)->flags = 0; } while (0)
|
|
|
|
#define usbhsp_type(p) ((p)->pipe_type)
|
|
#define usbhsp_type_is(p, t) ((p)->pipe_type == t)
|
|
|
|
/*
|
|
* for debug
|
|
*/
|
|
static char *usbhsp_pipe_name[] = {
|
|
[USB_ENDPOINT_XFER_CONTROL] = "DCP",
|
|
[USB_ENDPOINT_XFER_BULK] = "BULK",
|
|
[USB_ENDPOINT_XFER_INT] = "INT",
|
|
[USB_ENDPOINT_XFER_ISOC] = "ISO",
|
|
};
|
|
|
|
/*
|
|
* usb request functions
|
|
*/
|
|
void usbhs_usbreq_get_val(struct usbhs_priv *priv, struct usb_ctrlrequest *req)
|
|
{
|
|
u16 val;
|
|
|
|
val = usbhs_read(priv, USBREQ);
|
|
req->bRequest = (val >> 8) & 0xFF;
|
|
req->bRequestType = (val >> 0) & 0xFF;
|
|
|
|
req->wValue = usbhs_read(priv, USBVAL);
|
|
req->wIndex = usbhs_read(priv, USBINDX);
|
|
req->wLength = usbhs_read(priv, USBLENG);
|
|
}
|
|
|
|
void usbhs_usbreq_set_val(struct usbhs_priv *priv, struct usb_ctrlrequest *req)
|
|
{
|
|
usbhs_write(priv, USBREQ, (req->bRequest << 8) | req->bRequestType);
|
|
usbhs_write(priv, USBVAL, req->wValue);
|
|
usbhs_write(priv, USBINDX, req->wIndex);
|
|
usbhs_write(priv, USBLENG, req->wLength);
|
|
}
|
|
|
|
/*
|
|
* DCPCTR/PIPEnCTR functions
|
|
*/
|
|
static void usbhsp_pipectrl_set(struct usbhs_pipe *pipe, u16 mask, u16 val)
|
|
{
|
|
struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe);
|
|
int offset = usbhsp_addr_offset(pipe);
|
|
|
|
if (usbhs_pipe_is_dcp(pipe))
|
|
usbhs_bset(priv, DCPCTR, mask, val);
|
|
else
|
|
usbhs_bset(priv, PIPEnCTR + offset, mask, val);
|
|
}
|
|
|
|
static u16 usbhsp_pipectrl_get(struct usbhs_pipe *pipe)
|
|
{
|
|
struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe);
|
|
int offset = usbhsp_addr_offset(pipe);
|
|
|
|
if (usbhs_pipe_is_dcp(pipe))
|
|
return usbhs_read(priv, DCPCTR);
|
|
else
|
|
return usbhs_read(priv, PIPEnCTR + offset);
|
|
}
|
|
|
|
/*
|
|
* DCP/PIPE functions
|
|
*/
|
|
static void __usbhsp_pipe_xxx_set(struct usbhs_pipe *pipe,
|
|
u16 dcp_reg, u16 pipe_reg,
|
|
u16 mask, u16 val)
|
|
{
|
|
struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe);
|
|
|
|
if (usbhs_pipe_is_dcp(pipe))
|
|
usbhs_bset(priv, dcp_reg, mask, val);
|
|
else
|
|
usbhs_bset(priv, pipe_reg, mask, val);
|
|
}
|
|
|
|
static u16 __usbhsp_pipe_xxx_get(struct usbhs_pipe *pipe,
|
|
u16 dcp_reg, u16 pipe_reg)
|
|
{
|
|
struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe);
|
|
|
|
if (usbhs_pipe_is_dcp(pipe))
|
|
return usbhs_read(priv, dcp_reg);
|
|
else
|
|
return usbhs_read(priv, pipe_reg);
|
|
}
|
|
|
|
/*
|
|
* DCPCFG/PIPECFG functions
|
|
*/
|
|
static void usbhsp_pipe_cfg_set(struct usbhs_pipe *pipe, u16 mask, u16 val)
|
|
{
|
|
__usbhsp_pipe_xxx_set(pipe, DCPCFG, PIPECFG, mask, val);
|
|
}
|
|
|
|
/*
|
|
* PIPEBUF
|
|
*/
|
|
static void usbhsp_pipe_buf_set(struct usbhs_pipe *pipe, u16 mask, u16 val)
|
|
{
|
|
if (usbhs_pipe_is_dcp(pipe))
|
|
return;
|
|
|
|
__usbhsp_pipe_xxx_set(pipe, 0, PIPEBUF, mask, val);
|
|
}
|
|
|
|
/*
|
|
* DCPMAXP/PIPEMAXP
|
|
*/
|
|
static void usbhsp_pipe_maxp_set(struct usbhs_pipe *pipe, u16 mask, u16 val)
|
|
{
|
|
__usbhsp_pipe_xxx_set(pipe, DCPMAXP, PIPEMAXP, mask, val);
|
|
}
|
|
|
|
static u16 usbhsp_pipe_maxp_get(struct usbhs_pipe *pipe)
|
|
{
|
|
return __usbhsp_pipe_xxx_get(pipe, DCPMAXP, PIPEMAXP);
|
|
}
|
|
|
|
/*
|
|
* pipe control functions
|
|
*/
|
|
static void usbhsp_pipe_select(struct usbhs_pipe *pipe)
|
|
{
|
|
struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe);
|
|
|
|
/*
|
|
* On pipe, this is necessary before
|
|
* accesses to below registers.
|
|
*
|
|
* PIPESEL : usbhsp_pipe_select
|
|
* PIPECFG : usbhsp_pipe_cfg_xxx
|
|
* PIPEBUF : usbhsp_pipe_buf_xxx
|
|
* PIPEMAXP : usbhsp_pipe_maxp_xxx
|
|
* PIPEPERI
|
|
*/
|
|
|
|
/*
|
|
* if pipe is dcp, no pipe is selected.
|
|
* it is no problem, because dcp have its register
|
|
*/
|
|
usbhs_write(priv, PIPESEL, 0xF & usbhs_pipe_number(pipe));
|
|
}
|
|
|
|
static int usbhsp_pipe_barrier(struct usbhs_pipe *pipe)
|
|
{
|
|
struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe);
|
|
int timeout = 1024;
|
|
u16 val;
|
|
|
|
/*
|
|
* make sure....
|
|
*
|
|
* Modify these bits when CSSTS = 0, PID = NAK, and no pipe number is
|
|
* specified by the CURPIPE bits.
|
|
* When changing the setting of this bit after changing
|
|
* the PID bits for the selected pipe from BUF to NAK,
|
|
* check that CSSTS = 0 and PBUSY = 0.
|
|
*/
|
|
|
|
/*
|
|
* CURPIPE bit = 0
|
|
*
|
|
* see also
|
|
* "Operation"
|
|
* - "Pipe Control"
|
|
* - "Pipe Control Registers Switching Procedure"
|
|
*/
|
|
usbhs_write(priv, CFIFOSEL, 0);
|
|
usbhs_pipe_disable(pipe);
|
|
|
|
do {
|
|
val = usbhsp_pipectrl_get(pipe);
|
|
val &= CSSTS | PID_MASK;
|
|
if (!val)
|
|
return 0;
|
|
|
|
udelay(10);
|
|
|
|
} while (timeout--);
|
|
|
|
return -EBUSY;
|
|
}
|
|
|
|
int usbhs_pipe_is_accessible(struct usbhs_pipe *pipe)
|
|
{
|
|
u16 val;
|
|
|
|
val = usbhsp_pipectrl_get(pipe);
|
|
if (val & BSTS)
|
|
return 0;
|
|
|
|
return -EBUSY;
|
|
}
|
|
|
|
/*
|
|
* PID ctrl
|
|
*/
|
|
static void __usbhsp_pid_try_nak_if_stall(struct usbhs_pipe *pipe)
|
|
{
|
|
u16 pid = usbhsp_pipectrl_get(pipe);
|
|
|
|
pid &= PID_MASK;
|
|
|
|
/*
|
|
* see
|
|
* "Pipe n Control Register" - "PID"
|
|
*/
|
|
switch (pid) {
|
|
case PID_STALL11:
|
|
usbhsp_pipectrl_set(pipe, PID_MASK, PID_STALL10);
|
|
/* fall-through */
|
|
case PID_STALL10:
|
|
usbhsp_pipectrl_set(pipe, PID_MASK, PID_NAK);
|
|
}
|
|
}
|
|
|
|
void usbhs_pipe_disable(struct usbhs_pipe *pipe)
|
|
{
|
|
int timeout = 1024;
|
|
u16 val;
|
|
|
|
/* see "Pipe n Control Register" - "PID" */
|
|
__usbhsp_pid_try_nak_if_stall(pipe);
|
|
|
|
usbhsp_pipectrl_set(pipe, PID_MASK, PID_NAK);
|
|
|
|
do {
|
|
val = usbhsp_pipectrl_get(pipe);
|
|
val &= PBUSY;
|
|
if (!val)
|
|
break;
|
|
|
|
udelay(10);
|
|
} while (timeout--);
|
|
}
|
|
|
|
void usbhs_pipe_enable(struct usbhs_pipe *pipe)
|
|
{
|
|
/* see "Pipe n Control Register" - "PID" */
|
|
__usbhsp_pid_try_nak_if_stall(pipe);
|
|
|
|
usbhsp_pipectrl_set(pipe, PID_MASK, PID_BUF);
|
|
}
|
|
|
|
void usbhs_pipe_stall(struct usbhs_pipe *pipe)
|
|
{
|
|
u16 pid = usbhsp_pipectrl_get(pipe);
|
|
|
|
pid &= PID_MASK;
|
|
|
|
/*
|
|
* see
|
|
* "Pipe n Control Register" - "PID"
|
|
*/
|
|
switch (pid) {
|
|
case PID_NAK:
|
|
usbhsp_pipectrl_set(pipe, PID_MASK, PID_STALL10);
|
|
break;
|
|
case PID_BUF:
|
|
usbhsp_pipectrl_set(pipe, PID_MASK, PID_STALL11);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* pipe setup
|
|
*/
|
|
static int usbhsp_possible_double_buffer(struct usbhs_pipe *pipe)
|
|
{
|
|
/*
|
|
* only ISO / BULK pipe can use double buffer
|
|
*/
|
|
if (usbhsp_type_is(pipe, USB_ENDPOINT_XFER_BULK) ||
|
|
usbhsp_type_is(pipe, USB_ENDPOINT_XFER_ISOC))
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static u16 usbhsp_setup_pipecfg(struct usbhs_pipe *pipe,
|
|
const struct usb_endpoint_descriptor *desc,
|
|
int is_host)
|
|
{
|
|
u16 type = 0;
|
|
u16 bfre = 0;
|
|
u16 dblb = 0;
|
|
u16 cntmd = 0;
|
|
u16 dir = 0;
|
|
u16 epnum = 0;
|
|
u16 shtnak = 0;
|
|
u16 type_array[] = {
|
|
[USB_ENDPOINT_XFER_BULK] = TYPE_BULK,
|
|
[USB_ENDPOINT_XFER_INT] = TYPE_INT,
|
|
[USB_ENDPOINT_XFER_ISOC] = TYPE_ISO,
|
|
};
|
|
int is_double = usbhsp_possible_double_buffer(pipe);
|
|
|
|
if (usbhs_pipe_is_dcp(pipe))
|
|
return -EINVAL;
|
|
|
|
/*
|
|
* PIPECFG
|
|
*
|
|
* see
|
|
* - "Register Descriptions" - "PIPECFG" register
|
|
* - "Features" - "Pipe configuration"
|
|
* - "Operation" - "Pipe Control"
|
|
*/
|
|
|
|
/* TYPE */
|
|
type = type_array[usbhsp_type(pipe)];
|
|
|
|
/* BFRE */
|
|
if (usbhsp_type_is(pipe, USB_ENDPOINT_XFER_ISOC) ||
|
|
usbhsp_type_is(pipe, USB_ENDPOINT_XFER_BULK))
|
|
bfre = 0; /* FIXME */
|
|
|
|
/* DBLB */
|
|
if (usbhsp_type_is(pipe, USB_ENDPOINT_XFER_ISOC) ||
|
|
usbhsp_type_is(pipe, USB_ENDPOINT_XFER_BULK))
|
|
dblb = (is_double) ? DBLB : 0;
|
|
|
|
/* CNTMD */
|
|
if (usbhsp_type_is(pipe, USB_ENDPOINT_XFER_BULK))
|
|
cntmd = 0; /* FIXME */
|
|
|
|
/* DIR */
|
|
if (usb_endpoint_dir_in(desc))
|
|
usbhsp_flags_set(pipe, IS_DIR_HOST);
|
|
|
|
if ((is_host && usb_endpoint_dir_out(desc)) ||
|
|
(!is_host && usb_endpoint_dir_in(desc)))
|
|
dir |= DIR_OUT;
|
|
|
|
if (!dir)
|
|
usbhsp_flags_set(pipe, IS_DIR_IN);
|
|
|
|
/* SHTNAK */
|
|
if (usbhsp_type_is(pipe, USB_ENDPOINT_XFER_BULK) &&
|
|
!dir)
|
|
shtnak = SHTNAK;
|
|
|
|
/* EPNUM */
|
|
epnum = 0xF & usb_endpoint_num(desc);
|
|
|
|
return type |
|
|
bfre |
|
|
dblb |
|
|
cntmd |
|
|
dir |
|
|
shtnak |
|
|
epnum;
|
|
}
|
|
|
|
static u16 usbhsp_setup_pipemaxp(struct usbhs_pipe *pipe,
|
|
const struct usb_endpoint_descriptor *desc,
|
|
int is_host)
|
|
{
|
|
/* host should set DEVSEL */
|
|
|
|
/* reutn MXPS */
|
|
return PIPE_MAXP_MASK & le16_to_cpu(desc->wMaxPacketSize);
|
|
}
|
|
|
|
static u16 usbhsp_setup_pipebuff(struct usbhs_pipe *pipe,
|
|
const struct usb_endpoint_descriptor *desc,
|
|
int is_host)
|
|
{
|
|
struct usbhs_priv *priv = usbhs_pipe_to_priv(pipe);
|
|
struct usbhs_pipe_info *info = usbhs_priv_to_pipeinfo(priv);
|
|
struct device *dev = usbhs_priv_to_dev(priv);
|
|
int pipe_num = usbhs_pipe_number(pipe);
|
|
int is_double = usbhsp_possible_double_buffer(pipe);
|
|
u16 buff_size;
|
|
u16 bufnmb;
|
|
u16 bufnmb_cnt;
|
|
|
|
/*
|
|
* PIPEBUF
|
|
*
|
|
* see
|
|
* - "Register Descriptions" - "PIPEBUF" register
|
|
* - "Features" - "Pipe configuration"
|
|
* - "Operation" - "FIFO Buffer Memory"
|
|
* - "Operation" - "Pipe Control"
|
|
*
|
|
* ex) if pipe6 - pipe9 are USB_ENDPOINT_XFER_INT (SH7724)
|
|
*
|
|
* BUFNMB: PIPE
|
|
* 0: pipe0 (DCP 256byte)
|
|
* 1: -
|
|
* 2: -
|
|
* 3: -
|
|
* 4: pipe6 (INT 64byte)
|
|
* 5: pipe7 (INT 64byte)
|
|
* 6: pipe8 (INT 64byte)
|
|
* 7: pipe9 (INT 64byte)
|
|
* 8 - xx: free (for BULK, ISOC)
|
|
*/
|
|
|
|
/*
|
|
* FIXME
|
|
*
|
|
* it doesn't have good buffer allocator
|
|
*
|
|
* DCP : 256 byte
|
|
* BULK: 512 byte
|
|
* INT : 64 byte
|
|
* ISOC: 512 byte
|
|
*/
|
|
if (usbhsp_type_is(pipe, USB_ENDPOINT_XFER_CONTROL))
|
|
buff_size = 256;
|
|
else if (usbhsp_type_is(pipe, USB_ENDPOINT_XFER_INT))
|
|
buff_size = 64;
|
|
else
|
|
buff_size = 512;
|
|
|
|
/* change buff_size to register value */
|
|
bufnmb_cnt = (buff_size / 64) - 1;
|
|
|
|
/* BUFNMB has been reserved for INT pipe
|
|
* see above */
|
|
if (usbhsp_type_is(pipe, USB_ENDPOINT_XFER_INT)) {
|
|
bufnmb = pipe_num - 2;
|
|
} else {
|
|
bufnmb = info->bufnmb_last;
|
|
info->bufnmb_last += bufnmb_cnt + 1;
|
|
|
|
/*
|
|
* double buffer
|
|
*/
|
|
if (is_double)
|
|
info->bufnmb_last += bufnmb_cnt + 1;
|
|
}
|
|
|
|
dev_dbg(dev, "pipe : %d : buff_size 0x%x: bufnmb 0x%x\n",
|
|
pipe_num, buff_size, bufnmb);
|
|
|
|
return (0x1f & bufnmb_cnt) << 10 |
|
|
(0xff & bufnmb) << 0;
|
|
}
|
|
|
|
/*
|
|
* pipe control
|
|
*/
|
|
int usbhs_pipe_get_maxpacket(struct usbhs_pipe *pipe)
|
|
{
|
|
u16 mask = usbhs_pipe_is_dcp(pipe) ? DCP_MAXP_MASK : PIPE_MAXP_MASK;
|
|
|
|
usbhsp_pipe_select(pipe);
|
|
|
|
return (int)(usbhsp_pipe_maxp_get(pipe) & mask);
|
|
}
|
|
|
|
int usbhs_pipe_is_dir_in(struct usbhs_pipe *pipe)
|
|
{
|
|
return usbhsp_flags_has(pipe, IS_DIR_IN);
|
|
}
|
|
|
|
int usbhs_pipe_is_dir_host(struct usbhs_pipe *pipe)
|
|
{
|
|
return usbhsp_flags_has(pipe, IS_DIR_HOST);
|
|
}
|
|
|
|
void usbhs_pipe_clear_sequence(struct usbhs_pipe *pipe)
|
|
{
|
|
usbhsp_pipectrl_set(pipe, SQCLR, SQCLR);
|
|
}
|
|
|
|
static struct usbhs_pipe *usbhsp_get_pipe(struct usbhs_priv *priv, u32 type)
|
|
{
|
|
struct usbhs_pipe *pos, *pipe;
|
|
int i;
|
|
|
|
/*
|
|
* find target pipe
|
|
*/
|
|
pipe = NULL;
|
|
usbhs_for_each_pipe_with_dcp(pos, priv, i) {
|
|
if (!usbhsp_type_is(pos, type))
|
|
continue;
|
|
if (usbhsp_flags_has(pos, IS_USED))
|
|
continue;
|
|
|
|
pipe = pos;
|
|
break;
|
|
}
|
|
|
|
if (!pipe)
|
|
return NULL;
|
|
|
|
/*
|
|
* initialize pipe flags
|
|
*/
|
|
usbhsp_flags_init(pipe);
|
|
usbhsp_flags_set(pipe, IS_USED);
|
|
|
|
return pipe;
|
|
}
|
|
|
|
void usbhs_pipe_init(struct usbhs_priv *priv,
|
|
void (*done)(struct usbhs_pkt *pkt),
|
|
int (*dma_map_ctrl)(struct usbhs_pkt *pkt, int map))
|
|
{
|
|
struct usbhs_pipe_info *info = usbhs_priv_to_pipeinfo(priv);
|
|
struct device *dev = usbhs_priv_to_dev(priv);
|
|
struct usbhs_pipe *pipe;
|
|
int i;
|
|
|
|
if (!done) {
|
|
dev_err(dev, "no done function\n");
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* FIXME
|
|
*
|
|
* driver needs good allocator.
|
|
*
|
|
* find first free buffer area (BULK, ISOC)
|
|
* (DCP, INT area is fixed)
|
|
*
|
|
* buffer number 0 - 3 have been reserved for DCP
|
|
* see
|
|
* usbhsp_to_bufnmb
|
|
*/
|
|
info->bufnmb_last = 4;
|
|
usbhs_for_each_pipe_with_dcp(pipe, priv, i) {
|
|
if (usbhsp_type_is(pipe, USB_ENDPOINT_XFER_INT))
|
|
info->bufnmb_last++;
|
|
|
|
usbhsp_flags_init(pipe);
|
|
pipe->fifo = NULL;
|
|
pipe->mod_private = NULL;
|
|
INIT_LIST_HEAD(&pipe->list);
|
|
|
|
/* pipe force init */
|
|
usbhsp_pipectrl_set(pipe, ACLRM, ACLRM);
|
|
usbhsp_pipectrl_set(pipe, ACLRM, 0);
|
|
}
|
|
|
|
info->done = done;
|
|
info->dma_map_ctrl = dma_map_ctrl;
|
|
}
|
|
|
|
struct usbhs_pipe *usbhs_pipe_malloc(struct usbhs_priv *priv,
|
|
const struct usb_endpoint_descriptor *desc)
|
|
{
|
|
struct device *dev = usbhs_priv_to_dev(priv);
|
|
struct usbhs_mod *mod = usbhs_mod_get_current(priv);
|
|
struct usbhs_pipe *pipe;
|
|
int is_host = usbhs_mod_is_host(priv, mod);
|
|
int ret;
|
|
u16 pipecfg, pipebuf, pipemaxp;
|
|
|
|
pipe = usbhsp_get_pipe(priv, usb_endpoint_type(desc));
|
|
if (!pipe) {
|
|
dev_err(dev, "can't get pipe (%s)\n",
|
|
usbhsp_pipe_name[usb_endpoint_type(desc)]);
|
|
return NULL;
|
|
}
|
|
|
|
INIT_LIST_HEAD(&pipe->list);
|
|
|
|
usbhs_pipe_disable(pipe);
|
|
|
|
/* make sure pipe is not busy */
|
|
ret = usbhsp_pipe_barrier(pipe);
|
|
if (ret < 0) {
|
|
dev_err(dev, "pipe setup failed %d\n", usbhs_pipe_number(pipe));
|
|
return NULL;
|
|
}
|
|
|
|
pipecfg = usbhsp_setup_pipecfg(pipe, desc, is_host);
|
|
pipebuf = usbhsp_setup_pipebuff(pipe, desc, is_host);
|
|
pipemaxp = usbhsp_setup_pipemaxp(pipe, desc, is_host);
|
|
|
|
usbhsp_pipe_select(pipe);
|
|
usbhsp_pipe_cfg_set(pipe, 0xFFFF, pipecfg);
|
|
usbhsp_pipe_buf_set(pipe, 0xFFFF, pipebuf);
|
|
usbhsp_pipe_maxp_set(pipe, 0xFFFF, pipemaxp);
|
|
|
|
usbhs_pipe_clear_sequence(pipe);
|
|
|
|
dev_dbg(dev, "enable pipe %d : %s (%s)\n",
|
|
usbhs_pipe_number(pipe),
|
|
usbhsp_pipe_name[usb_endpoint_type(desc)],
|
|
usbhs_pipe_is_dir_in(pipe) ? "in" : "out");
|
|
|
|
return pipe;
|
|
}
|
|
|
|
void usbhs_pipe_select_fifo(struct usbhs_pipe *pipe, struct usbhs_fifo *fifo)
|
|
{
|
|
if (pipe->fifo)
|
|
pipe->fifo->pipe = NULL;
|
|
|
|
pipe->fifo = fifo;
|
|
|
|
if (fifo)
|
|
fifo->pipe = pipe;
|
|
}
|
|
|
|
|
|
/*
|
|
* dcp control
|
|
*/
|
|
struct usbhs_pipe *usbhs_dcp_malloc(struct usbhs_priv *priv)
|
|
{
|
|
struct usbhs_pipe *pipe;
|
|
|
|
pipe = usbhsp_get_pipe(priv, USB_ENDPOINT_XFER_CONTROL);
|
|
if (!pipe)
|
|
return NULL;
|
|
|
|
/*
|
|
* dcpcfg : default
|
|
* dcpmaxp : default
|
|
* pipebuf : nothing to do
|
|
*/
|
|
|
|
usbhsp_pipe_select(pipe);
|
|
usbhs_pipe_clear_sequence(pipe);
|
|
INIT_LIST_HEAD(&pipe->list);
|
|
|
|
return pipe;
|
|
}
|
|
|
|
void usbhs_dcp_control_transfer_done(struct usbhs_pipe *pipe)
|
|
{
|
|
WARN_ON(!usbhs_pipe_is_dcp(pipe));
|
|
|
|
usbhs_pipe_enable(pipe);
|
|
usbhsp_pipectrl_set(pipe, CCPL, CCPL);
|
|
}
|
|
|
|
/*
|
|
* pipe module function
|
|
*/
|
|
int usbhs_pipe_probe(struct usbhs_priv *priv)
|
|
{
|
|
struct usbhs_pipe_info *info = usbhs_priv_to_pipeinfo(priv);
|
|
struct usbhs_pipe *pipe;
|
|
struct device *dev = usbhs_priv_to_dev(priv);
|
|
u32 *pipe_type = usbhs_get_dparam(priv, pipe_type);
|
|
int pipe_size = usbhs_get_dparam(priv, pipe_size);
|
|
int i;
|
|
|
|
/* This driver expects 1st pipe is DCP */
|
|
if (pipe_type[0] != USB_ENDPOINT_XFER_CONTROL) {
|
|
dev_err(dev, "1st PIPE is not DCP\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
info->pipe = kzalloc(sizeof(struct usbhs_pipe) * pipe_size, GFP_KERNEL);
|
|
if (!info->pipe) {
|
|
dev_err(dev, "Could not allocate pipe\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
info->size = pipe_size;
|
|
|
|
/*
|
|
* init pipe
|
|
*/
|
|
usbhs_for_each_pipe_with_dcp(pipe, priv, i) {
|
|
pipe->priv = priv;
|
|
usbhsp_type(pipe) = pipe_type[i] & USB_ENDPOINT_XFERTYPE_MASK;
|
|
|
|
dev_dbg(dev, "pipe %x\t: %s\n",
|
|
i, usbhsp_pipe_name[pipe_type[i]]);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void usbhs_pipe_remove(struct usbhs_priv *priv)
|
|
{
|
|
struct usbhs_pipe_info *info = usbhs_priv_to_pipeinfo(priv);
|
|
|
|
kfree(info->pipe);
|
|
}
|