Add endpoint_remove_all helper function

Add the helper function endpoint_remove_all which removes all added
endpoints. This is useful for class drivers switching between
different USB configurations.

Author: c1728p9

usb/device/USBDevice/USBDevice.cpp

@@ -36,6 +36,7 @@
 /* Endpoint macros */
 #define EP_INDEXABLE(endpoint)  (EP_VALID(endpoint) && !EP_CONTROL(endpoint))
 #define EP_TO_INDEX(endpoint)   ((((endpoint & 0xf) << 1) | (endpoint & 0x80 ? 1 : 0)) - 2)
+#define INDEX_TO_EP(index)      ((usb_ep_t)((((index) >> 1) | (index & 1 ? 0x80 : 0)) + 1))
 #define EP_VALID(endpoint)      (((endpoint) & ~0x8F) == 0)
 #define EP_CONTROL(endpoint)    (((endpoint) & 0xF) == 0)
 #define EP_RX(endpoint)         ((endpoint) & 0x80)
@@ -1101,6 +1102,20 @@ void USBDevice::endpoint_remove(usb_ep_t endpoint)
     unlock();
 }
 
+void USBDevice::endpoint_remove_all()
+{
+    lock();
+
+    for (uint32_t i = 0; i < sizeof(_endpoint_info) / sizeof(_endpoint_info[0]); i++) {
+        endpoint_info_t *info = _endpoint_info + i;
+        if (info->flags & ENDPOINT_ENABLED) {
+            endpoint_remove(INDEX_TO_EP(i));
+        }
+    }
+
+    unlock();
+}
+
 void USBDevice::endpoint_stall(usb_ep_t endpoint)
 {
     lock();

usb/device/USBDevice/USBDevice.h

@@ -175,6 +175,11 @@ class USBDevice: public  USBPhyEvents {
     */
     void endpoint_remove(usb_ep_t endpoint);
 
+    /**
+    * Remove all non-zero endpoints
+    */
+    void endpoint_remove_all();
+
     /**
     * Stall an endpoint
     *