diff --git a/src/AutoPilotPlugins/APM/APMCameraComponent.qml b/src/AutoPilotPlugins/APM/APMCameraComponent.qml index bd9308ff3661e88ae00a9f25fb042fd1612bc487..121cfdf728021863264103e7af73ea0621ad2aa2 100644 --- a/src/AutoPilotPlugins/APM/APMCameraComponent.qml +++ b/src/AutoPilotPlugins/APM/APMCameraComponent.qml @@ -92,19 +92,12 @@ SetupPage { } function setGimbalSettingsServoInfo(loader, channel) { - var rcPrefix = "RC" + channel + "_" + var rcPrefix = "r.SERVO" + channel + "_" loader.gimbalOutIndex = channel - 4 loader.servoPWMMinFact = controller.getParameterFact(-1, rcPrefix + "MIN") loader.servoPWMMaxFact = controller.getParameterFact(-1, rcPrefix + "MAX") - if (controller.parameterExists(-1, "RC5_REVERSED")) { - // Newer firmware parameter - loader.servoReverseFact = controller.getParameterFact(-1, rcPrefix + "REVERSED") - } else { - // Older firmware parameter - loader.servoReverseFact = controller.getParameterFact(-1, rcPrefix + "REV") - } - + loader.servoReverseFact = controller.getParameterFact(-1, rcPrefix + "REVERSED") } /// Gimbal output channels are stored in SERVO#_FUNCTION parameters. We need to loop through those diff --git a/src/FirmwarePlugin/APM/ArduCopterFirmwarePlugin.cc b/src/FirmwarePlugin/APM/ArduCopterFirmwarePlugin.cc index dba4a5f1155cae5fe0440563486246ee201d011a..4d07f66673ac31ab1ce182c16f0986e2e9d2cb13 100644 --- a/src/FirmwarePlugin/APM/ArduCopterFirmwarePlugin.cc +++ b/src/FirmwarePlugin/APM/ArduCopterFirmwarePlugin.cc @@ -108,6 +108,39 @@ ArduCopterFirmwarePlugin::ArduCopterFirmwarePlugin(void) remapV3_5["SERVO13_FUNCTION"] = QStringLiteral("RC13_FUNCTION"); remapV3_5["SERVO14_FUNCTION"] = QStringLiteral("RC14_FUNCTION"); + remapV3_5["SERVO5_MIN"] = QStringLiteral("RC5_MIN"); + remapV3_5["SERVO6_MIN"] = QStringLiteral("RC6_MIN"); + remapV3_5["SERVO7_MIN"] = QStringLiteral("RC7_MIN"); + remapV3_5["SERVO8_MIN"] = QStringLiteral("RC8_MIN"); + remapV3_5["SERVO9_MIN"] = QStringLiteral("RC9_MIN"); + remapV3_5["SERVO10_MIN"] = QStringLiteral("RC10_MIN"); + remapV3_5["SERVO11_MIN"] = QStringLiteral("RC11_MIN"); + remapV3_5["SERVO12_MIN"] = QStringLiteral("RC12_MIN"); + remapV3_5["SERVO13_MIN"] = QStringLiteral("RC13_MIN"); + remapV3_5["SERVO14_MIN"] = QStringLiteral("RC14_MIN"); + + remapV3_5["SERVO5_MAX"] = QStringLiteral("RC5_MAX"); + remapV3_5["SERVO6_MAX"] = QStringLiteral("RC6_MAX"); + remapV3_5["SERVO7_MAX"] = QStringLiteral("RC7_MAX"); + remapV3_5["SERVO8_MAX"] = QStringLiteral("RC8_MAX"); + remapV3_5["SERVO9_MAX"] = QStringLiteral("RC9_MAX"); + remapV3_5["SERVO10_MAX"] = QStringLiteral("RC10_MAX"); + remapV3_5["SERVO11_MAX"] = QStringLiteral("RC11_MAX"); + remapV3_5["SERVO12_MAX"] = QStringLiteral("RC12_MAX"); + remapV3_5["SERVO13_MAX"] = QStringLiteral("RC13_MAX"); + remapV3_5["SERVO14_MAX"] = QStringLiteral("RC14_MAX"); + + remapV3_5["SERVO5_REVERSED"] = QStringLiteral("RC5_REVERSED"); + remapV3_5["SERVO6_REVERSED"] = QStringLiteral("RC6_REVERSED"); + remapV3_5["SERVO7_REVERSED"] = QStringLiteral("RC7_REVERSED"); + remapV3_5["SERVO8_REVERSED"] = QStringLiteral("RC8_REVERSED"); + remapV3_5["SERVO9_REVERSED"] = QStringLiteral("RC9_REVERSED"); + remapV3_5["SERVO10_REVERSED"] = QStringLiteral("RC10_REVERSED"); + remapV3_5["SERVO11_REVERSED"] = QStringLiteral("RC11_REVERSED"); + remapV3_5["SERVO12_REVERSED"] = QStringLiteral("RC12_REVERSED"); + remapV3_5["SERVO13_REVERSED"] = QStringLiteral("RC13_REVERSED"); + remapV3_5["SERVO14_REVERSED"] = QStringLiteral("RC14_REVERSED"); + _remapParamNameIntialized = true; } } diff --git a/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.cc b/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.cc index 996551e100d4825816fdc56e95b3c2f8630c9631..8b7953bf6039bbd1505ff411d0729a3a410046c9 100644 --- a/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.cc +++ b/src/FirmwarePlugin/APM/ArduPlaneFirmwarePlugin.cc @@ -77,6 +77,39 @@ ArduPlaneFirmwarePlugin::ArduPlaneFirmwarePlugin(void) remapV3_8["SERVO13_FUNCTION"] = QStringLiteral("RC13_FUNCTION"); remapV3_8["SERVO14_FUNCTION"] = QStringLiteral("RC14_FUNCTION"); + remapV3_8["SERVO5_MIN"] = QStringLiteral("RC5_MIN"); + remapV3_8["SERVO6_MIN"] = QStringLiteral("RC6_MIN"); + remapV3_8["SERVO7_MIN"] = QStringLiteral("RC7_MIN"); + remapV3_8["SERVO8_MIN"] = QStringLiteral("RC8_MIN"); + remapV3_8["SERVO9_MIN"] = QStringLiteral("RC9_MIN"); + remapV3_8["SERVO10_MIN"] = QStringLiteral("RC10_MIN"); + remapV3_8["SERVO11_MIN"] = QStringLiteral("RC11_MIN"); + remapV3_8["SERVO12_MIN"] = QStringLiteral("RC12_MIN"); + remapV3_8["SERVO13_MIN"] = QStringLiteral("RC13_MIN"); + remapV3_8["SERVO14_MIN"] = QStringLiteral("RC14_MIN"); + + remapV3_8["SERVO5_MAX"] = QStringLiteral("RC5_MAX"); + remapV3_8["SERVO6_MAX"] = QStringLiteral("RC6_MAX"); + remapV3_8["SERVO7_MAX"] = QStringLiteral("RC7_MAX"); + remapV3_8["SERVO8_MAX"] = QStringLiteral("RC8_MAX"); + remapV3_8["SERVO9_MAX"] = QStringLiteral("RC9_MAX"); + remapV3_8["SERVO10_MAX"] = QStringLiteral("RC10_MAX"); + remapV3_8["SERVO11_MAX"] = QStringLiteral("RC11_MAX"); + remapV3_8["SERVO12_MAX"] = QStringLiteral("RC12_MAX"); + remapV3_8["SERVO13_MAX"] = QStringLiteral("RC13_MAX"); + remapV3_8["SERVO14_MAX"] = QStringLiteral("RC14_MAX"); + + remapV3_8["SERVO5_REVERSED"] = QStringLiteral("RC5_REVERSED"); + remapV3_8["SERVO6_REVERSED"] = QStringLiteral("RC6_REVERSED"); + remapV3_8["SERVO7_REVERSED"] = QStringLiteral("RC7_REVERSED"); + remapV3_8["SERVO8_REVERSED"] = QStringLiteral("RC8_REVERSED"); + remapV3_8["SERVO9_REVERSED"] = QStringLiteral("RC9_REVERSED"); + remapV3_8["SERVO10_REVERSED"] = QStringLiteral("RC10_REVERSED"); + remapV3_8["SERVO11_REVERSED"] = QStringLiteral("RC11_REVERSED"); + remapV3_8["SERVO12_REVERSED"] = QStringLiteral("RC12_REVERSED"); + remapV3_8["SERVO13_REVERSED"] = QStringLiteral("RC13_REVERSED"); + remapV3_8["SERVO14_REVERSED"] = QStringLiteral("RC14_REVERSED"); + _remapParamNameIntialized = true; } } diff --git a/src/FirmwarePlugin/APM/ArduRoverFirmwarePlugin.cc b/src/FirmwarePlugin/APM/ArduRoverFirmwarePlugin.cc index bbb7ed961e1155518bd6d6a17c87d2f326a768f2..1e30340f13b01bc04be10f2bdd4d46248fa8a1ac 100644 --- a/src/FirmwarePlugin/APM/ArduRoverFirmwarePlugin.cc +++ b/src/FirmwarePlugin/APM/ArduRoverFirmwarePlugin.cc @@ -55,6 +55,39 @@ ArduRoverFirmwarePlugin::ArduRoverFirmwarePlugin(void) remapV3_2["SERVO13_FUNCTION"] = QStringLiteral("RC13_FUNCTION"); remapV3_2["SERVO14_FUNCTION"] = QStringLiteral("RC14_FUNCTION"); + remapV3_2["SERVO5_MIN"] = QStringLiteral("RC5_MIN"); + remapV3_2["SERVO6_MIN"] = QStringLiteral("RC6_MIN"); + remapV3_2["SERVO7_MIN"] = QStringLiteral("RC7_MIN"); + remapV3_2["SERVO8_MIN"] = QStringLiteral("RC8_MIN"); + remapV3_2["SERVO9_MIN"] = QStringLiteral("RC9_MIN"); + remapV3_2["SERVO10_MIN"] = QStringLiteral("RC10_MIN"); + remapV3_2["SERVO11_MIN"] = QStringLiteral("RC11_MIN"); + remapV3_2["SERVO12_MIN"] = QStringLiteral("RC12_MIN"); + remapV3_2["SERVO13_MIN"] = QStringLiteral("RC13_MIN"); + remapV3_2["SERVO14_MIN"] = QStringLiteral("RC14_MIN"); + + remapV3_2["SERVO5_MAX"] = QStringLiteral("RC5_MAX"); + remapV3_2["SERVO6_MAX"] = QStringLiteral("RC6_MAX"); + remapV3_2["SERVO7_MAX"] = QStringLiteral("RC7_MAX"); + remapV3_2["SERVO8_MAX"] = QStringLiteral("RC8_MAX"); + remapV3_2["SERVO9_MAX"] = QStringLiteral("RC9_MAX"); + remapV3_2["SERVO10_MAX"] = QStringLiteral("RC10_MAX"); + remapV3_2["SERVO11_MAX"] = QStringLiteral("RC11_MAX"); + remapV3_2["SERVO12_MAX"] = QStringLiteral("RC12_MAX"); + remapV3_2["SERVO13_MAX"] = QStringLiteral("RC13_MAX"); + remapV3_2["SERVO14_MAX"] = QStringLiteral("RC14_MAX"); + + remapV3_2["SERVO5_REVERSED"] = QStringLiteral("RC5_REVERSED"); + remapV3_2["SERVO6_REVERSED"] = QStringLiteral("RC6_REVERSED"); + remapV3_2["SERVO7_REVERSED"] = QStringLiteral("RC7_REVERSED"); + remapV3_2["SERVO8_REVERSED"] = QStringLiteral("RC8_REVERSED"); + remapV3_2["SERVO9_REVERSED"] = QStringLiteral("RC9_REVERSED"); + remapV3_2["SERVO10_REVERSED"] = QStringLiteral("RC10_REVERSED"); + remapV3_2["SERVO11_REVERSED"] = QStringLiteral("RC11_REVERSED"); + remapV3_2["SERVO12_REVERSED"] = QStringLiteral("RC12_REVERSED"); + remapV3_2["SERVO13_REVERSED"] = QStringLiteral("RC13_REVERSED"); + remapV3_2["SERVO14_REVERSED"] = QStringLiteral("RC14_REVERSED"); + _remapParamNameIntialized = true; } } diff --git a/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.cc b/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.cc index 78ca8d4ee4b70a33c4cb67bf5d7ecc4fe4aa4f3e..cc0ff973ec11308cf1ea69385ddb6ba36957c974 100644 --- a/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.cc +++ b/src/FirmwarePlugin/APM/ArduSubFirmwarePlugin.cc @@ -62,6 +62,39 @@ ArduSubFirmwarePlugin::ArduSubFirmwarePlugin(void) remapV3_5["SERVO13_FUNCTION"] = QStringLiteral("RC13_FUNCTION"); remapV3_5["SERVO14_FUNCTION"] = QStringLiteral("RC14_FUNCTION"); + remapV3_5["SERVO5_MIN"] = QStringLiteral("RC5_MIN"); + remapV3_5["SERVO6_MIN"] = QStringLiteral("RC6_MIN"); + remapV3_5["SERVO7_MIN"] = QStringLiteral("RC7_MIN"); + remapV3_5["SERVO8_MIN"] = QStringLiteral("RC8_MIN"); + remapV3_5["SERVO9_MIN"] = QStringLiteral("RC9_MIN"); + remapV3_5["SERVO10_MIN"] = QStringLiteral("RC10_MIN"); + remapV3_5["SERVO11_MIN"] = QStringLiteral("RC11_MIN"); + remapV3_5["SERVO12_MIN"] = QStringLiteral("RC12_MIN"); + remapV3_5["SERVO13_MIN"] = QStringLiteral("RC13_MIN"); + remapV3_5["SERVO14_MIN"] = QStringLiteral("RC14_MIN"); + + remapV3_5["SERVO5_MAX"] = QStringLiteral("RC5_MAX"); + remapV3_5["SERVO6_MAX"] = QStringLiteral("RC6_MAX"); + remapV3_5["SERVO7_MAX"] = QStringLiteral("RC7_MAX"); + remapV3_5["SERVO8_MAX"] = QStringLiteral("RC8_MAX"); + remapV3_5["SERVO9_MAX"] = QStringLiteral("RC9_MAX"); + remapV3_5["SERVO10_MAX"] = QStringLiteral("RC10_MAX"); + remapV3_5["SERVO11_MAX"] = QStringLiteral("RC11_MAX"); + remapV3_5["SERVO12_MAX"] = QStringLiteral("RC12_MAX"); + remapV3_5["SERVO13_MAX"] = QStringLiteral("RC13_MAX"); + remapV3_5["SERVO14_MAX"] = QStringLiteral("RC14_MAX"); + + remapV3_5["SERVO5_REVERSED"] = QStringLiteral("RC5_REVERSED"); + remapV3_5["SERVO6_REVERSED"] = QStringLiteral("RC6_REVERSED"); + remapV3_5["SERVO7_REVERSED"] = QStringLiteral("RC7_REVERSED"); + remapV3_5["SERVO8_REVERSED"] = QStringLiteral("RC8_REVERSED"); + remapV3_5["SERVO9_REVERSED"] = QStringLiteral("RC9_REVERSED"); + remapV3_5["SERVO10_REVERSED"] = QStringLiteral("RC10_REVERSED"); + remapV3_5["SERVO11_REVERSED"] = QStringLiteral("RC11_REVERSED"); + remapV3_5["SERVO12_REVERSED"] = QStringLiteral("RC12_REVERSED"); + remapV3_5["SERVO13_REVERSED"] = QStringLiteral("RC13_REVERSED"); + remapV3_5["SERVO14_REVERSED"] = QStringLiteral("RC14_REVERSED"); + remapV3_5["FENCE_ALT_MIN"] = QStringLiteral("FENCE_DEPTH_MAX"); _remapParamNameIntialized = true;