@ -199,7 +199,7 @@ void ParameterManager::_parameterUpdate(int vehicleId, int componentId, QString
if ( ! _waitingReadParamIndexMap [ componentId ] . contains ( parameterId ) & &
if ( ! _waitingReadParamIndexMap [ componentId ] . contains ( parameterId ) & &
! _waitingReadParamNameMap [ componentId ] . contains ( parameterName ) & &
! _waitingReadParamNameMap [ componentId ] . contains ( parameterName ) & &
! _waitingWriteParamNameMap [ componentId ] . contains ( parameterName ) ) {
! _waitingWriteParamNameMap [ componentId ] . contains ( parameterName ) ) {
qCDebug ( ParameterManagerVerbose1Log ) < < _logVehiclePrefix ( ) < < " Unrequested param update " < < parameterName ;
qCDebug ( ParameterManagerVerbose1Log ) < < _logVehiclePrefix ( componentId ) < < " Unrequested param update " < < parameterName ;
}
}
// Remove this parameter from the waiting lists
// Remove this parameter from the waiting lists
@ -252,14 +252,14 @@ void ParameterManager::_parameterUpdate(int vehicleId, int componentId, QString
if ( totalWaitingParamCount ) {
if ( totalWaitingParamCount ) {
// More params to wait for, restart timer
// More params to wait for, restart timer
_waitingParamTimeoutTimer . start ( ) ;
_waitingParamTimeoutTimer . start ( ) ;
qCDebug ( ParameterManagerVerbose1Log ) < < _logVehiclePrefix ( ) < < " Restarting _waitingParamTimeoutTimer: totalWaitingParamCount: " < < totalWaitingParamCount ;
qCDebug ( ParameterManagerVerbose1Log ) < < _logVehiclePrefix ( - 1 ) < < " Restarting _waitingParamTimeoutTimer: totalWaitingParamCount: " < < totalWaitingParamCount ;
} else {
} else {
if ( ! _mapParameterName2Variant . contains ( _vehicle - > defaultComponentId ( ) ) ) {
if ( ! _mapParameterName2Variant . contains ( _vehicle - > defaultComponentId ( ) ) ) {
// Still waiting for parameters from default component
// Still waiting for parameters from default component
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( ) < < " Restarting _waitingParamTimeoutTimer (still waiting for default component params) " ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( - 1 ) < < " Restarting _waitingParamTimeoutTimer (still waiting for default component params) " ;
_waitingParamTimeoutTimer . start ( ) ;
_waitingParamTimeoutTimer . start ( ) ;
} else {
} else {
qCDebug ( ParameterManagerVerbose1Log ) < < _logVehiclePrefix ( ) < < " Not restarting _waitingParamTimeoutTimer (all requests satisfied) " ;
qCDebug ( ParameterManagerVerbose1Log ) < < _logVehiclePrefix ( - 1 ) < < " Not restarting _waitingParamTimeoutTimer (all requests satisfied) " ;
}
}
}
}
@ -440,7 +440,7 @@ void ParameterManager::refreshAllParameters(uint8_t componentId)
_vehicle - > sendMessageOnLink ( _vehicle - > priorityLink ( ) , msg ) ;
_vehicle - > sendMessageOnLink ( _vehicle - > priorityLink ( ) , msg ) ;
QString what = ( componentId = = MAV_COMP_ID_ALL ) ? " MAV_COMP_ID_ALL " : QString : : number ( componentId ) ;
QString what = ( componentId = = MAV_COMP_ID_ALL ) ? " MAV_COMP_ID_ALL " : QString : : number ( componentId ) ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( ) < < " Request to refresh all parameters for component ID: " < < what ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( - 1 ) < < " Request to refresh all parameters for component ID: " < < what ;
}
}
/// Translates FactSystem::defaultComponentId to real component id if needed
/// Translates FactSystem::defaultComponentId to real component id if needed
@ -449,7 +449,7 @@ int ParameterManager::_actualComponentId(int componentId)
if ( componentId = = FactSystem : : defaultComponentId ) {
if ( componentId = = FactSystem : : defaultComponentId ) {
componentId = _vehicle - > defaultComponentId ( ) ;
componentId = _vehicle - > defaultComponentId ( ) ;
if ( componentId = = FactSystem : : defaultComponentId ) {
if ( componentId = = FactSystem : : defaultComponentId ) {
qWarning ( ) < < _logVehiclePrefix ( ) < < " Default component id not set " ;
qWarning ( ) < < _logVehiclePrefix ( - 1 ) < < " Default component id not set " ;
}
}
}
}
@ -564,8 +564,8 @@ bool ParameterManager::_fillIndexBatchQueue(bool waitingParamTimeout)
for ( int componentId : _waitingReadParamIndexMap . keys ( ) ) {
for ( int componentId : _waitingReadParamIndexMap . keys ( ) ) {
if ( _waitingReadParamIndexMap [ componentId ] . count ( ) ) {
if ( _waitingReadParamIndexMap [ componentId ] . count ( ) ) {
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( ) < < " _waitingReadParamIndexMap count " < < _waitingReadParamIndexMap [ componentId ] . count ( ) ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( componentId ) < < " _waitingReadParamIndexMap count " < < _waitingReadParamIndexMap [ componentId ] . count ( ) ;
qCDebug ( ParameterManagerVerbose1Log ) < < _logVehiclePrefix ( ) < < " _waitingReadParamIndexMap " < < _waitingReadParamIndexMap [ componentId ] ;
qCDebug ( ParameterManagerVerbose1Log ) < < _logVehiclePrefix ( componentId ) < < " _waitingReadParamIndexMap " < < _waitingReadParamIndexMap [ componentId ] ;
}
}
for ( int paramIndex : _waitingReadParamIndexMap [ componentId ] . keys ( ) ) {
for ( int paramIndex : _waitingReadParamIndexMap [ componentId ] . keys ( ) ) {
@ -606,7 +606,7 @@ void ParameterManager::_waitingParamTimeout(void)
const int maxBatchSize = 10 ;
const int maxBatchSize = 10 ;
int batchCount = 0 ;
int batchCount = 0 ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( ) < < " _waitingParamTimeout " ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( - 1 ) < < " _waitingParamTimeout " ;
// Now that we have timed out for possibly the first time we can activate the index batch queue
// Now that we have timed out for possibly the first time we can activate the index batch queue
_indexBatchQueueActive = true ;
_indexBatchQueueActive = true ;
@ -617,7 +617,7 @@ void ParameterManager::_waitingParamTimeout(void)
if ( ! paramsRequested & & ! _waitingForDefaultComponent & & ! _mapParameterName2Variant . contains ( _vehicle - > defaultComponentId ( ) ) ) {
if ( ! paramsRequested & & ! _waitingForDefaultComponent & & ! _mapParameterName2Variant . contains ( _vehicle - > defaultComponentId ( ) ) ) {
// Initial load is complete but we still don't have any default component params. Wait one more cycle to see if the
// Initial load is complete but we still don't have any default component params. Wait one more cycle to see if the
// any show up.
// any show up.
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( ) < < " Restarting _waitingParamTimeoutTimer - still don't have default component params " < < _vehicle - > defaultComponentId ( ) < < _mapParameterName2Variant . keys ( ) ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( - 1 ) < < " Restarting _waitingParamTimeoutTimer - still don't have default component params " < < _vehicle - > defaultComponentId ( ) < < _mapParameterName2Variant . keys ( ) ;
_waitingParamTimeoutTimer . start ( ) ;
_waitingParamTimeoutTimer . start ( ) ;
_waitingForDefaultComponent = true ;
_waitingForDefaultComponent = true ;
return ;
return ;
@ -672,7 +672,7 @@ void ParameterManager::_waitingParamTimeout(void)
Out :
Out :
if ( paramsRequested ) {
if ( paramsRequested ) {
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( ) < < " Restarting _waitingParamTimeoutTimer - re-request " ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( - 1 ) < < " Restarting _waitingParamTimeoutTimer - re-request " ;
_waitingParamTimeoutTimer . start ( ) ;
_waitingParamTimeoutTimer . start ( ) ;
}
}
}
}
@ -1121,7 +1121,7 @@ void ParameterManager::_checkInitialLoadComplete(void)
}
}
_debugCacheCRC . clear ( ) ;
_debugCacheCRC . clear ( ) ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( ) < < " Initial load complete " ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( - 1 ) < < " Initial load complete " ;
// Check for index based load failures
// Check for index based load failures
QString indexList ;
QString indexList ;
@ -1131,7 +1131,7 @@ void ParameterManager::_checkInitialLoadComplete(void)
if ( initialLoadFailures ) {
if ( initialLoadFailures ) {
indexList + = " , " ;
indexList + = " , " ;
}
}
indexList + = QString ( " %1 " ) . arg ( paramIndex ) ;
indexList + = QString ( " %1:%2 " ) . arg ( componentId ) . arg ( paramIndex ) ;
initialLoadFailures = true ;
initialLoadFailures = true ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( componentId ) < < " Gave up on initial load after max retries (paramIndex: " < < paramIndex < < " ) " ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( componentId ) < < " Gave up on initial load after max retries (paramIndex: " < < paramIndex < < " ) " ;
}
}
@ -1147,7 +1147,7 @@ void ParameterManager::_checkInitialLoadComplete(void)
qCDebug ( ParameterManagerLog ) < < errorMsg ;
qCDebug ( ParameterManagerLog ) < < errorMsg ;
qgcApp ( ) - > showMessage ( errorMsg ) ;
qgcApp ( ) - > showMessage ( errorMsg ) ;
if ( ! qgcApp ( ) - > runningUnitTests ( ) ) {
if ( ! qgcApp ( ) - > runningUnitTests ( ) ) {
qCWarning ( ParameterManagerLog ) < < _logVehiclePrefix ( ) < < " The following parameter indices could not be loaded after the maximum number of retries: " < < indexList ;
qCWarning ( ParameterManagerLog ) < < _logVehiclePrefix ( - 1 ) < < " The following parameter indices could not be loaded after the maximum number of retries: " < < indexList ;
}
}
}
}
@ -1161,7 +1161,7 @@ void ParameterManager::_checkInitialLoadComplete(void)
void ParameterManager : : _initialRequestTimeout ( void )
void ParameterManager : : _initialRequestTimeout ( void )
{
{
if ( ! _disableAllRetries & & + + _initialRequestRetryCount < = _maxInitialRequestListRetry ) {
if ( ! _disableAllRetries & & + + _initialRequestRetryCount < = _maxInitialRequestListRetry ) {
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( ) < < " Retrying initial parameter request list " ;
qCDebug ( ParameterManagerLog ) < < _logVehiclePrefix ( - 1 ) < < " Retrying initial parameter request list " ;
refreshAllParameters ( ) ;
refreshAllParameters ( ) ;
_initialRequestTimeoutTimer . start ( ) ;
_initialRequestTimeoutTimer . start ( ) ;
} else {
} else {