brain-hackers_pepepper-mirror/u-boot-brain
1
0
Fork 0
mirror of https://github.com/brain-hackers/u-boot-brain synced 2024-07-12 22:26:16 +09:00
Code Issues Projects Releases Wiki Activity

usb: dwc2: refactor submit_bulk_msg to be common

Browse Source 
Move the body of submit_bulk_msg() into new function chunk_msg(). This
can be shared with submit_control_msg() to reduce code duplication, and
allow control messages larger than maxpacket.

Signed-off-by: Stephen Warren <swarren@wwwdotorg.org>
This commit is contained in:
Stephen Warren 2015-03-07 22:48:52 -07:00 committed by Marek Vasut
parent 4a1d21fc52
commit 7b5e504dae
1 changed files with 39 additions and 16 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

55
drivers/usb/host/dwc2.c
View File

@ -734,25 +734,30 @@ int wait_for_chhltd(uint32_t *sub, int *toggle)
return 0; return 0;
} }
/* U-Boot USB transmission interface */ static int dwc2_eptype[] = {
int submit_bulk_msg(struct usb_device *dev, unsigned long pipe, void *buffer, DWC2_HCCHAR_EPTYPE_ISOC,
int len) DWC2_HCCHAR_EPTYPE_INTR,
DWC2_HCCHAR_EPTYPE_CONTROL,
DWC2_HCCHAR_EPTYPE_BULK,
};
int chunk_msg(struct usb_device *dev, unsigned long pipe, int *pid, int in,
void *buffer, int len)
{ {
struct dwc2_hc_regs *hc_regs = &regs->hc_regs[DWC2_HC_CHANNEL];
int devnum = usb_pipedevice(pipe); int devnum = usb_pipedevice(pipe);
int ep = usb_pipeendpoint(pipe); int ep = usb_pipeendpoint(pipe);
int max = usb_maxpacket(dev, pipe); int max = usb_maxpacket(dev, pipe);
int eptype = dwc2_eptype[usb_pipetype(pipe)];
int done = 0; int done = 0;
int ret; int ret;
uint32_t sub; uint32_t sub;
struct dwc2_hc_regs *hc_regs = &regs->hc_regs[DWC2_HC_CHANNEL];
uint32_t xfer_len; uint32_t xfer_len;
uint32_t num_packets; uint32_t num_packets;
int stop_transfer = 0; int stop_transfer = 0;
if (devnum == root_hub_devnum) { debug("%s: msg: pipe %lx pid %d in %d len %d\n", __func__, pipe, *pid,
dev->status = 0; in, len);
return -EINVAL;
}
if (len > DWC2_DATA_BUF_SIZE) { if (len > DWC2_DATA_BUF_SIZE) {
printf("%s: %d is more then available buffer size (%d)\n", printf("%s: %d is more then available buffer size (%d)\n",
@ -764,8 +769,8 @@ int submit_bulk_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
while ((done < len) && !stop_transfer) { while ((done < len) && !stop_transfer) {
/* Initialize channel */ /* Initialize channel */
dwc_otg_hc_init(regs, DWC2_HC_CHANNEL, devnum, ep, dwc_otg_hc_init(regs, DWC2_HC_CHANNEL, devnum, ep, in, eptype,
usb_pipein(pipe), DWC2_HCCHAR_EPTYPE_BULK, max); max);
xfer_len = len - done; xfer_len = len - done;
/* Make sure that xfer_len is a multiple of max packet size. */ /* Make sure that xfer_len is a multiple of max packet size. */
@ -782,13 +787,15 @@ int submit_bulk_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
num_packets = 1; num_packets = 1;
} }
if (usb_pipein(pipe)) if (in)
xfer_len = num_packets * max; xfer_len = num_packets * max;
debug("%s: chunk: pid %d xfer_len %u pkts %u\n", __func__,
*pid, xfer_len, num_packets);
writel((xfer_len << DWC2_HCTSIZ_XFERSIZE_OFFSET) | writel((xfer_len << DWC2_HCTSIZ_XFERSIZE_OFFSET) |
(num_packets << DWC2_HCTSIZ_PKTCNT_OFFSET) | (num_packets << DWC2_HCTSIZ_PKTCNT_OFFSET) |
(bulk_data_toggle[devnum][ep] << (*pid << DWC2_HCTSIZ_PID_OFFSET),
DWC2_HCTSIZ_PID_OFFSET),
&hc_regs->hctsiz); &hc_regs->hctsiz);
memcpy(aligned_buffer, (char *)buffer + done, len - done); memcpy(aligned_buffer, (char *)buffer + done, len - done);
@ -800,21 +807,21 @@ int submit_bulk_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
(1 << DWC2_HCCHAR_MULTICNT_OFFSET) | (1 << DWC2_HCCHAR_MULTICNT_OFFSET) |
DWC2_HCCHAR_CHEN); DWC2_HCCHAR_CHEN);
ret = wait_for_chhltd(&sub, &bulk_data_toggle[devnum][ep]); ret = wait_for_chhltd(&sub, pid);
if (ret) { if (ret) {
stop_transfer = 1; stop_transfer = 1;
break; break;
} }
done += xfer_len; done += xfer_len;
if (usb_pipein(pipe)) { if (in) {
done -= sub; done -= sub;
if (sub) if (sub)
stop_transfer = 1; stop_transfer = 1;
} }
} }
if (done && usb_pipein(pipe)) if (done && in)
memcpy(buffer, aligned_buffer, done); memcpy(buffer, aligned_buffer, done);
writel(0, &hc_regs->hcintmsk); writel(0, &hc_regs->hcintmsk);
@ -826,6 +833,22 @@ int submit_bulk_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
return 0; return 0;
} }
/* U-Boot USB transmission interface */
int submit_bulk_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
int len)
{
int devnum = usb_pipedevice(pipe);
int ep = usb_pipeendpoint(pipe);
if (devnum == root_hub_devnum) {
dev->status = 0;
return -EINVAL;
}
return chunk_msg(dev, pipe, &bulk_data_toggle[devnum][ep],
usb_pipein(pipe), buffer, len);
}
int submit_control_msg(struct usb_device *dev, unsigned long pipe, void *buffer, int submit_control_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
int len, struct devrequest *setup) int len, struct devrequest *setup)
{ {