X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=fx2lafw.c;h=dc54d0052a53245b0b6bf580598806b1b67e81fa;hb=18544912fb14f1beb10fe375aad9743a8e8df790;hp=f69fcd5af6b068898c99861c05d593b0b502bfd1;hpb=f7f91781e4d4d5543371d76bb295316a6655e535;p=sigrok-firmware-fx2lafw.git

diff --git a/fx2lafw.c b/fx2lafw.c
index f69fcd5a..dc54d005 100644
--- a/fx2lafw.c
+++ b/fx2lafw.c
@@ -95,19 +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:
-		/* There is data to receive - arm EP0 */
+		vendor_command = cmd;
 		EP0BCL = 0;
+		return TRUE;
+
 	case CMD_GET_FW_VERSION:
-		vendor_command = cmd;
+		send_fw_version();
 		return TRUE;
-	default:
-		/* Unimplemented command. */
-		break;
 	}
 
 	return FALSE;
@@ -228,13 +239,6 @@ void fx2lafw_poll(void)
 
 	if (vendor_command) {
 		switch (vendor_command) {
-		case CMD_GET_FW_VERSION:
-			/* TODO */
-
-			/* Acknowledge the vendor command. */
-			vendor_command = 0;
-			break;
-
 		case CMD_START:
 			if((EP0CS & bmEPBUSY) != 0)
 				break;