Added support for MAVLink XML inclusion, added support for multiple...

Added support for MAVLink XML inclusion, added support for multiple Autopilots, improved protocol generation

mavlinkgen.pro

+
+# }
+# Include general settings for MAVGround
+# necessary as last include to override any non-acceptable settings
+# done by the plugins above
+QT       += svg xml
+
+TEMPLATE = app
+TARGET = mavlinkgen
+
+BASEDIR = .
+BUILDDIR = build/mavlinkgen
+LANGUAGE = C++
+
+CONFIG += release
+CONFIG -= debug
+
+OBJECTS_DIR = $$BUILDDIR/obj
+MOC_DIR = $$BUILDDIR/moc
+UI_HEADERS_DIR = src/ui/generated
+
+macx:DESTDIR = $$BASEDIR/bin/mac
+
+INCLUDEPATH += . \
+    src \
+    src/ui \
+    src/comm \
+    include/ui \
+    src/ui/mavlink \
+    src/standalone/mavlinkgen
+
+# Input
+FORMS += src/ui/XMLCommProtocolWidget.ui
+
+HEADERS += src/standalone/mavlinkgen/MAVLinkGen.h \
+    src/ui/XMLCommProtocolWidget.h \
+    src/comm/MAVLinkXMLParser.h \
+    src/ui/mavlink/DomItem.h \
+    src/ui/mavlink/DomModel.h \
+    src/comm/MAVLinkSyntaxHighlighter.h
+SOURCES += src/standalone/mavlinkgen/main.cc \
+    src/standalone/mavlinkgen/MAVLinkGen.cc \
+    src/ui/XMLCommProtocolWidget.cc \
+    src/ui/mavlink/DomItem.cc \
+    src/ui/mavlink/DomModel.cc \
+    src/comm/MAVLinkXMLParser.cc \
+    src/comm/MAVLinkSyntaxHighlighter.cc
+RESOURCES = mavground.qrc

qgroundcontrol.pro

@@ -99,7 +99,6 @@ HEADERS += src/MG.h \
     src/input/JoystickInput.h \
     src/ui/JoystickWidget.h \
     src/ui/PFD.h \
-    src/ui/GaugePanel.h \
     src/ui/DebugConsole.h \
     src/ui/MapWidget.h \
     src/ui/XMLCommProtocolWidget.h \
@@ -116,7 +115,8 @@ HEADERS += src/MG.h \
     src/ui/linechart/Linecharts.h \
     src/uas/SlugsMAV.h \
     src/uas/PxQuadMAV.h \
-    src/uas/ArduPilotMAV.h
+    src/uas/ArduPilotMAV.h \
+    src/comm/MAVLinkSyntaxHighlighter.h
 SOURCES += src/main.cc \
     src/Core.cc \
     src/uas/UASManager.cc \
@@ -149,7 +149,6 @@ SOURCES += src/main.cc \
     src/input/JoystickInput.cc \
     src/ui/JoystickWidget.cc \
     src/ui/PFD.cc \
-    src/ui/GaugePanel.cc \
     src/ui/DebugConsole.cc \
     src/ui/MapWidget.cc \
     src/ui/XMLCommProtocolWidget.cc \
@@ -166,5 +165,6 @@ SOURCES += src/main.cc \
     src/ui/linechart/Linecharts.cc \
     src/uas/SlugsMAV.cc \
     src/uas/PxQuadMAV.cc \
-    src/uas/ArduPilotMAV.cc
+    src/uas/ArduPilotMAV.cc \
+    src/comm/MAVLinkSyntaxHighlighter.cc
 RESOURCES = mavground.qrc

src/comm/MAVLinkProtocol.cc

@@ -42,7 +42,9 @@ This file is part of the PIXHAWK project
 #include "UASManager.h"
 #include "UASInterface.h"
 #include "UAS.h"
-#include "SlugsMAV.h" /* FIXME REMOVE */
+#include "SlugsMAV.h"
+#include "PxQuadMAV.h"
+#include "ArduPilotMAV.h"
 #include "configuration.h"
 #include "LinkManager.h"
 #include <mavlink.h>
@@ -115,7 +117,7 @@ void MAVLinkProtocol::receiveBytes(LinkInterface* link)
             UASInterface* uas = UASManager::instance()->getUASForId(message.sysid);
 
             // Check and (if necessary) create UAS object
