From 84cd0c672b2dd3754a36ae632bbe25845dbeeabc Mon Sep 17 00:00:00 2001
From: Rob Pilling <robpilling@gmail.com>
Date: Mon, 29 Apr 2024 16:23:42 +0100
Subject: [PATCH] rp usb: wake ep-wakers after stalling

---
 embassy-rp/src/usb.rs | 3 +++
 1 file changed, 3 insertions(+)

diff --git a/embassy-rp/src/usb.rs b/embassy-rp/src/usb.rs
index 99cba2d82..512271ae4 100644
--- a/embassy-rp/src/usb.rs
+++ b/embassy-rp/src/usb.rs
@@ -432,6 +432,9 @@ impl<'d, T: Instance> driver::Bus for Bus<'d, T> {
         };
 
         ctrl.modify(|w| w.set_stall(stalled));
+
+        let wakers = if ep_addr.is_in() { &EP_IN_WAKERS } else { &EP_OUT_WAKERS };
+        wakers[n].wake();
     }
 
     fn endpoint_is_stalled(&mut self, ep_addr: EndpointAddress) -> bool {