mirror of
https://bitbucket.org/librepilot/librepilot.git
synced 2025-03-01 18:29:16 +01:00
Merged in f5soh/librepilot/LP-273_Reset_Mag_Alarm (pull request #214)
LP-273 Reinit Mag alarm while switching to Complementary
This commit is contained in:
commit
d916fde887
@ -383,6 +383,8 @@ static void StateEstimationCb(void)
|
|||||||
switch ((RevoSettingsFusionAlgorithmOptions)revoSettings.FusionAlgorithm) {
|
switch ((RevoSettingsFusionAlgorithmOptions)revoSettings.FusionAlgorithm) {
|
||||||
case REVOSETTINGS_FUSIONALGORITHM_BASICCOMPLEMENTARY:
|
case REVOSETTINGS_FUSIONALGORITHM_BASICCOMPLEMENTARY:
|
||||||
newFilterChain = cfQueue;
|
newFilterChain = cfQueue;
|
||||||
|
// reinit Mag alarm
|
||||||
|
AlarmsSet(SYSTEMALARMS_ALARM_MAGNETOMETER, SYSTEMALARMS_ALARM_UNINITIALISED);
|
||||||
break;
|
break;
|
||||||
case REVOSETTINGS_FUSIONALGORITHM_COMPLEMENTARYMAG:
|
case REVOSETTINGS_FUSIONALGORITHM_COMPLEMENTARYMAG:
|
||||||
newFilterChain = cfmiQueue;
|
newFilterChain = cfmiQueue;
|
||||||
@ -414,7 +416,7 @@ static void StateEstimationCb(void)
|
|||||||
AlarmsSet(SYSTEMALARMS_ALARM_ATTITUDE, SYSTEMALARMS_ALARM_ERROR);
|
AlarmsSet(SYSTEMALARMS_ALARM_ATTITUDE, SYSTEMALARMS_ALARM_ERROR);
|
||||||
return;
|
return;
|
||||||
} else {
|
} else {
|
||||||
// set new fusion algortithm
|
// set new fusion algorithm
|
||||||
filterChain = newFilterChain;
|
filterChain = newFilterChain;
|
||||||
fusionAlgorithm = revoSettings.FusionAlgorithm;
|
fusionAlgorithm = revoSettings.FusionAlgorithm;
|
||||||
}
|
}
|
||||||
|
Loading…
x
Reference in New Issue
Block a user