gateware.usb2: reset current speed, operating mode and termination se…

…lect on exiting forced disconnect
greatscottgadgets · Jun 7, 2024 · c546c84 · c546c84
1 parent f2b479a
commit c546c84
Showing 1 changed file with 7 additions and 3 deletions.
diff --git a/luna/gateware/usb/usb2/reset.py b/luna/gateware/usb/usb2/reset.py
@@ -532,8 +532,12 @@ def elaborate(self, platform):
 
                 # Exit DISCONNECT once the Tddis timer has expired and self.disconnect is low.
                 with m.If((~self.disconnect) & tddis):
-                    m.d.usb += tddis.eq(0)
-                    m.d.usb += timer.eq(0)
-                    m.next = 'START_HS_DETECTION'
+                    m.d.usb += [
+                        tddis.eq(0),
+                        self.current_speed.eq(USBSpeed.FULL),
+                        self.operating_mode.eq(UTMIOperatingMode.NORMAL),
+                        self.termination_select.eq(1),
+                    ]
+                    m.next = 'INITIALIZE'
 
         return m