X-Git-Url: http://sigrok.org/gitweb/?a=blobdiff_plain;f=fx2lafw.c;h=f0590b3fdc0ca4417b936d2f1b26707646207a1c;hb=a4d8b708a8cc30525c9148f77dc3d664a2d285f8;hp=6af439900fb3bd304ea2178c20abd82523cdf4e3;hpb=64d4773073e3b40c7c4a4eef609df959fa7591c9;p=sigrok-firmware-fx2lafw.git

diff --git a/fx2lafw.c b/fx2lafw.c
index 6af43990..f0590b3f 100644
--- a/fx2lafw.c
+++ b/fx2lafw.c
@@ -51,6 +51,7 @@
 
 /* ... */
 volatile bit got_sud;
+BYTE vendor_command;
 
 static void setup_endpoints(void)
 {
@@ -58,44 +59,29 @@ static void setup_endpoints(void)
 	EP2CFG = (1 << 7) |		  /* EP is valid/activated */
 		 (1 << 6) |		  /* EP direction: IN */
 		 (1 << 5) | (0 << 4) |	  /* EP Type: bulk */
-		 (0 << 3) |		  /* EP buffer size: 512 */
+		 (1 << 3) |		  /* EP buffer size: 1024 */
 		 (0 << 2) |		  /* Reserved. */
 		 (0 << 1) | (0 << 0);	  /* EP buffering: quad buffering */
 	SYNCDELAY();
 
-	/* Setup EP6 (IN) in the debug build. */
-#ifdef DEBUG
-	EP6CFG = (1 << 7) |		  /* EP is valid/activated */
-		 (1 << 6) |		  /* EP direction: IN */
-		 (1 << 5) | (0 << 4) |	  /* EP Type: bulk */
-		 (0 << 3) |		  /* EP buffer size: 512 */
-		 (0 << 2) |		  /* Reserved */
-		 (1 << 1) | (0 << 0);	  /* EP buffering: double buffering */
-#else
-	EP6CFG &= ~bmVALID;
-#endif
-	SYNCDELAY();
-
-	/* Disable all other EPs (EP1, EP4, and EP8). */
+	/* Disable all other EPs (EP1, EP4, EP6, and EP8). */
 	EP1INCFG &= ~bmVALID;
 	SYNCDELAY();
 	EP1OUTCFG &= ~bmVALID;
 	SYNCDELAY();
 	EP4CFG &= ~bmVALID;
 	SYNCDELAY();
+	EP6CFG &= ~bmVALID;
+	SYNCDELAY();
 	EP8CFG &= ~bmVALID;
 	SYNCDELAY();
 
 	/* EP2: Reset the FIFOs. */
 	/* Note: RESETFIFO() gets the EP number WITHOUT bit 7 set/cleared. */
 	RESETFIFO(0x02)
-#ifdef DEBUG
-	/* Reset the FIFOs of EP6 when in debug mode. */
-	RESETFIFO(0x06)
-#endif
 
 	/* EP2: Enable AUTOIN mode. Set FIFO width to 8bits. */
-	EP2FIFOCFG = bmAUTOIN | ~bmWORDWIDE;
+	EP2FIFOCFG = bmAUTOIN;
 	SYNCDELAY();
 
 	/* EP2: Auto-commit 512 (0x200) byte packets (due to AUTOIN = 1). */
@@ -109,24 +95,30 @@ static void setup_endpoints(void)
 	SYNCDELAY();
 }
 
+static void send_fw_version(void)
+{
+	/* Populate the buffer. */
+	struct version_info *const vi = (struct version_info *)EP0BUF;
+	vi->major = FX2LAFW_VERSION_MAJOR;
+	vi->minor = FX2LAFW_VERSION_MINOR;
+
+	/* Send the message. */
+	EP0BCH = 0;
+	EP0BCL = sizeof(struct version_info);
+}
+
 BOOL handle_vendorcommand(BYTE cmd)
 {
 	/* Protocol implementation */
-
 	switch (cmd) {
 	case CMD_START:
-		gpif_acquisition_start();
-		return TRUE;
-	case CMD_STOP:
-		GPIFABORT = 0xff;
-		/* TODO */
+		vendor_command = cmd;
+		EP0BCL = 0;
 		return TRUE;
 		break;
 	case CMD_GET_FW_VERSION:
-		/* TODO */
-		break;
-	default:
-		/* Unimplemented command. */
+		send_fw_version();
+		return TRUE;
 		break;
 	}
 
@@ -214,6 +206,7 @@ void fx2lafw_init(void)
 	REVCTL = bmNOAUTOARM | bmSKIPCOMMIT;
 
 	got_sud = FALSE;
+	vendor_command = 0;
 
 	/* Renumerate. */
 	RENUMERATE_UNCOND();
@@ -238,10 +231,40 @@ void fx2lafw_init(void)
 	gpif_init_la();
 }
 
-void fx2lafw_run(void)
+void fx2lafw_poll(void)
 {
 	if (got_sud) {
 		handle_setupdata();
 		got_sud = FALSE;
 	}
+
+	if (vendor_command) {
+		switch (vendor_command) {
+		case CMD_START:
+			if ((EP0CS & bmEPBUSY) != 0)
+				break;
+
+			if (EP0BCL == 2) {
+				gpif_acquisition_start(
+				 (const struct cmd_start_acquisition *)EP0BUF);
+			}
+
+			/* Acknowledge the vendor command. */
+			vendor_command = 0;
+			break;
+		default:
+			/* Unimplemented command. */
+			vendor_command = 0;
+			break;
+		}
+	}
+
+	gpif_poll();
+}
+
+void main(void)
+{
+	fx2lafw_init();
+	while (1)
+		fx2lafw_poll();
 }