1 files changed, 55 insertions, 0 deletions
diff --git a/src/drivers/usb.c b/src/drivers/usb.c
new file mode 100644
index 0000000..c6aa02d
--- /dev/null
+++ b/src/drivers/usb.c
@@ -0,0 +1,55 @@
+#include "../drivers/usb.h"
+#include "../sys/core.h"
+
+#define DRIVERS_USB_C
+unsigned char usb_buffer0[256] = {0};
+unsigned char usb_buffer1[256] = {0};
+
+static struct UsbDeviceRequest udr = {
+	.Type = 0xA0,     // DEVICE_TO_HOST | STDANDAD | DEVICE
+	.Request = 0x06,  // GET_DESCRIPTOR
+	.Value = 0x0100,  // descriptor.type = 0x01, decriptor.index = 0x00
+	.Index = 0,
+	.Length = 64,
+};
+
+void my_memcpy(void *dest, void *src, unsigned int n) {
+   char *src_char = (char *)src;
+   char *dest_char = (char *)dest;
+   for (unsigned int i=0; i<n; i++) {
+       dest_char[i] = src_char[i];
+   }
+}
+
+static void txrx_control_msg(uint8_t txlen)
+{
+	// send setup & control packet
+	// set dma buffer
+	*USB_HOST_HCDMA0   = (unsigned long long) usb_buffer0;
+	*USB_HOST_HCDMA0  |= 0xC0000000;
+	// HCTSIZ0.Pid = 2'd3 (SETUP) , HCTSIZ0.PktCnt = 10'h1 , HCTSIZ0.XferSize = 18'd8
+	*USB_HOST_HCTSIZ0 = 3 << 29 | 1 << 19 | txlen;
+	// HCCAR1.ChEna = 1'b1
+	*USB_HOST_HCCHAR0 |= 1<<31;
+
+	// recieve control packet
+	// set dma buffer
+	*USB_HOST_HCDMA1   = (unsigned long long) usb_buffer1;
+	*USB_HOST_HCDMA1  |= 0xC0000000;
+	// HCTSIZ1.Pid = 2'd2 (DATA1) , HCTSIZ1.PktCnt = 10'h1 , HCTSIZ1.XferSize = 18'd64
+	*USB_HOST_HCTSIZ1  = 2 << 29 | 1 << 19 | 64;
+	// HCCAR1.ChEna = 1'b1
+	*USB_HOST_HCCHAR1 |= 1<<31;
+}
+
+void send_packet(void)
+{
+	// HCCAR1.EPDir = 1'b0 (OUT) / 1'b01(IN), HCCAR1.MPS = 11'h40
+	*USB_HOST_HCCHAR0   |= 0x40;            // OUT
+	*USB_HOST_HCCHAR1   |= 1 << 15 | 0x40;  // IN
+
+	// build packet
+	my_memcpy(usb_buffer0, &udr, 8);
+
+	txrx_control_msg(8);
+}