From b636afb7b513cc9027a33659a58373106e4a3958 Mon Sep 17 00:00:00 2001
From: Jan Niehusmann <jan@gondor.com>
Date: Tue, 2 Aug 2022 22:05:38 +0000
Subject: [PATCH] Clear sie_status.suspended / sie_status.resume flags in
 poll()

usb_device ignores PollResult::Suspend when already suspended,
and PollResult::Resume when not suspended.

This may lead to repeatedly triggered interrupts if for some reason
the Suspend flag gets set while the device is already suspended.

I observed such a situation when a reset was triggered while the device
was suspended.

To make sure that this can't cause interrupt storms, clear the flags
before returning from poll()
---
 rp2040-hal/src/usb.rs | 22 ++++------------------
 1 file changed, 4 insertions(+), 18 deletions(-)

diff --git a/rp2040-hal/src/usb.rs b/rp2040-hal/src/usb.rs
index 0a36dc6..39445d7 100644
--- a/rp2040-hal/src/usb.rs
+++ b/rp2040-hal/src/usb.rs
@@ -538,24 +538,8 @@ impl UsbBusTrait for UsbBus {
                 .bit_is_set()
         })
     }
-    fn suspend(&self) {
-        interrupt::free(|cs| {
-            let inner = self.inner.borrow(cs).borrow_mut();
-            inner
-                .ctrl_reg
-                .sie_status
-                .write(|w| w.suspended().set_bit());
-        });
-    }
-    fn resume(&self) {
-        interrupt::free(|cs| {
-            let inner = self.inner.borrow(cs).borrow_mut();
-            inner
-                .ctrl_reg
-                .sie_status
-                .write(|w| w.resume().set_bit());
-        });
-    }
+    fn suspend(&self) {}
+    fn resume(&self) {}
     fn poll(&self) -> PollResult {
         interrupt::free(|cs| {
             let mut inner = self.inner.borrow(cs).borrow_mut();
@@ -565,8 +549,10 @@ impl UsbBusTrait for UsbBus {
             if sie_status.bus_reset().bit_is_set() {
                 return PollResult::Reset;
             } else if sie_status.suspended().bit_is_set() {
+                inner.ctrl_reg.sie_status.write(|w| w.suspended().set_bit());
                 return PollResult::Suspend;
             } else if sie_status.resume().bit_is_set() {
+                inner.ctrl_reg.sie_status.write(|w| w.resume().set_bit());
                 return PollResult::Resume;
             }