-            if (uas == NULL)
+            if (uas == NULL && message.msgid == MAVLINK_MSG_ID_HEARTBEAT)
             {
                 // ORDER MATTERS HERE!
                 // The UAS object has first to be created and connected,
@@ -130,9 +132,33 @@ void MAVLinkProtocol::receiveBytes(LinkInterface* link)
                     qDebug() << "WARNING\nWARNING\nWARNING\nWARNING\nWARNING\nWARNING\nWARNING\n\n RECEIVED MESSAGE FROM THIS SYSTEM WITH ID" << message.msgid << "FROM COMPONENT" << message.compid;
                 }
 
+                // Create a new UAS based on the heartbeat received
+                // Todo dynamically load plugin at run-time for MAV
+                // WIKISEARCH:AUTOPILOT_TYPE_INSTANTIATION
+
                 // First create new UAS object
-                uas = new UAS(this, message.sysid);
-                //uas = new SlugsMAV(this, message.sysid);
+                // Decode heartbeat message
+                mavlink_heartbeat_t heartbeat;
+                mavlink_msg_heartbeat_decode(&message, &heartbeat);
+                switch (heartbeat.autopilot)
+                {
+                case MAV_AUTOPILOT_GENERIC:
+                    uas = new UAS(this, message.sysid);
+                    break;
+                case MAV_AUTOPILOT_PIXHAWK:
+                    // Fixme differentiate between quadrotor and coaxial here
+                    uas = new PxQuadMAV(this, message.sysid);
+                    break;
+                case MAV_AUTOPILOT_SLUGS:
+                    uas = new SlugsMAV(this, message.sysid);
+                    break;
+                case MAV_AUTOPILOT_ARDUPILOT:
+                    uas = new ArduPilotMAV(this, message.sysid);
+                    break;
+                default:
+                    uas = new UAS(this, message.sysid);
+                    break;
+                }
 
 
                 // Make UAS aware that this link can be used to communicate with the actual robot
@@ -142,29 +168,20 @@ void MAVLinkProtocol::receiveBytes(LinkInterface* link)
                 // Now add UAS to "official" list, which makes the whole application aware of it
                 UASManager::instance()->addUAS(uas);
             }
-            // Increase receive counter
-            totalReceiveCounter++;
-            currReceiveCounter++;
-            qint64 lastLoss = totalLossCounter;
-            // Update last packet index
-            if (lastIndex[message.sysid][message.compid] == -1)
-            {
-                lastIndex[message.sysid][message.compid] = message.seq;
-            }
-            else
+
+            // Only count message if UAS exists for this message
+            if (uas != NULL)
             {
-                if (lastIndex[message.sysid][message.compid] == 255)
+                // Increase receive counter
+                totalReceiveCounter++;
+                currReceiveCounter++;
+                qint64 lastLoss = totalLossCounter;
+                // Update last packet index
+                if (lastIndex[message.sysid][message.compid] == -1)
                 {
-                    lastIndex[message.sysid][message.compid] = 0;
+                    lastIndex[message.sysid][message.compid] = message.seq;
                 }
                 else
-                {
-                    lastIndex[message.sysid][message.compid]++;
-                }
-
-                int safeguard = 0;
-                //qDebug() << "SYSID" << message.sysid << "COMPID" << message.compid << "MSGID" << message.msgid << "LASTINDEX" << lastIndex[message.sysid][message.compid] << "SEQ" << message.seq;
-                while(lastIndex[message.sysid][message.compid] != message.seq && safeguard < 255)
                 {
                     if (lastIndex[message.sysid][message.compid] == 255)
                     {
@@ -174,36 +191,50 @@ void MAVLinkProtocol::receiveBytes(LinkInterface* link)
                     {
                         lastIndex[message.sysid][message.compid]++;
                     }
-                    totalLossCounter++;
-                    currLossCounter++;
-                    safeguard++;
+
+                    int safeguard = 0;
+                    //qDebug() << "SYSID" << message.sysid << "COMPID" << message.compid << "MSGID" << message.msgid << "LASTINDEX" << lastIndex[message.sysid][message.compid] << "SEQ" << message.seq;
+                    while(lastIndex[message.sysid][message.compid] != message.seq && safeguard < 255)
+                    {
+                        if (lastIndex[message.sysid][message.compid] == 255)
+                        {
+                            lastIndex[message.sysid][message.compid] = 0;
+                        }
+                        else
+                        {
+                            lastIndex[message.sysid][message.compid]++;
+                        }
+                        totalLossCounter++;
+                        currLossCounter++;
+                        safeguard++;
+                    }
+                }
+                //            if (lastIndex.contains(message.sysid))
+                //            {
+                //                QMap<int, int>* lastCompIndex = lastIndex.value(message.sysid);
+                //                if (lastCompIndex->contains(message.compid))
+                //                while (lastCompIndex->value(message.compid, 0)+1 )
+                //            }
+                //if ()
+
+                // If a new loss was detected or we just hit one 128th packet step
+                if (lastLoss != totalLossCounter || (totalReceiveCounter & 0x7F) == 0)
+                {
+                    // Calculate new loss ratio
+                    // Receive loss
+                    float receiveLoss = (double)currLossCounter/(double)(currReceiveCounter+currLossCounter);
+                    receiveLoss *= 100.0f;
+                    // qDebug() << "LOSSCHANGED" << receiveLoss;
+                    currLossCounter = 0;
+                    currReceiveCounter = 0;
+                    emit receiveLossChanged(receiveLoss);
                 }
-            }
-            //            if (lastIndex.contains(message.sysid))
-            //            {
-            //                QMap<int, int>* lastCompIndex = lastIndex.value(message.sysid);
-            //                if (lastCompIndex->contains(message.compid))
-            //                while (lastCompIndex->value(message.compid, 0)+1 )
-            //            }
-            //if ()
-
-            // If a new loss was detected or we just hit one 128th packet step
-            if (lastLoss != totalLossCounter || (totalReceiveCounter & 0x7F) == 0)
-            {
-                // Calculate new loss ratio
-                // Receive loss
-                float receiveLoss = (double)currLossCounter/(double)(currReceiveCounter+currLossCounter);
-                receiveLoss *= 100.0f;
-               // qDebug() << "LOSSCHANGED" << receiveLoss;
-                currLossCounter = 0;
-                currReceiveCounter = 0;
-                emit receiveLossChanged(receiveLoss);
-            }
 
-            // The packet is emitted as a whole, as it is only 255 - 261 bytes short
-            // kind of inefficient, but no issue for a groundstation pc.
-            // It buys as reentrancy for the whole code over all threads
-            emit messageReceived(link, message);
+                // The packet is emitted as a whole, as it is only 255 - 261 bytes short
+                // kind of inefficient, but no issue for a groundstation pc.
+                // It buys as reentrancy for the whole code over all threads
+                emit messageReceived(link, message);
+            }
         }
     }
     receiveMutex.unlock();
