Simplify logSendBytes

Remove the use of mavlink_parse_char which distorts channel stats

src/comm/MAVLinkProtocol.cc

@@ -167,30 +167,17 @@ void MAVLinkProtocol::resetMetadataForLink(LinkInterface *link)
 
 void MAVLinkProtocol::logSentBytes(LinkInterface* link, QByteArray b){
 
-    uint8_t mavlinkChannel = link->mavlinkChannel();
-    static mavlink_message_t _sent_message;
-
-    for (int position = 0; position < b.size(); position++) {
+    uint8_t bytes_time[sizeof(quint64)];
 
-        if(mavlink_parse_char(mavlinkChannel, static_cast<uint8_t>(b[position]), &_sent_message, &_status)){
+    Q_UNUSED(link);
 
-            if (!_logSuspendError && !_logSuspendReplay && _tempLogFile.isOpen()) {
-                uint8_t buf[MAVLINK_MAX_PACKET_LEN+sizeof(quint64)];
-
-                // Write the uint64 time in microseconds in big endian format before the message.
-                // This timestamp is saved in UTC time. We are only saving in ms precision because
-                // getting more than this isn't possible with Qt without a ton of extra code.
     quint64 time = static_cast<quint64>(QDateTime::currentMSecsSinceEpoch() * 1000);
-                qToBigEndian(time, buf);
 
-                // Then write the message to the buffer
-                int len = mavlink_msg_to_send_buffer(buf + sizeof(quint64), &_sent_message);
+    qToBigEndian(time,bytes_time);
 
-                // Determine how many bytes were written by adding the timestamp size to the message size
-                len += sizeof(quint64);
+    b.insert(0,QByteArray((const char*)bytes_time,sizeof(bytes_time)));
 
-                // Now write this timestamp/message pair to the log.
-                QByteArray b(reinterpret_cast<const char*>(buf), len);
+    int len = b.count(); 
 
     if(_tempLogFile.write(b) != len)
     {
@@ -199,9 +186,6 @@ void MAVLinkProtocol::logSentBytes(LinkInterface* link, QByteArray b){
         _stopLogging();
         _logSuspendError = true;
     }
-            }
-        }
-    }
 
 }