|
|
|
@ -295,6 +295,11 @@ void APMFirmwarePlugin::_handleOutgoingParamSet(Vehicle* vehicle, LinkInterface*
@@ -295,6 +295,11 @@ void APMFirmwarePlugin::_handleOutgoingParamSet(Vehicle* vehicle, LinkInterface*
|
|
|
|
|
|
|
|
|
|
mavlink_msg_param_set_decode(message, ¶mSet); |
|
|
|
|
|
|
|
|
|
if (!_ardupilotComponentMap[paramSet.target_system][paramSet.target_component]) { |
|
|
|
|
// Message is targetted to non-ArduPilot firmware component, assume it uses current mavlink spec
|
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
paramUnion.param_float = paramSet.param_value; |
|
|
|
|
|
|
|
|
|
switch (paramSet.param_type) { |
|
|
|
@ -502,15 +507,12 @@ bool APMFirmwarePlugin::adjustIncomingMavlinkMessage(Vehicle* vehicle, mavlink_m
@@ -502,15 +507,12 @@ bool APMFirmwarePlugin::adjustIncomingMavlinkMessage(Vehicle* vehicle, mavlink_m
|
|
|
|
|
|
|
|
|
|
void APMFirmwarePlugin::adjustOutgoingMavlinkMessage(Vehicle* vehicle, LinkInterface* outgoingLink, mavlink_message_t* message) |
|
|
|
|
{ |
|
|
|
|
// Only translate messages which come from ArduPilot code. All other components are expected to follow current mavlink spec.
|
|
|
|
|
if (_ardupilotComponentMap[vehicle->id()][message->compid]) { |
|
|
|
|
switch (message->msgid) { |
|
|
|
|
case MAVLINK_MSG_ID_PARAM_SET: |
|
|
|
|
_handleOutgoingParamSet(vehicle, outgoingLink, message); |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
QString APMFirmwarePlugin::_getMessageText(mavlink_message_t* message, bool longVersion) const |
|
|
|
|
{ |
|
|
|
|