michaelh/zephyr
1
0
Fork 0
Code Releases Activity

drivers: usb_dc_mcux_ehci: rework set/clear stall

Browse source 
Rework set/clear stall. Fix style.

Signed-off-by: Johann Fischer <j.fischer@phytec.de>
This commit is contained in:
Johann Fischer 2019-12-02 20:05:23 +01:00 • committed by Carles Cufí
commit 031d744b9a
1 changed files with 49 additions and 9 deletions
Download patch file Download diff file Expand all files Collapse all files

58
drivers/usb/device/usb_dc_mcux_ehci.c
View file

@ -228,32 +228,72 @@ int usb_dc_ep_configure(const struct usb_dc_ep_cfg_data *const cfg)
int usb_dc_ep_set_stall(const u8_t ep)
{
u8_t endpoint = ep;
u8_t ep_abs_idx = EP_ABS_IDX(ep);
usb_status_t status;
if (ep_abs_idx >= NUM_OF_EP_MAX) {
LOG_ERR("Wrong endpoint index/address");
return -EINVAL;
}
status = dev_data.interface->deviceControl(dev_data.controllerHandle,
kUSB_DeviceControlEndpointStall, &endpoint);
if (kStatus_USB_Success != status) {
LOG_ERR("Failed to stall endpoint");
return -EIO;
}
dev_data.interface->deviceControl(dev_data.controllerHandle, kUSB_DeviceControlEndpointStall, &endpoint);
return 0;
}
int usb_dc_ep_clear_stall(const u8_t ep)
{
u8_t endpoint = ep;
u8_t ep_abs_idx = EP_ABS_IDX(ep);
usb_status_t status;
if (ep_abs_idx >= NUM_OF_EP_MAX) {
LOG_ERR("Wrong endpoint index/address");
return -EINVAL;
}
status = dev_data.interface->deviceControl(dev_data.controllerHandle,
kUSB_DeviceControlEndpointUnstall, &endpoint);
if (kStatus_USB_Success != status) {
LOG_ERR("Failed to clear stall");
return -EIO;
}
dev_data.interface->deviceControl(dev_data.controllerHandle, kUSB_DeviceControlEndpointUnstall, &endpoint);
return 0;
}
int usb_dc_ep_is_stalled(const u8_t ep, u8_t *const stalled)
{
u8_t ep_abs_idx = EP_ABS_IDX(ep);
usb_device_endpoint_status_struct_t ep_status;
usb_status_t status;
if (ep_abs_idx >= NUM_OF_EP_MAX) {
LOG_ERR("Wrong endpoint index/address");
return -EINVAL;
}
if (!stalled) {
return -EINVAL;
}
*stalled = 0;
/* Get the endpoint status */
usb_device_endpoint_status_struct_t endpointStatus;
endpointStatus.endpointAddress = ep;
endpointStatus.endpointStatus = kUSB_DeviceEndpointStateIdle;
dev_data.interface->deviceControl(dev_data.controllerHandle, kUSB_DeviceControlGetEndpointStatus, &endpointStatus);
*stalled = endpointStatus.endpointStatus;
*stalled = 0;
ep_status.endpointAddress = ep;
ep_status.endpointStatus = kUSB_DeviceEndpointStateIdle;
status = dev_data.interface->deviceControl(dev_data.controllerHandle,
kUSB_DeviceControlGetEndpointStatus, &ep_status);
if (kStatus_USB_Success != status) {
LOG_ERR("Failed to get endpoint status");
return -EIO;
}
*stalled = (u8_t)ep_status.endpointStatus;
return 0;
}