fix(ulog): the index of the timestamp may be non-zero (#1016)

The previous parsing assumed that the timestamp for a ulog data series
was always at index 0, which is often, but not necessarily the case. The
parser now store the correct index when parsing the definition.

Author: kibidev

plotjuggler_plugins/DataLoadULog/ulog_parser.cpp

@@ -153,10 +153,6 @@ void ULogParser::parseDataMessage(const ULogParser::Subscription& sub, char* mes
   }
   Timeseries& timeseries = ts_it->second;
 
-  uint64_t time_val = *reinterpret_cast<uint64_t*>(message);
-  timeseries.timestamps.push_back(time_val);
-  message += sizeof(uint64_t);
-
   size_t index = 0;
   parseSimpleDataMessage(timeseries, sub.format, message, &index);
 }
@@ -173,8 +169,16 @@ char* ULogParser::parseSimpleDataMessage(Timeseries& timeseries, const Format* f
       continue;
     }
 
+    bool timestamp_done = false;
     for (int array_pos = 0; array_pos < field.array_size; array_pos++)
     {
+      if (*index == format->timestamp_idx && !timestamp_done)
+      {
+        timestamp_done = true;
+        uint64_t time_val = *reinterpret_cast<uint64_t*>(message);
+        timeseries.timestamps.push_back(time_val);
+        message += sizeof(uint64_t);
+      }
       double value = 0;
       switch (field.type)
       {
@@ -619,7 +623,7 @@ bool ULogParser::readFormat(DataStream& datastream, uint16_t msg_size)
 
     if (field.type == UINT64 && field_name == StringView("timestamp"))
     {
-      // skip
+      format.timestamp_idx = format.fields.size();
     }
     else
     {
@@ -628,6 +632,12 @@ bool ULogParser::readFormat(DataStream& datastream, uint16_t msg_size)
     }
   }
 
+  if (format.timestamp_idx < 0)
+  {
+    // Required timestamp is not found in definition
+    return false;
+  }
+
   format.name = name;
   _formats[name] = std::move(format);
 

plotjuggler_plugins/DataLoadULog/ulog_parser.h

@@ -79,12 +79,13 @@ class ULogParser
 
   struct Format
   {
-    Format() : padding(0)
+    Format() : padding(0), timestamp_idx(-1)
     {
     }
     std::string name;
     std::vector<Field> fields;
     int padding;
+    int timestamp_idx;
   };
 
   struct MessageLog