Enumeration working.

1 files changed, 76 insertions, 2 deletions

diff --git a/main.cpp b/main.cpp
index 5128062..feb3397 100644
--- a/main.cpp
+++ b/main.cpp
@@ -17,9 +17,74 @@ static Pin& usb_dm = PA11;
 static Pin& usb_dp = PA12;
 static Pin& usb_vbus = PA9;
 
+void handle_setup(const uint32_t* bufp) {
+	led_red.toggle();
+	
+	if(bufp[0] == 0x01000680 && bufp[1] == 0x00080000) {
+		OTG_FS.dev_iep_reg[0].DIEPTSIZ = (1 << 19) | 8;
+		//                               PKTCNT
+		OTG_FS.dev_iep_reg[0].DIEPCTL |= (1 << 31) | (1 << 26);
+		//                               EPENA       CNAK
+		OTG_FS.fifo = 0x02000112;
+		OTG_FS.fifo = 0x400000ff;
+	} else if((bufp[0] & 0xffff) == 0x0500) {
+		OTG_FS.dev_reg.DCFG |= ((bufp[0] >> 16) & 0x7f) << 4;
+		
+		OTG_FS.dev_iep_reg[0].DIEPTSIZ = (1 << 19) | 0;
+		//                               PKTCNT
+		OTG_FS.dev_iep_reg[0].DIEPCTL |= (1 << 31) | (1 << 26);
+		//                               EPENA       CNAK
+	} else if(bufp[0] == 0x01000680 && bufp[1] == 0x00120000) {
+		OTG_FS.dev_iep_reg[0].DIEPTSIZ = (1 << 19) | 18;
+		//                               PKTCNT
+		OTG_FS.dev_iep_reg[0].DIEPCTL |= (1 << 31) | (1 << 26);
+		//                               EPENA       CNAK
+		OTG_FS.fifo = 0x02000112;
+		OTG_FS.fifo = 0x400000ff;
+		OTG_FS.fifo = 0x56781234;
+		OTG_FS.fifo = 0x00000000;
+		OTG_FS.fifo = 0x00000100;
+	} else if(bufp[0] == 0x02000680 && bufp[1] == 0x00040000) {
+		OTG_FS.dev_iep_reg[0].DIEPTSIZ = (1 << 19) | 4;
+		//                               PKTCNT
+		OTG_FS.dev_iep_reg[0].DIEPCTL |= (1 << 31) | (1 << 26);
+		//                               EPENA       CNAK
+		OTG_FS.fifo = 0x00090209;
+	} else if(bufp[0] == 0x02000680 && bufp[1] == 0x00090000) {
+		OTG_FS.dev_iep_reg[0].DIEPTSIZ = (1 << 19) | 9;
+		//                               PKTCNT
+		OTG_FS.dev_iep_reg[0].DIEPCTL |= (1 << 31) | (1 << 26);
+		//                               EPENA       CNAK
+		OTG_FS.fifo = 0x00090209;
+		OTG_FS.fifo = 0xc0000100;
+		OTG_FS.fifo = 0x00000000;
+	} else {
+		OTG_FS.dev_iep_reg[0].DIEPCTL |= (1 << 21);
+	}
+}
+
+static uint32_t buf[16];
+
+void handle_rxfifo() {
+	
+	uint32_t status = OTG_FS.reg.GRXSTSP;
+	
+	uint32_t len = (status & 0x7ff0) >> 6;
+	
+	for(uint32_t i = 0; i < len; i++) {
+		buf[i] = OTG_FS.fifo;
+	}
+	
+	//if(status == 0x000c0080) {
+	if((status & (0xf << 17)) == (0x4 << 17)) {
+		handle_setup(buf);
+		OTG_FS.dev_oep_reg[0].DOEPCTL |= (1 << 26);
+	}
+}
+
 template<>
 void interrupt<(Interrupt::IRQ)67>() {
-	led_red.toggle();
+	//led_red.toggle();
 	
 	// USB reset.
 	if(OTG_FS.reg.GINTSTS & (1 << 12)) {
@@ -39,6 +104,11 @@ void interrupt<(Interrupt::IRQ)67>() {
 		OTG_FS.reg.GOTGINT = (1 << 2); // SEDET
 	}
 	
+	// RxFIFO non-empty.
+	if(OTG_FS.reg.GINTSTS & (1 << 4)) {
+		handle_rxfifo();
+	}
+	
 	OTG_FS.reg.GINTSTS = 0xffffffff;
 }
 
@@ -75,12 +145,16 @@ int main() {
 	
 	OTG_FS.reg.GAHBCFG = 1;
 	
+	//OTG_FS.reg.GRSTCTL |= 1;
+	//while(OTG_FS.reg.GRSTCTL & 1);
+	//Time::sleep(10);
+	
 	// USB configuration
 	OTG_FS.reg.GUSBCFG = (1 << 30) | (0xf << 10) | (0 << 9) | (0 << 8);
 	//                   FDMOD       TRDT          HNPCAP     SRPCAP
 
 	// interrupt mask
-	OTG_FS.reg.GINTMSK = (1 << 13) | (1 << 12) | (1 << 11) | (1 << 10) | (1 << 3) | (1 << 2) | (1 << 1);
+	OTG_FS.reg.GINTMSK = (1 << 13) | (1 << 12) | (1 << 11) | (1 << 10) | (1 << 3) | (1 << 2) | (1 << 1) | (1 << 4);
 	//                   ENUMDNEM    USBRST      USBSUSPM    ESUSPM      SOFM       OTGINT     MMISM
 
 	// device configuration