main.cc: allow command line override of systemId (example --system-id:255)

Author: Davidsastresas

src/main.cc

@@ -18,6 +18,7 @@
 #include "QGCApplication.h"
 #include "AppMessages.h"
 #include "CmdLineOptParser.h"
+#include "MAVLinkProtocol.h"
 
 #if !defined(Q_OS_ANDROID) && !defined(Q_OS_IOS)
     #include <QtWidgets/QMessageBox>
@@ -150,6 +151,8 @@ int main(int argc, char *argv[])
 
     bool runUnitTests = false;
     bool simpleBootTest = false;
+    QString systemIdStr = QString();
+    bool hasSystemId = false;
 
 #ifdef QT_DEBUG
     // We parse a small set of command line options here prior to QGCApplication in order to handle the ones
@@ -163,6 +166,7 @@ int main(int argc, char *argv[])
         { "--unittest",             &runUnitTests,          &unitTestOptions },
         { "--unittest-stress",      &stressUnitTests,       &unitTestOptions },
         { "--no-windows-assert-ui", &quietWindowsAsserts,   nullptr },
+        { "--system-id",            &hasSystemId,           &systemIdStr },
         // Add additional command line option flags here
     };
 
@@ -201,6 +205,18 @@ int main(int argc, char *argv[])
 
     app.init();
 
+    // Set system ID if specified via command line, for example --system-id:255
+    if (hasSystemId) {
+        bool ok;
+        int systemId = systemIdStr.toInt(&ok);
+        if (ok && systemId >= 0 && systemId <= 255) {  // MAVLink system IDs are 8-bit
+            qDebug() << "Setting MAVLink System ID to:" << systemId;
+            MAVLinkProtocol::instance()->setSystemId(systemId);
+        } else {
+            qDebug() << "Not setting MAVLink System ID. It must be between 0 and 255. Invalid system ID value:" << systemIdStr;
+        }
+    }
+
     int exitCode = 0;
 
 #ifdef QGC_UNITTEST_BUILD