STM32 USB: Read data before register update

1 files changed, 3 insertions, 1 deletions

diff --git a/embassy-stm32/src/usb/usb.rs b/embassy-stm32/src/usb/usb.rs
index 0b878915a..3e8e74a1f 100644
--- a/embassy-stm32/src/usb/usb.rs
+++ b/embassy-stm32/src/usb/usb.rs
@@ -911,6 +911,8 @@ impl<'d, T: Instance> driver::EndpointOut for Endpoint<'d, T, Out> {
             };
             self.read_data_double_buffered(buf, packet_buffer)?
         } else {
+            let len = self.read_data(buf)?;
+
             regs.epr(index).write(|w| {
                 w.set_ep_type(convert_type(self.info.ep_type));
                 w.set_ea(self.info.addr.index() as _);
@@ -920,7 +922,7 @@ impl<'d, T: Instance> driver::EndpointOut for Endpoint<'d, T, Out> {
                 w.set_ctr_tx(true); // don't clear
             });
 
-            self.read_data(buf)?
+            len
         };
         trace!("READ OK, rx_len = {}", rx_len);