Import fx2lib into fx2lafw directly.

[sigrok-firmware-fx2lafw.git] / fx2lafw.c

diff --git a/fx2lafw.c b/fx2lafw.c
index c523b1609eb82f0f27f061f177e24e6ce1d93a89..018f7604dbdf731f54c26a6fcbdbb09b4dde5bbb 100644 (file)
--- a/fx2lafw.c
+++ b/fx2lafw.c
@@ -95,18 +95,47 @@ 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);
+}
+
+static void send_revid_version(void)
+{
+       uint8_t *p;
+
+       /* Populate the buffer. */
+       p = (uint8_t *)EP0BUF;
+       *p = REVID;
+
+       /* Send the message. */
+       EP0BCH = 0;
+       EP0BCL = 1;
+}
+
 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;
+               break;
        case CMD_GET_FW_VERSION:
-               vendor_command = cmd;
+               send_fw_version();
+               return TRUE;
+               break;
+       case CMD_GET_REVID_VERSION:
+               send_revid_version();
                return TRUE;
-       default:
-               /* Unimplemented command. */
                break;
        }
 
@@ -228,26 +257,18 @@ 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)
+                       if ((EP0CS & bmEPBUSY) != 0)
                                break;
 
-                       if(EP0BCL == 2) {
+                       if (EP0BCL == sizeof(struct cmd_start_acquisition)) {
                                gpif_acquisition_start(
-                                       (const struct cmd_start_acquisition*)EP0BUF);
+                                (const struct cmd_start_acquisition *)EP0BUF);
                        }
 
                        /* Acknowledge the vendor command. */
                        vendor_command = 0;
                        break;
-
                default:
                        /* Unimplemented command. */
                        vendor_command = 0;
@@ -257,3 +278,10 @@ void fx2lafw_poll(void)
 
        gpif_poll();
 }
+
+void main(void)
+{
+       fx2lafw_init();
+       while (1)
+               fx2lafw_poll();
+}