usb: Plumb in SOF handling for the Synopsys DWC2

Author: dragonmux

embassy-usb-synopsys-otg/src/lib.rs

@@ -30,12 +30,20 @@ pub unsafe fn on_interrupt<const MAX_EP_COUNT: usize>(r: Otg, state: &State<MAX_
     trace!("irq");
 
     let ints = r.gintsts().read();
-    if ints.wkupint() || ints.usbsusp() || ints.usbrst() || ints.enumdne() || ints.otgint() || ints.srqint() {
+    if ints.wkupint()
+        || ints.usbsusp()
+        || ints.usbrst()
+        || ints.enumdne()
+        || ints.otgint()
+        || ints.srqint()
+        || ints.sof()
+    {
         // Mask interrupts and notify `Bus` to process them
         r.gintmsk().write(|w| {
             w.set_iepint(true);
             w.set_oepint(true);
             w.set_rxflvlm(true);
+            w.set_sofm(true);
         });
         state.bus_waker.wake();
     }
@@ -868,6 +876,13 @@ impl<'d, const MAX_EP_COUNT: usize> embassy_usb_driver::Bus for Bus<'d, MAX_EP_C
                 return Poll::Ready(Event::Resume);
             }
 
+            if ints.sof() {
+                trace!("sof");
+                regs.gintsts().write(|w| w.set_sof(true)); // clear
+                self.restore_irqs();
+                return Poll::Ready(Event::SOF);
+            }
+
             Poll::Pending
         })
         .await