@@ -273,7 +304,7 @@ void MAVLinkProtocol::sendHeartbeat()
     if (m_heartbeatsEnabled)
     {
         mavlink_message_t beat;
-        mavlink_msg_heartbeat_pack(MG::SYSTEM::ID, MG::SYSTEM::COMPID,&beat, OCU);
+        mavlink_msg_heartbeat_pack(MG::SYSTEM::ID, MG::SYSTEM::COMPID,&beat, OCU, MAV_AUTOPILOT_GENERIC);
         sendMessage(beat);
     }
 }

src/comm/MAVLinkSyntaxHighlighter.cc

+#include "MAVLinkSyntaxHighlighter.h"
+
+MAVLinkSyntaxHighlighter::MAVLinkSyntaxHighlighter(QObject *parent) :
+    QSyntaxHighlighter(parent)
+{
+}
+
+
+void MAVLinkSyntaxHighlighter::highlightBlock(const QString &text)
+ {
+     QTextCharFormat myClassFormat;
+     myClassFormat.setFontWeight(QFont::Bold);
+     myClassFormat.setForeground(Qt::darkMagenta);
+     QString pattern = "\"[A-Za-z0-9]+\"";
+
+     QRegExp expression(pattern);
+     int index = text.indexOf(expression);
+     while (index >= 0) {
+         int length = expression.matchedLength();
+         setFormat(index, length, myClassFormat);
+         index = text.indexOf(expression, index + length);
+     }
+ }

src/comm/MAVLinkSyntaxHighlighter.h

+#ifndef MAVLINKSYNTAXHIGHLIGHTER_H
+#define MAVLINKSYNTAXHIGHLIGHTER_H
+
+#include <QSyntaxHighlighter>
+
+class MAVLinkSyntaxHighlighter : public QSyntaxHighlighter
+{
+Q_OBJECT
+public:
+    explicit MAVLinkSyntaxHighlighter(QObject *parent = 0);
+
+signals:
+
+public slots:
+    void highlightBlock(const QString &text);
+
+};
+
+#endif // MAVLINKSYNTAXHIGHLIGHTER_H

src/comm/MAVLinkXMLParser.h

