support pio dcd endpiont stall

1 files changed, 5 insertions, 2 deletions

diff --git a/src/portable/raspberrypi/pio_usb/dcd_pio_usb.c b/src/portable/raspberrypi/pio_usb/dcd_pio_usb.c
index dc9cbb45b..7744a11cd 100644
--- a/src/portable/raspberrypi/pio_usb/dcd_pio_usb.c
+++ b/src/portable/raspberrypi/pio_usb/dcd_pio_usb.c
@@ -136,14 +136,17 @@ bool dcd_edpt_xfer (uint8_t rhport, uint8_t ep_addr, uint8_t * buffer, uint16_t
 void dcd_edpt_stall (uint8_t rhport, uint8_t ep_addr)
 {
   (void) rhport;
-  (void) ep_addr;
+  pio_hw_endpoint_t *ep = pio_usb_device_get_ep(ep_addr);
+  ep->stalled = true;
 }
 
 // clear stall, data toggle is also reset to DATA0
 void dcd_edpt_clear_stall (uint8_t rhport, uint8_t ep_addr)
 {
   (void) rhport;
-  (void) ep_addr;
+  pio_hw_endpoint_t *ep = pio_usb_device_get_ep(ep_addr);
+  ep->data_id = 0;
+  ep->stalled = false;
 }
 
 //--------------------------------------------------------------------+