Simulate query delay; getting to a point where implementing clear/aborts makes

sense. Probably adding too many concurance issues; need to figure out
semaphores.

4 files changed, 77 insertions, 30 deletions

diff --git a/examples/device/usbtmc/src/main.c b/examples/device/usbtmc/src/main.c
index 8bc2a8398..1fce48f45 100644
--- a/examples/device/usbtmc/src/main.c
+++ b/examples/device/usbtmc/src/main.c
@@ -29,7 +29,7 @@
 
 #include "bsp/board.h"
 #include "tusb.h"
-
+#include "usbtmc_app.h"
 //--------------------------------------------------------------------+
 // MACRO CONSTANT TYPEDEF PROTYPES
 //--------------------------------------------------------------------+
@@ -60,6 +60,7 @@ int main(void)
   {
     tud_task(); // tinyusb device task
     led_blinking_task();
+    usbtmc_app_task_iter();
   }
 
   return 0;
diff --git a/examples/device/usbtmc/src/usb_descriptors.c b/examples/device/usbtmc/src/usb_descriptors.c
index 296636359..9567bcab5 100644
--- a/examples/device/usbtmc/src/usb_descriptors.c
+++ b/examples/device/usbtmc/src/usb_descriptors.c
@@ -110,10 +110,10 @@ uint8_t const * tud_hid_descriptor_report_cb(void)
      USBTMC_BULK_DESCRIPTORS(/* OUT = */0x03, /* IN = */ 0x83)
 
 #if defined(CFG_TUD_USBTMC_ENABLE_INT_EP)
-
+// Interrupt endpoint should be 2 bytes on a FS USB link
 #  define USBTMC_DESC(_itfnum) \
      USBTMC_DESC_MAIN(_itfnum, /* _epCount = */ 3), \
-     USBTMC_INT_DESCRIPTOR(/* INT ep # */ 0x84, /* epMaxSize = */ 64, /* bInterval = */16u )
+     USBTMC_INT_DESCRIPTOR(/* INT ep # */ 0x84, /* epMaxSize = */ 2, /* bInterval = */16u )
 #  define USBTMC_DESC_LEN (USBTMC_IF_DESCRIPTOR_LEN + USBTMC_BULK_DESCRIPTORS_LEN + USBTMC_INT_DESCRIPTOR_LEN)
 
 #else
@@ -248,7 +248,7 @@ uint16_t const* tud_descriptor_string_cb(uint8_t index)
   }
 
   // first byte is length (including header), second byte is string type
-  _desc_str[0] = (TUSB_DESC_STRING << 8 ) | (2*chr_count + 2);
+  _desc_str[0] = (((uint16_t)TUSB_DESC_STRING) << 8 ) | (2u*chr_count + 2u);
 
   return _desc_str;
 }
diff --git a/examples/device/usbtmc/src/usbtmc_app.c b/examples/device/usbtmc/src/usbtmc_app.c
index 6b72bb360..af97939b9 100644
--- a/examples/device/usbtmc/src/usbtmc_app.c
+++ b/examples/device/usbtmc/src/usbtmc_app.c
@@ -25,6 +25,7 @@
 
 #include <strings.h>
 #include "class/usbtmc/usbtmc_device.h"
+#include "bsp/board.h"
 #include "main.h"
 
 #if (USBTMC_CFG_ENABLE_488)
@@ -65,9 +66,21 @@ usbtmcd_app_capabilities  =
 };
 
 static const char idn[] = "TinyUSB,ModelNumber,SerialNumber,FirmwareVer\n";
-static uint8_t status;
-static bool queryReceived = false;
+static volatile uint8_t status;
 
+// 0=not query, 1=queried, 2=delay,set(MAV), 3=delay 4=ready?
+// (to simulate delay)
+static volatile uint16_t queryState = 0;
+static volatile uint32_t queryDelayStart;
+static volatile uint32_t bulkInStarted;
+
+static usbtmc_msg_dev_dep_msg_in_header_t rspMsg = {
+    .bmTransferAttributes =
+    {
+      .EOM = 1,
+      .UsingTermChar = 0
+    }
+};
 
 bool usbtmcd_app_msgBulkOut_start(uint8_t rhport, usbtmc_msg_request_dev_dep_out const * msgHeader)
 {
@@ -86,7 +99,7 @@ bool usbtmcd_app_msg_data(uint8_t rhport, void *data, size_t len, bool transfer_
   (void)rhport;
   (void)transfer_complete;
   if(transfer_complete && (len >=4) && !strncasecmp("*idn?",data,4)) {
-    queryReceived = true;
+    queryState = 1;
   }
   return true;
 }
@@ -98,47 +111,73 @@ bool usbtmcd_app_msgBulkIn_complete(uint8_t rhport)
 }
 
 static uint8_t noQueryMsg[] = "ERR: No query\n";