@@ -17,9 +17,14 @@ public slots:
     /** @brief Parse XML and generate C files */
     bool generate();
 
+signals:
+    /** @brief Status message on the parsing */
+    void parseState(QString message);
+
 protected:
     QDomDocument* doc;
     QString outputDirName;
+    QString fileName;
 };
 
 #endif // MAVLINKXMLPARSER_H

src/standalone/mavlinkgen/MAVLinkGen.cc

+/*=====================================================================
+
+PIXHAWK Micro Air Vehicle Flying Robotics Toolkit
+
+(c) 2009, 2010 PIXHAWK PROJECT  <http://pixhawk.ethz.ch>
+
+This file is part of the PIXHAWK project
+
+    PIXHAWK is free software: you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation, either version 3 of the License, or
+    (at your option) any later version.
+
+    PIXHAWK is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License
+    along with PIXHAWK. If not, see <http://www.gnu.org/licenses/>.
+
+======================================================================*/
+
+/**
+ * @file
+ *   @brief Implementation of class MAVLinkGen
+ *
+ *   @author Lorenz Meier <mavteam@student.ethz.ch>
+ *
+ */
+
+
+#include <QFile>
+#include <QFlags>
+#include <QThread>
+#include <QSplashScreen>
+#include <QPixmap>
+#include <QDesktopWidget>
+#include <QPainter>
+#include <QStyleFactory>
+#include <QAction>
+#include <QSettings>
+#include <QFontDatabase>
+#include <QMainWindow>
+
+#include "MAVLinkGen.h"
+#include "XMLCommProtocolWidget.h"
+
+
+/**
+ * @brief Constructor for the main application.
+ *
+ * This constructor initializes and starts the whole application. It takes standard
+ * command-line parameters
+ *
+ * @param argc The number of command-line parameters
+ * @param argv The string array of parameters
+ **/
+
+MAVLinkGen::MAVLinkGen(int &argc, char* argv[]) : QApplication(argc, argv)
+{
+    this->setApplicationName("MAVLink Generator");
+    this->setApplicationVersion("v. 0.1.0 (Beta)");
+    this->setOrganizationName(QLatin1String("OpenMAV Association"));
+    this->setOrganizationDomain("http://qgroundcontrol.org");
+	
+    QSettings::setDefaultFormat(QSettings::IniFormat);
+    // Exit main application when last window is closed
+    connect(this, SIGNAL(lastWindowClosed()), this, SLOT(quit()));
+	
+    // Set application font
+    QFontDatabase fontDatabase = QFontDatabase();
+    const QString fontFileName = ":/general/vera.ttf"; ///< Font file is part of the QRC file and compiled into the app
+    const QString fontFamilyName = "Bitstream Vera Sans";
+    if(!QFile::exists(fontFileName)) printf("ERROR! font file: %s DOES NOT EXIST!\n", fontFileName.toStdString().c_str());
+    fontDatabase.addApplicationFont(fontFileName);
+    setFont(fontDatabase.font(fontFamilyName, "Roman", 12));
+
+    // Create main window
+    QMainWindow* window = new QMainWindow();
+    window->setCentralWidget(new XMLCommProtocolWidget(window));
+    window->setWindowTitle(applicationName() + " " + applicationVersion());
+    window->show();
+}
+
+/**
+ * @brief Destructor for the groundstation. It destroys all loaded instances.
+ *
+ **/
+MAVLinkGen::~MAVLinkGen()
+{
+}
+

src/standalone/mavlinkgen/MAVLinkGen.h

+/*=====================================================================
+
+PIXHAWK Micro Air Vehicle Flying Robotics Toolkit
+
+(c) 2009, 2010 PIXHAWK PROJECT  <http://pixhawk.ethz.ch>
+
+This file is part of the PIXHAWK project
+
+    PIXHAWK is free software: you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation, either version 3 of the License, or
+    (at your option) any later version.
+
+    PIXHAWK is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License
+    along with PIXHAWK. If not, see <http://www.gnu.org/licenses/>.
+
+======================================================================*/
+
+/**
+ * @file
+ *   @brief Definition of class MAVLinkGen
+ *
+ *   @author Lorenz Meier <mavteam@student.ethz.ch>
+ *
+ */
+
+
+#ifndef MAVLINKGEN_H
+#define MAVLINKGEN_H
+
+#include <QApplication>
+
+/**
+ * @brief The main application and management class.
+ *
+ * This class is started by the main method and provides
+ * the central management unit of the groundstation application.
+ *
+ **/
+class MAVLinkGen : public QApplication
+{
+	Q_OBJECT
+
+public:
+        MAVLinkGen(int &argc, char* argv[]);
+        ~MAVLinkGen();
+
+protected:
+
+private:
+};
+
+#endif /* MAVLINKGEN_H */

