Different Rot Rate Source for Detumble #902
@ -39,6 +39,7 @@ void FusedRotationEstimation::estimateFusedRotationRate(
|
|||||||
} else if (fusedRotRateSourcesData->rotRateTotalSusMgm.isValid()) {
|
} else if (fusedRotRateSourcesData->rotRateTotalSusMgm.isValid()) {
|
||||||
std::memcpy(fusedRotRateData->rotRateTotalSource.value,
|
std::memcpy(fusedRotRateData->rotRateTotalSource.value,
|
||||||
fusedRotRateSourcesData->rotRateTotalSusMgm.value, 3 * sizeof(double));
|
fusedRotRateSourcesData->rotRateTotalSusMgm.value, 3 * sizeof(double));
|
||||||
|
fusedRotRateData->rotRateTotalSource.setValid(true);
|
||||||
fusedRotRateData->rotRateSource.value = acs::rotrate::Source::SUSMGM;
|
fusedRotRateData->rotRateSource.value = acs::rotrate::Source::SUSMGM;
|
||||||
fusedRotRateData->rotRateSource.setValid(true);
|
fusedRotRateData->rotRateSource.setValid(true);
|
||||||
} else {
|
} else {
|
||||||
@ -53,7 +54,7 @@ void FusedRotationEstimation::estimateFusedRotationRate(
|
|||||||
if (fusedRotRateSourcesData->rotRateTotalSusMgm.isValid()) {
|
if (fusedRotRateSourcesData->rotRateTotalSusMgm.isValid()) {
|
||||||
std::memcpy(fusedRotRateData->rotRateTotalSusMgm.value,
|
std::memcpy(fusedRotRateData->rotRateTotalSusMgm.value,
|
||||||
fusedRotRateSourcesData->rotRateTotalSusMgm.value, 3 * sizeof(double));
|
fusedRotRateSourcesData->rotRateTotalSusMgm.value, 3 * sizeof(double));
|
||||||
fusedRotRateData->rotRateTotalSusMgm.setValid(false);
|
fusedRotRateData->rotRateTotalSusMgm.setValid(true);
|
||||||
} else {
|
} else {
|
||||||
PoolReadGuard pg(fusedRotRateData);
|
PoolReadGuard pg(fusedRotRateData);
|
||||||
if (pg.getReadResult() == returnvalue::OK) {
|
if (pg.getReadResult() == returnvalue::OK) {
|
||||||
|
Loading…
Reference in New Issue
Block a user