feature(usbd): Added tud_teardown()

src/device/usbd.c

@@ -437,6 +437,31 @@ bool tud_init (uint8_t rhport)
   return true;
 }
 
+bool tud_teardown (uint8_t rhport)
+{
+  // skip if nothing to teardown
+  if ( !tud_inited() ) return true;
+
+  TU_LOG(USBD_DBG, "USBD teardown on controller %u\r\n", rhport);
+
+  // Disable interrupt
+  dcd_int_disable(rhport);
+
+  // Disable class devices
+  for (uint8_t i = 0; i < TOTAL_DRIVER_COUNT; i++)
+  {
+    usbd_class_driver_t const * driver = get_driver(i);
+    TU_ASSERT(driver);
+    TU_LOG(USBD_DBG, "%s reset\r\n", driver->name);
+    driver->reset(rhport);
+  }
+
+  // clean port
+  _usbd_rhport = RHPORT_INVALID;
+
+  return true;
+}
+
 static void configuration_reset(uint8_t rhport)
 {
   for ( uint8_t i = 0; i < TOTAL_DRIVER_COUNT; i++ )

src/device/usbd.h

@@ -43,6 +43,9 @@ bool tud_init (uint8_t rhport);
 // Check if device stack is already initialized
 bool tud_inited(void);
 
+// Teardown device stack
+bool tud_teardown (uint8_t rhport);
+
 // Task function should be called in main/rtos loop, extended version of tud_task()
 // - timeout_ms: millisecond to wait, zero = no wait, 0xFFFFFFFF = wait forever
 // - in_isr: if function is called in ISR

src/tusb.c

@@ -58,6 +58,23 @@ bool tusb_init(void)
   return true;
 }
 
+// Teardown device/host stack
+bool tusb_teardown(void)
+{
+#if CFG_TUD_ENABLED && defined(TUD_OPT_RHPORT)
+  // teardown device stack CFG_TUSB_RHPORTx_MODE must be defined
+  TU_ASSERT ( tud_teardown(TUD_OPT_RHPORT) );
+#endif
+
+#if CFG_TUH_ENABLED && defined(TUH_OPT_RHPORT)
+  // teardown host stack CFG_TUSB_RHPORTx_MODE must be defined
+  // not implemented
+  return false;
+#endif
+
+  return true;
+}
+
 bool tusb_inited(void)
 {
   bool ret = false;

src/tusb.h

@@ -133,8 +133,8 @@ bool tusb_init(void);
 // Check if stack is initialized
 bool tusb_inited(void);
 
-// TODO
-// bool tusb_teardown(void);
+// Teardown device/host stack
+bool tusb_teardown(void);
 
 #ifdef __cplusplus
  }