修改无人机状态判断标准
This commit is contained in:
parent
83b76fecdd
commit
01e0504bba
|
|
@ -344,20 +344,21 @@ public class TuohengBufferDeviceImpl implements IBufferDeviceService {
|
|||
machineStates.getCoverState();
|
||||
log.info("机场舱门状态(从MachineStateManager): {}", coverState);
|
||||
|
||||
// 先判断MODE是否为飞行模式
|
||||
boolean isFlyingMode = "auto".equalsIgnoreCase(mode) ||
|
||||
"guided".equalsIgnoreCase(mode) ||
|
||||
"loiter".equalsIgnoreCase(mode) ||
|
||||
"rtl".equalsIgnoreCase(mode);
|
||||
// 通过MODE判断飞行模式(暂时注释掉,数据不准确)
|
||||
// boolean isFlyingMode = "auto".equalsIgnoreCase(mode) ||
|
||||
// "guided".equalsIgnoreCase(mode) ||
|
||||
// "loiter".equalsIgnoreCase(mode) ||
|
||||
// "rtl".equalsIgnoreCase(mode);
|
||||
|
||||
if (isFlyingMode) {
|
||||
dockStatus = "WORKING";
|
||||
log.info("无人机处于{}模式,设置机场状态为 WORKING", mode);
|
||||
} else if (coverState == CoverState.OPENED) {
|
||||
// if (isFlyingMode) {
|
||||
// dockStatus = "WORKING";
|
||||
// log.info("无人机处于{}模式,设置机场状态为 WORKING", mode);
|
||||
// } else if (coverState == CoverState.OPENED) {
|
||||
if (coverState == CoverState.OPENED) {
|
||||
dockStatus = "WORKING";
|
||||
log.info("舱门打开,设置机场状态为 WORKING");
|
||||
} else {
|
||||
log.info("无人机处于{}模式且舱门关闭,设置机场状态为 IDLE", mode);
|
||||
log.info("舱门关闭,设置机场状态为 IDLE");
|
||||
}
|
||||
} catch (Exception e) {
|
||||
log.warn("获取无人机mode或舱门状态失败,默认设置为IDLE: {}", e.getMessage());
|
||||
|
|
|
|||
Loading…
Reference in New Issue