+
 bool usbtmcd_app_msgBulkIn_request(uint8_t rhport, usbtmc_msg_request_dev_dep_in const * request)
 {
-  usbtmc_msg_dev_dep_msg_in_header_t hdr = {
-      .header =
-      {
-          .MsgID = request->header.MsgID,
-          .bTag = request->header.bTag,
-          .bTagInverse = request->header.bTagInverse
-      },
-      .TransferSize = sizeof(idn)-1,
-      .bmTransferAttributes =
-      {
-        .EOM = 1,
-        .UsingTermChar = 0
-      }
-  };
-  if(queryReceived)
+  rspMsg.header.MsgID = request->header.MsgID,
+  rspMsg.header.bTag = request->header.bTag,
+  rspMsg.header.bTagInverse = request->header.bTagInverse;
+  if(queryState != 0)
   {
-    usbtmcd_transmit_dev_msg_data(rhport, &hdr, idn);
+    TU_ASSERT(bulkInStarted == 0);
+    bulkInStarted = 1;
   }
   else
   {
-    hdr.TransferSize = sizeof(noQueryMsg)-1;
-    usbtmcd_transmit_dev_msg_data(rhport, &hdr, noQueryMsg);
+    rspMsg.TransferSize = sizeof(noQueryMsg)-1;
+    usbtmcd_transmit_dev_msg_data(rhport, &rspMsg, noQueryMsg);
   }
-  queryReceived = false;
+  // Always return true indicating not to stall the EP.
   return true;
 }
 
+void usbtmc_app_task_iter(void) {
+  uint8_t const rhport = 0;
+
+  switch(queryState) {
+  case 1:
+    queryDelayStart = board_millis();
+    queryState = 2;
+    break;
+  case 2:
+    if( (board_millis() - queryDelayStart) > 1000u) {
+      queryDelayStart = board_millis();
+      queryState=3;
+      status |= 0x10u; // MAV
+    }
+    break;
+  case 3:
+    if( (board_millis() - queryDelayStart) > 1000u) {
+      queryState = 4;
+    }
+    break;
+  case 4: // time to transmit;
+    if(bulkInStarted) {
+      queryState = 0;
+      bulkInStarted = 0;
+      rspMsg.TransferSize = sizeof(idn)-1;
+      usbtmcd_transmit_dev_msg_data(rhport, &rspMsg, idn);
+      status &= ~(0x10u); // MAV
+    }
+    break;
+  }
+}
+
 // Return status byte, but put the transfer result status code in the rspResult argument.
-uint8_t usbtmcd_app_get_stb(uint8_t rhport, uint8_t *rspResult)
+uint8_t usbtmcd_app_get_stb(uint8_t rhport, uint8_t *tmcResult)
 {
   (void)rhport;
-  *rspResult = USBTMC_STATUS_SUCCESS;
+  *tmcResult = USBTMC_STATUS_SUCCESS;
   // Increment status so that we see different results on each read...
-  status++;
 
   return status;
 }
 
-bool usbtmcd_app_indicator_pluse(uint8_t rhport, tusb_control_request_t const * msg)
+bool usbtmcd_app_indicator_pluse(uint8_t rhport, tusb_control_request_t const * msg, uint8_t *tmcResult)
 {
+  (void)rhport;
+  (void)msg;
   led_indicator_pulse();
+  *tmcResult = USBTMC_STATUS_SUCCESS;
+  return true;
 }
diff --git a/examples/device/usbtmc/src/usbtmc_app.h b/examples/device/usbtmc/src/usbtmc_app.h
new file mode 100644
index 000000000..4de30c2ba
--- /dev/null
+++ b/examples/device/usbtmc/src/usbtmc_app.h
@@ -0,0 +1,7 @@
+
+#ifndef USBTMC_APP_H
+#define USBTMC_APP_H
+
+void usbtmc_app_task_iter(void);
+
+#endif