fancy GPS fdir
This commit is contained in:
parent
e10359077c
commit
3941770378
@ -278,15 +278,34 @@ ReturnValue_t AcsBoardAssembly::checkAndHandleHealthStates(Mode_t deviceMode,
|
|||||||
modeHelper.setForced(true);
|
modeHelper.setForced(true);
|
||||||
}
|
}
|
||||||
};
|
};
|
||||||
if (healthHelper.healthTable->getHealth(helper.gpsId) == EXTERNAL_CONTROL) {
|
if (healthHelper.healthTable->getHealth(helper.healthDevGps0) == EXTERNAL_CONTROL or
|
||||||
|
healthHelper.healthTable->getHealth(helper.healthDevGps1) == EXTERNAL_CONTROL) {
|
||||||
modeHelper.setForced(true);
|
modeHelper.setForced(true);
|
||||||
}
|
}
|
||||||
if (deviceSubmode == duallane::DUAL_MODE) {
|
if (healthHelper.healthTable->getHealth(helper.healthDevGps0) == PERMANENT_FAULTY and
|
||||||
checkAcsBoardSensorGroup(helper.mgm0Lis3IdSideA, helper.mgm1Rm3100IdSideA,
|
healthHelper.healthTable->getHealth(helper.healthDevGps1) == FAULTY) {
|
||||||
helper.mgm2Lis3IdSideB, helper.mgm3Rm3100IdSideB);
|
overwriteDeviceHealth(helper.healthDevGps1, FAULTY);
|
||||||
checkAcsBoardSensorGroup(helper.gyro0AdisIdSideA, helper.gyro1L3gIdSideA,
|
} else if (healthHelper.healthTable->getHealth(helper.healthDevGps1) == PERMANENT_FAULTY and
|
||||||
helper.gyro2AdisIdSideB, helper.gyro3L3gIdSideB);
|
healthHelper.healthTable->getHealth(helper.healthDevGps0) == FAULTY) {
|
||||||
|
overwriteDeviceHealth(helper.healthDevGps0, FAULTY);
|
||||||
|
} else if (healthHelper.healthTable->isFaulty(helper.healthDevGps0) or
|
||||||
|
healthHelper.healthTable->isFaulty(helper.healthDevGps1)) {
|
||||||
|
overwriteDeviceHealth(helper.healthDevGps0,
|
||||||
|
healthHelper.healthTable->getHealth(helper.healthDevGps0));
|
||||||
|
overwriteDeviceHealth(helper.healthDevGps1,
|
||||||
|
healthHelper.healthTable->getHealth(helper.healthDevGps1));
|
||||||
}
|
}
|
||||||
|
if (healthHelper.healthTable->getHealth(helper.healthDevGps0) == FAULTY and
|
||||||
|
healthHelper.healthTable->getHealth(helper.healthDevGps1) == FAULTY) {
|
||||||
|
overwriteDeviceHealth(helper.healthDevGps0, FAULTY);
|
||||||
|
overwriteDeviceHealth(helper.healthDevGps1, FAULTY);
|
||||||
|
} else if ()
|
||||||
|
if (deviceSubmode == duallane::DUAL_MODE) {
|
||||||
|
checkAcsBoardSensorGroup(helper.mgm0Lis3IdSideA, helper.mgm1Rm3100IdSideA,
|
||||||
|
helper.mgm2Lis3IdSideB, helper.mgm3Rm3100IdSideB);
|
||||||
|
checkAcsBoardSensorGroup(helper.gyro0AdisIdSideA, helper.gyro1L3gIdSideA,
|
||||||
|
helper.gyro2AdisIdSideB, helper.gyro3L3gIdSideB);
|
||||||
|
}
|
||||||
return status;
|
return status;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
x
Reference in New Issue
Block a user