public void AddAngleData(AngleData angelData) { if (lastAngleData != null) { if (IsAccZero(lastAngleData.Value) && !IsAccZero(angelData)) { ActivePoint(FlyProtocol.GetPoint(PROGRAM_CONTROL_STATUS.STATUS_LEVEL1_SHUTDOWN).Value, true); } } lastAngleData = angelData; }
public void AddNavData(NavData navData) { if (lastNavData != null) { if (lastNavData.Value.height > navData.height && IsActive(FlyProtocol.GetPoint(PROGRAM_CONTROL_STATUS.STATUS_BOOM).Value)) { ActivePoint(FlyProtocol.GetPoint(PROGRAM_CONTROL_STATUS.STATUS_TOP).Value, true); } } lastNavData = navData; }