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;
}