From 221a43af8b8a302f541258c2234046cd139f0df7 Mon Sep 17 00:00:00 2001 From: lm Date: Tue, 15 Feb 2011 10:57:52 +0100 Subject: [PATCH] Minor fix to simulation link --- src/comm/MAVLinkSimulationLink.cc | 17 +++++++++++------ src/ui/QGCParamWidget.cc | 4 ++-- 2 files changed, 13 insertions(+), 8 deletions(-) diff --git a/src/comm/MAVLinkSimulationLink.cc b/src/comm/MAVLinkSimulationLink.cc index 565426325..781024c06 100644 --- a/src/comm/MAVLinkSimulationLink.cc +++ b/src/comm/MAVLinkSimulationLink.cc @@ -845,11 +845,14 @@ void MAVLinkSimulationLink::writeBytes(const char* data, qint64 size) break; case MAVLINK_MSG_ID_PARAM_SET: { - qDebug() << "SIMULATION RECEIVED COMMAND TO SET PARAMETER"; - mavlink_param_set_t set; - mavlink_msg_param_set_decode(&msg, &set); -// if (set.target_system == systemId) -// { + // Drop on even milliseconds + if (QGC::groundTimeMilliseconds() % 2 == 0) + { + qDebug() << "SIMULATION RECEIVED COMMAND TO SET PARAMETER"; + mavlink_param_set_t set; + mavlink_msg_param_set_decode(&msg, &set); + // if (set.target_system == systemId) + // { QString key = QString((char*)set.param_id); if (onboardParams.contains(key)) { @@ -864,8 +867,10 @@ void MAVLinkSimulationLink::writeBytes(const char* data, qint64 size) memcpy(stream+streampointer,buffer, bufferlength); streampointer+=bufferlength; } -// } + // } + } } + break; case MAVLINK_MSG_ID_PARAM_REQUEST_READ: { qDebug() << "SIMULATION RECEIVED COMMAND TO SEND PARAMETER"; diff --git a/src/ui/QGCParamWidget.cc b/src/ui/QGCParamWidget.cc index 5e91cf2bb..e94789080 100644 --- a/src/ui/QGCParamWidget.cc +++ b/src/ui/QGCParamWidget.cc @@ -282,7 +282,7 @@ void QGCParamWidget::addParameter(int uas, int component, int paramCount, int pa else if (justWritten && writeMismatch) { // Mismatch, tell user - statusLabel->setText(tr("FAILURE: Wrote %1: sent %2 != onboard %3").arg(parameterName).arg(map->value(parameterName), value)); + statusLabel->setText(tr("FAILURE: Wrote %1: sent %2 != onboard %3").arg(parameterName).arg(map->value(parameterName)).arg(value)); } else { @@ -704,7 +704,7 @@ void QGCParamWidget::retransmissionGuardTick() { // Re-request write operation emit parameterChanged(component, key, missingParams->value(key)); - statusLabel->setText(tr("Re-requested write: %1: %2").arg(key).arg(missingParams->value(key))); + statusLabel->setText(tr("Requested rewrite of: %1: %2").arg(key).arg(missingParams->value(key))); count++; } else -- 2.22.0