diff --git a/Modules/Mavlink/mavlinkcommandadapter.h b/Modules/Mavlink/mavlinkcommandadapter.h index d78315746b7339546dd08401db0af8b3dd1ac100..60d82f73d997f149137958de162154331e393260 100644 --- a/Modules/Mavlink/mavlinkcommandadapter.h +++ b/Modules/Mavlink/mavlinkcommandadapter.h @@ -40,6 +40,9 @@ public: //void loadMsgDefinition(); + static const int MAV_CMP = 96; + static const int MAV_SYS = 171; + signals: void publishRequested(const ModuleMessage &msg); @@ -52,9 +55,6 @@ private: QMap<QString, int> msgNameIdMap; //QString msgDefinitionFile = GroundStation::getResourceDirectory()+"/mavlinkMsgDefinition.xml"; - static const int MAV_CMP = 1; - static const int MAV_SYS = 1; - int portNumber = -1; }; diff --git a/Modules/Mavlink/mavlinkmodule.cpp b/Modules/Mavlink/mavlinkmodule.cpp index 2c65c846a1401ffb5bf95b11f2fb9a2adcf80d99..cbf6cd6cfef7dfe4f6d45c0039262da333e67357 100644 --- a/Modules/Mavlink/mavlinkmodule.cpp +++ b/Modules/Mavlink/mavlinkmodule.cpp @@ -58,6 +58,7 @@ void MavlinkModule::subscribe() getCore()->getModuleMessagesBroker()->subscribe(SkywardHubStrings::commandsTopic,this,[this](const ModuleMessage &msg){ onCommandReceived(msg); }); + getCore()->getModuleMessagesBroker()->subscribe(SkywardHubStrings::telemetryRequestTopic,this,[this](const ModuleMessage &msg){ onTelemetryRequestReceived(msg); }); @@ -402,8 +403,8 @@ void MavlinkModule::onCommandReceived(const ModuleMessage &msg) // } // } - encoded_mvl_msg.sysid = validSysid; - encoded_mvl_msg.compid = validCompid; + //encoded_mvl_msg.sysid = validSysid; + //encoded_mvl_msg.compid = validCompid; if(portOpen && portNumber >= 0){ mavlinkCommandAdapter.send(encoded_mvl_msg); @@ -483,8 +484,8 @@ void MavlinkModule::onTelemetryRequestReceived(const ModuleMessage &msg) // encoded_mvl_msg = mavlinkCommandAdapter.encode_TELEMETRY_REQUEST_TC(MAV_STRAIN_BOARD_TM_ID); // } - encoded_mvl_msg.sysid = validSysid; - encoded_mvl_msg.compid = validCompid; + //encoded_mvl_msg.sysid = validSysid; + //encoded_mvl_msg.compid = validCompid; if(portOpen && portNumber >= 0){ mavlinkCommandAdapter.send(encoded_mvl_msg); diff --git a/Modules/Mavlink/mavlinkreader.cpp b/Modules/Mavlink/mavlinkreader.cpp index 733a9df9f01825abb1cc1444997392e33846dcdb..2d339c6d33edc161efd1ec9cb2cf39b02bdfe59c 100644 --- a/Modules/Mavlink/mavlinkreader.cpp +++ b/Modules/Mavlink/mavlinkreader.cpp @@ -7,6 +7,7 @@ #include "rs232.h" #include "Modules/skywardhubstrings.h" #include <QDir> +#include "mavlinkcommandadapter.h" MavlinkReader::MavlinkReader() { @@ -62,10 +63,11 @@ void MavlinkReader::run() bool MavlinkReader::chackMsgOwnership(const mavlink_message_t& msg) const { - if(msg.sysid == validSysid && msg.compid == validCompid){ - return true; - } - return false; + return true; +// if(msg.sysid == MavlinkCommandAdapter::MAV_SYS && msg.compid == MavlinkCommandAdapter::MAV_CMP){ +// return true; +// } +// return false; } diff --git a/Modules/Mavlink/mavlinkversionheader.h b/Modules/Mavlink/mavlinkversionheader.h index ecf5344ae5ddd99ec5c45d326bfbdb87b5bab701..dbc925c460d3a451ac91eae65223b13a88d14d83 100644 --- a/Modules/Mavlink/mavlinkversionheader.h +++ b/Modules/Mavlink/mavlinkversionheader.h @@ -4,8 +4,8 @@ //#include "mavlink_skyward_lib/mavlink_lib/hermes/mavlink.h" #include "mavlink_skyward_lib/mavlink_lib/lynx/mavlink.h" -static __attribute__((unused)) uint8_t validSysid = 171; -static __attribute__((unused)) uint8_t validCompid = 96; +//static __attribute__((unused)) uint8_t validSysid = 171; +//static __attribute__((unused)) uint8_t validCompid = 96; #endif // MAVLINKVERSIONHEADER_H diff --git a/Modules/moduleinfo.h b/Modules/moduleinfo.h index 0aa4a56db15c27b86e3e589ad88b18f94edec8e5..12a3f04802d4143dd92c94a8e7a7e1020bc699a4 100644 --- a/Modules/moduleinfo.h +++ b/Modules/moduleinfo.h @@ -24,7 +24,8 @@ enum ModuleId{ STATEVIEWER, VALUESCONVERTERVIEWER, MAVLINK_RCK_TESTING, - TIMER_CONTROLLER + TIMER_CONTROLLER, + MODULETEST }; enum ModuleCategory{ diff --git a/Modules/moduleslist.cpp b/Modules/moduleslist.cpp index d05a126276c5310f89b11fb3eeacc6bfea7a5072..1c1cb0350671ac1e7458154db22ae95ca9255e9f 100644 --- a/Modules/moduleslist.cpp +++ b/Modules/moduleslist.cpp @@ -161,7 +161,6 @@ void ModulesList::createModuleList() timerController.addModuleSourceFiles("Modules/TimerController/"); addModuleInfo(timerController); #endif - } diff --git a/SkywardHub.pro.user b/SkywardHub.pro.user index 863e5eae4c27202956e98b918dc6051b67e20ac3..974552b0af4129484f2dbb02b238549376a054ae 100644 --- a/SkywardHub.pro.user +++ b/SkywardHub.pro.user @@ -1,6 +1,6 @@ <?xml version="1.0" encoding="UTF-8"?> <!DOCTYPE QtCreatorProject> -<!-- Written by QtCreator 4.14.2, 2021-10-01T22:10:38. --> +<!-- Written by QtCreator 4.14.2, 2021-10-30T12:42:19. --> <qtcreator> <data> <variable>EnvironmentId</variable>