src/standalone/mavlinkgen/main.cc

+/*=====================================================================
+
+PIXHAWK Micro Air Vehicle Flying Robotics Toolkit
+
+(c) 2009, 2010 PIXHAWK PROJECT  <http://pixhawk.ethz.ch>
+
+This file is part of the PIXHAWK project
+
+    PIXHAWK is free software: you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation, either version 3 of the License, or
+    (at your option) any later version.
+
+    PIXHAWK is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License
+    along with PIXHAWK. If not, see <http://www.gnu.org/licenses/>.
+
+======================================================================*/
+
+/**
+ * @file
+ *   @brief Main executable
+ *   @author Lorenz Meier <mavteam@student.ethz.ch>
+ *
+ */
+
+#include <QtGui/QApplication>
+#include "MAVLinkGen.h"
+
+/**
+ * @brief Starts the application
+ *
+ * @param argc Number of commandline arguments
+ * @param argv Commandline arguments
+ * @return exit code, 0 for normal exit and !=0 for error cases
+ */
+int main(int argc, char *argv[])
+{
+
+    MAVLinkGen gen(argc, argv);
+    return gen.exec();
+}

src/uas/ArduPilotMAV.cc

@@ -5,3 +5,30 @@ ArduPilotMAV::ArduPilotMAV(MAVLinkProtocol* mavlink, int id) :
         // place other initializers here
 {
 }
+
+/**
+ * This function is called by MAVLink once a complete, uncorrupted (CRC check valid)
+ * mavlink packet is received.
+ *
+ * @param link Hardware link the message came from (e.g. /dev/ttyUSB0 or UDP port).
+ *             messages can be sent back to the system via this link
+ * @param message MAVLink message, as received from the MAVLink protocol stack
+ */
+void ArduPilotMAV::receiveMessage(LinkInterface* link, mavlink_message_t message)
+{
+    // Let UAS handle the default message set
+    UAS::receiveMessage(link, message);
+
+    // Handle your special messages
+    switch (message.msgid)
+    {
+    case MAVLINK_MSG_ID_HEARTBEAT:
+        {
+            qDebug() << "ARDUPILOT RECEIVED HEARTBEAT";
+            break;
+        }
+    default:
+        qDebug() << "\nARDUPILOT RECEIVED MESSAGE WITH ID" << message.msgid;
+        break;
+    }
+}

src/uas/ArduPilotMAV.h

@@ -8,6 +8,9 @@ class ArduPilotMAV : public UAS
     Q_OBJECT
 public:
     ArduPilotMAV(MAVLinkProtocol* mavlink, int id = 0);
+public slots:
+    /** @brief Receive a MAVLink message from this MAV */
+    void receiveMessage(LinkInterface* link, mavlink_message_t message);
 };
 
 #endif // ARDUPILOTMAV_H

src/uas/PxQuadMAV.cc

@@ -4,3 +4,29 @@ PxQuadMAV::PxQuadMAV(MAVLinkProtocol* mavlink, int id) :
         UAS(mavlink, id)
 {
 }
+
+/**
+ * This function is called by MAVLink once a complete, uncorrupted (CRC check valid)
+ * mavlink packet is received.
+ *
+ * @param link Hardware link the message came from (e.g. /dev/ttyUSB0 or UDP port).
+ *             messages can be sent back to the system via this link
+ * @param message MAVLink message, as received from the MAVLink protocol stack
+ */
+void PxQuadMAV::receiveMessage(LinkInterface* link, mavlink_message_t message)
+{
+    // Let UAS handle the default message set
+    UAS::receiveMessage(link, message);
+
+    // Handle your special messages
+    switch (message.msgid)
+    {
+    case MAVLINK_MSG_ID_HEARTBEAT:
+        {
+            break;
+        }
+    default:
+        // Do nothing
+        break;
+    }
+}

src/uas/PxQuadMAV.h

@@ -8,6 +8,9 @@ class PxQuadMAV : public UAS
     Q_OBJECT
 public:
     PxQuadMAV(MAVLinkProtocol* mavlink, int id);
+public slots:
+    /** @brief Receive a MAVLink message from this MAV */
+    void receiveMessage(LinkInterface* link, mavlink_message_t message);
 };
 
 #endif // PXQUADMAV_H

