X-Git-Url: http://git.linex4red.de/pub/lufa.git/blobdiff_plain/1d26e78258c10dcca63e31e66732f1e525b5dade..73d9fafc0fe42741ad8f609dd4762e2bc14cbd01:/LUFA/Drivers/USB/LowLevel/Template/Template_Endpoint_Control_W.c

diff --git a/LUFA/Drivers/USB/LowLevel/Template/Template_Endpoint_Control_W.c b/LUFA/Drivers/USB/LowLevel/Template/Template_Endpoint_Control_W.c
new file mode 100644
index 000000000..2796c6425
--- /dev/null
+++ b/LUFA/Drivers/USB/LowLevel/Template/Template_Endpoint_Control_W.c
@@ -0,0 +1,39 @@
+uint8_t TEMPLATE_FUNC_NAME (void* Buffer, uint16_t Length)
+{
+	uint8_t* DataStream     = (uint8_t*)(Buffer + TEMPLATE_BUFFER_OFFSET(Length));
+	bool     LastPacketFull = false;
+	
+	if (Length > USB_ControlRequest.wLength)
+	  Length = USB_ControlRequest.wLength;
+	
+	while (Length && !(Endpoint_IsOUTReceived()))
+	{
+		while (!(Endpoint_IsINReady()));
+		
+		while (Length && (Endpoint_BytesInEndpoint() < USB_ControlEndpointSize))
+		{
+			TEMPLATE_TRANSFER_BYTE(DataStream);
+			Length--;
+		}
+		
+		LastPacketFull = (Endpoint_BytesInEndpoint() == USB_ControlEndpointSize);
+		Endpoint_ClearIN();
+	}
+	
+	if (Endpoint_IsOUTReceived())
+	  return ENDPOINT_RWCSTREAM_HostAborted;
+	
+	if (LastPacketFull)
+	{
+		while (!(Endpoint_IsINReady()));
+		Endpoint_ClearIN();
+	}
+	
+	while (!(Endpoint_IsOUTReceived()));
+
+	return ENDPOINT_RWCSTREAM_NoError;
+}
+
+#undef TEMPLATE_BUFFER_OFFSET
+#undef TEMPLATE_FUNC_NAME
+#undef TEMPLATE_TRANSFER_BYTE
\ No newline at end of file