|
@@ -39,18 +39,13 @@ static void __dwc3_ep0_do_control_status(struct dwc3 *dwc, struct dwc3_ep *dep);
|
|
static void __dwc3_ep0_do_control_data(struct dwc3 *dwc,
|
|
static void __dwc3_ep0_do_control_data(struct dwc3 *dwc,
|
|
struct dwc3_ep *dep, struct dwc3_request *req);
|
|
struct dwc3_ep *dep, struct dwc3_request *req);
|
|
|
|
|
|
-static int dwc3_ep0_start_trans(struct dwc3 *dwc, u8 epnum, dma_addr_t buf_dma,
|
|
|
|
- u32 len, u32 type, bool chain)
|
|
|
|
|
|
+static void dwc3_ep0_prepare_one_trb(struct dwc3 *dwc, u8 epnum,
|
|
|
|
+ dma_addr_t buf_dma, u32 len, u32 type, bool chain)
|
|
{
|
|
{
|
|
- struct dwc3_gadget_ep_cmd_params params;
|
|
|
|
struct dwc3_trb *trb;
|
|
struct dwc3_trb *trb;
|
|
struct dwc3_ep *dep;
|
|
struct dwc3_ep *dep;
|
|
|
|
|
|
- int ret;
|
|
|
|
-
|
|
|
|
dep = dwc->eps[epnum];
|
|
dep = dwc->eps[epnum];
|
|
- if (dep->flags & DWC3_EP_BUSY)
|
|
|
|
- return 0;
|
|
|
|
|
|
|
|
trb = &dwc->ep0_trb[dep->trb_enqueue];
|
|
trb = &dwc->ep0_trb[dep->trb_enqueue];
|
|
|
|
|
|
@@ -71,15 +66,23 @@ static int dwc3_ep0_start_trans(struct dwc3 *dwc, u8 epnum, dma_addr_t buf_dma,
|
|
trb->ctrl |= (DWC3_TRB_CTRL_IOC
|
|
trb->ctrl |= (DWC3_TRB_CTRL_IOC
|
|
| DWC3_TRB_CTRL_LST);
|
|
| DWC3_TRB_CTRL_LST);
|
|
|
|
|
|
- if (chain)
|
|
|
|
|
|
+ trace_dwc3_prepare_trb(dep, trb);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static int dwc3_ep0_start_trans(struct dwc3 *dwc, u8 epnum)
|
|
|
|
+{
|
|
|
|
+ struct dwc3_gadget_ep_cmd_params params;
|
|
|
|
+ struct dwc3_ep *dep;
|
|
|
|
+ int ret;
|
|
|
|
+
|
|
|
|
+ dep = dwc->eps[epnum];
|
|
|
|
+ if (dep->flags & DWC3_EP_BUSY)
|
|
return 0;
|
|
return 0;
|
|
|
|
|
|
memset(¶ms, 0, sizeof(params));
|
|
memset(¶ms, 0, sizeof(params));
|
|
params.param0 = upper_32_bits(dwc->ep0_trb_addr);
|
|
params.param0 = upper_32_bits(dwc->ep0_trb_addr);
|
|
params.param1 = lower_32_bits(dwc->ep0_trb_addr);
|
|
params.param1 = lower_32_bits(dwc->ep0_trb_addr);
|
|
|
|
|
|
- trace_dwc3_prepare_trb(dep, trb);
|
|
|
|
-
|
|
|
|
ret = dwc3_send_gadget_ep_cmd(dep, DWC3_DEPCMD_STARTTRANSFER, ¶ms);
|
|
ret = dwc3_send_gadget_ep_cmd(dep, DWC3_DEPCMD_STARTTRANSFER, ¶ms);
|
|
if (ret < 0)
|
|
if (ret < 0)
|
|
return ret;
|
|
return ret;
|
|
@@ -280,8 +283,9 @@ void dwc3_ep0_out_start(struct dwc3 *dwc)
|
|
|
|
|
|
complete(&dwc->ep0_in_setup);
|
|
complete(&dwc->ep0_in_setup);
|
|
|
|
|
|
- ret = dwc3_ep0_start_trans(dwc, 0, dwc->ctrl_req_addr, 8,
|
|
|
|
|
|
+ dwc3_ep0_prepare_one_trb(dwc, 0, dwc->ctrl_req_addr, 8,
|
|
DWC3_TRBCTL_CONTROL_SETUP, false);
|
|
DWC3_TRBCTL_CONTROL_SETUP, false);
|
|
|
|
+ ret = dwc3_ep0_start_trans(dwc, 0);
|
|
WARN_ON(ret < 0);
|
|
WARN_ON(ret < 0);
|
|
}
|
|
}
|
|
|
|
|
|
@@ -912,9 +916,9 @@ static void dwc3_ep0_complete_data(struct dwc3 *dwc,
|
|
|
|
|
|
dwc->ep0_next_event = DWC3_EP0_COMPLETE;
|
|
dwc->ep0_next_event = DWC3_EP0_COMPLETE;
|
|
|
|
|
|
- ret = dwc3_ep0_start_trans(dwc, epnum,
|
|
|
|
- dwc->ctrl_req_addr, 0,
|
|
|
|
- DWC3_TRBCTL_CONTROL_DATA, false);
|
|
|
|
|
|
+ dwc3_ep0_prepare_one_trb(dwc, epnum, dwc->ctrl_req_addr,
|
|
|
|
+ 0, DWC3_TRBCTL_CONTROL_DATA, false);
|
|
|
|
+ ret = dwc3_ep0_start_trans(dwc, epnum);
|
|
WARN_ON(ret < 0);
|
|
WARN_ON(ret < 0);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
@@ -993,9 +997,10 @@ static void __dwc3_ep0_do_control_data(struct dwc3 *dwc,
|
|
req->direction = !!dep->number;
|
|
req->direction = !!dep->number;
|
|
|
|
|
|
if (req->request.length == 0) {
|
|
if (req->request.length == 0) {
|
|
- ret = dwc3_ep0_start_trans(dwc, dep->number,
|
|
|
|
|
|
+ dwc3_ep0_prepare_one_trb(dwc, dep->number,
|
|
dwc->ctrl_req_addr, 0,
|
|
dwc->ctrl_req_addr, 0,
|
|
DWC3_TRBCTL_CONTROL_DATA, false);
|
|
DWC3_TRBCTL_CONTROL_DATA, false);
|
|
|
|
+ ret = dwc3_ep0_start_trans(dwc, dep->number);
|
|
} else if (!IS_ALIGNED(req->request.length, dep->endpoint.maxpacket)
|
|
} else if (!IS_ALIGNED(req->request.length, dep->endpoint.maxpacket)
|
|
&& (dep->number == 0)) {
|
|
&& (dep->number == 0)) {
|
|
u32 transfer_size = 0;
|
|
u32 transfer_size = 0;
|
|
@@ -1011,7 +1016,7 @@ static void __dwc3_ep0_do_control_data(struct dwc3 *dwc,
|
|
if (req->request.length > DWC3_EP0_BOUNCE_SIZE) {
|
|
if (req->request.length > DWC3_EP0_BOUNCE_SIZE) {
|
|
transfer_size = ALIGN(req->request.length - maxpacket,
|
|
transfer_size = ALIGN(req->request.length - maxpacket,
|
|
maxpacket);
|
|
maxpacket);
|
|
- ret = dwc3_ep0_start_trans(dwc, dep->number,
|
|
|
|
|
|
+ dwc3_ep0_prepare_one_trb(dwc, dep->number,
|
|
req->request.dma,
|
|
req->request.dma,
|
|
transfer_size,
|
|
transfer_size,
|
|
DWC3_TRBCTL_CONTROL_DATA,
|
|
DWC3_TRBCTL_CONTROL_DATA,
|
|
@@ -1023,18 +1028,20 @@ static void __dwc3_ep0_do_control_data(struct dwc3 *dwc,
|
|
|
|
|
|
dwc->ep0_bounced = true;
|
|
dwc->ep0_bounced = true;
|
|
|
|
|
|
- ret = dwc3_ep0_start_trans(dwc, dep->number,
|
|
|
|
|
|
+ dwc3_ep0_prepare_one_trb(dwc, dep->number,
|
|
dwc->ep0_bounce_addr, transfer_size,
|
|
dwc->ep0_bounce_addr, transfer_size,
|
|
DWC3_TRBCTL_CONTROL_DATA, false);
|
|
DWC3_TRBCTL_CONTROL_DATA, false);
|
|
|
|
+ ret = dwc3_ep0_start_trans(dwc, dep->number);
|
|
} else {
|
|
} else {
|
|
ret = usb_gadget_map_request_by_dev(dwc->sysdev,
|
|
ret = usb_gadget_map_request_by_dev(dwc->sysdev,
|
|
&req->request, dep->number);
|
|
&req->request, dep->number);
|
|
if (ret)
|
|
if (ret)
|
|
return;
|
|
return;
|
|
|
|
|
|
- ret = dwc3_ep0_start_trans(dwc, dep->number, req->request.dma,
|
|
|
|
|
|
+ dwc3_ep0_prepare_one_trb(dwc, dep->number, req->request.dma,
|
|
req->request.length, DWC3_TRBCTL_CONTROL_DATA,
|
|
req->request.length, DWC3_TRBCTL_CONTROL_DATA,
|
|
false);
|
|
false);
|
|
|
|
+ ret = dwc3_ep0_start_trans(dwc, dep->number);
|
|
}
|
|
}
|
|
|
|
|
|
WARN_ON(ret < 0);
|
|
WARN_ON(ret < 0);
|
|
@@ -1048,8 +1055,9 @@ static int dwc3_ep0_start_control_status(struct dwc3_ep *dep)
|
|
type = dwc->three_stage_setup ? DWC3_TRBCTL_CONTROL_STATUS3
|
|
type = dwc->three_stage_setup ? DWC3_TRBCTL_CONTROL_STATUS3
|
|
: DWC3_TRBCTL_CONTROL_STATUS2;
|
|
: DWC3_TRBCTL_CONTROL_STATUS2;
|
|
|
|
|
|
- return dwc3_ep0_start_trans(dwc, dep->number,
|
|
|
|
|
|
+ dwc3_ep0_prepare_one_trb(dwc, dep->number,
|
|
dwc->ctrl_req_addr, 0, type, false);
|
|
dwc->ctrl_req_addr, 0, type, false);
|
|
|
|
+ return dwc3_ep0_start_trans(dwc, dep->number);
|
|
}
|
|
}
|
|
|
|
|
|
static void __dwc3_ep0_do_control_status(struct dwc3 *dwc, struct dwc3_ep *dep)
|
|
static void __dwc3_ep0_do_control_status(struct dwc3 *dwc, struct dwc3_ep *dep)
|