src/uas/SlugsMAV.cc

@@ -8,7 +8,14 @@ SlugsMAV::SlugsMAV(MAVLinkProtocol* mavlink, int id) :
 {
 }
 
-
+/**
+ * This function is called by MAVLink once a complete, uncorrupted (CRC check valid)
+ * mavlink packet is received.
+ *
+ * @param link Hardware link the message came from (e.g. /dev/ttyUSB0 or UDP port).
+ *             messages can be sent back to the system via this link
+ * @param message MAVLink message, as received from the MAVLink protocol stack
+ */
 void SlugsMAV::receiveMessage(LinkInterface* link, mavlink_message_t message)
 {
     // Let UAS handle the default message set
@@ -19,7 +26,7 @@ void SlugsMAV::receiveMessage(LinkInterface* link, mavlink_message_t message)
     {
     case MAVLINK_MSG_ID_HEARTBEAT:
         {
-            qDebug() << "RECEIVED HEARTBEAT";
+            qDebug() << "SLUGS RECEIVED HEARTBEAT";
             break;
         }
     default:

src/uas/SlugsMAV.h

@@ -10,6 +10,7 @@ public:
     SlugsMAV(MAVLinkProtocol* mavlink, int id = 0);
 
 public slots:
+    /** @brief Receive a MAVLink message from this MAV */
     void receiveMessage(LinkInterface* link, mavlink_message_t message);
 };
 

src/uas/UAS.cc

@@ -1053,7 +1053,20 @@ int UAS::calculateTimeRemaining()
  */
 double UAS::getChargeLevel()
 {
-    return 100.0f * ((lpVoltage - emptyVoltage)/(fullVoltage - emptyVoltage));
+    float chargeLevel;
+    if (lpVoltage < emptyVoltage)
+    {
+        chargeLevel = 0.0f;
+    }
+    else if (lpVoltage > fullVoltage)
+    {
+        chargeLevel = 100.0f;
+    }
+    else
+    {
+        chargeLevel = 100.0f * ((lpVoltage - emptyVoltage)/(fullVoltage - emptyVoltage));
+    }
+    return chargeLevel;
 }
 
 void UAS::startLowBattAlarm()

src/ui/DebugConsole.cc

@@ -163,7 +163,7 @@ void DebugConsole::setAutoHold(bool hold)
 
 void DebugConsole::receiveTextMessage(int id, int severity, QString text)
 {
-    m_ui->receiveText->appendHtml(QString("<b color=\"red\">(MAV" + QString::number(id) + QString(":") + QString::number(severity) + QString(") ") + text + QString("</b>")));
+    m_ui->receiveText->appendHtml(QString("<font color=\"yellow\">(MAV" + QString::number(id) + QString(":") + QString::number(severity) + QString(") ") + text + QString("</font>")));
 }
 
 void DebugConsole::updateTrafficMeasurements()

src/ui/HDDisplay.cc

@@ -516,8 +516,10 @@ void HDDisplay::paintText(QString text, QColor color, float fontSize, float refX
     float pPositionX = refToScreenX(refX) - (fontSize*scalingFactor*0.072f);
     float pPositionY = refToScreenY(refY) - (fontSize*scalingFactor*0.212f);
 
-    //QFont font("Bitstream Vera Sans");
-    font.setPixelSize((int)(fontSize*scalingFactor*1.26f));
+    QFont font("Bitstream Vera Sans");
+    // Enforce minimum font size of 5 pixels
+    int fSize = qMax(5, (int)(fontSize*scalingFactor*1.26f));
+    font.setPixelSize(fSize);
 
     QFontMetrics metrics = QFontMetrics(font);
     int border = qMax(4, metrics.leading());

src/ui/HUD.cc

@@ -444,8 +444,10 @@ void HUD::paintText(QString text, QColor color, float fontSize, float refX, floa
     float pPositionX = refToScreenX(refX) - (fontSize*scalingFactor*0.072f);
     float pPositionY = refToScreenY(refY) - (fontSize*scalingFactor*0.212f);
 
-    //QFont font("Bitstream Vera Sans");
-    font.setPixelSize((int)(fontSize*scalingFactor*1.26f));
+    QFont font("Bitstream Vera Sans");
+    // Enforce minimum font size of 5 pixels
+    int fSize = qMax(1, (int)(fontSize*scalingFactor*1.26f));
+    font.setPixelSize(fSize);
 
     QFontMetrics metrics = QFontMetrics(font);
     int border = qMax(4, metrics.leading());