Handle CLEAR_HALT

HydraDancer · Jan 31, 2025 · ef5b27e · ef5b27e
1 parent 2a40bfa
commit ef5b27e
Show file tree

Hide file tree

Showing 2 changed files with 17 additions and 0 deletions.
diff --git a/hydradancer/firmware_hydradancer/User/definitions.h b/hydradancer/firmware_hydradancer/User/definitions.h
@@ -31,6 +31,7 @@
 #define CHECK_HYDRADANCER_READY 57
 #define DO_BUS_RESET 58
 #define CONFIGURED 59
+#define CLEAR_HALT 60
 
 #define EVENT_BUS_RESET 0x0
 #define EVENT_IN_BUFFER_AVAILABLE 0x1

diff --git a/hydradancer/firmware_hydradancer/User/usb_control_handlers.h b/hydradancer/firmware_hydradancer/User/usb_control_handlers.h
@@ -198,6 +198,22 @@ uint16_t usb_control_endp0_user_handled_control_request(USB_SETUP* request, uint
 		}
 		return 0;
 	}
+	else if (request->bRequest == CLEAR_HALT)
+	{
+		LOG("CLEAR_HALT ep %d dir %d \r\n", request->wValue.bw.bb1, request->wValue.bw.bb0);
+
+		uint32_t ep = 0;
+		if (request->wValue.bw.bb0 == 0)
+		{
+			ep = 1U << ((request->wValue.bw.bb1 - 1) * 2 + 1);
+		}
+		else
+		{
+			ep = 1U << ((request->wValue.bw.bb1 - 1) * 2);
+		}
+		usb2_setup_endpoints_in_mask(ep);
+		return 0;
+	}
 	else if (request->bRequest == CHECK_HYDRADANCER_READY)
 	{
 		*buf = (uint8_t*)&boards_ready;