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 AddProgramData(ProgramControlData programData)
{
switch (programData.controlStatus)
{
case 1:
case 2:
case 12:
ActivePoint(FlyProtocol.GetProgramControlStatusDescription(programData.controlStatus), true);
break;
}
}
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;
}
private void InitProgramDigram()
{
programDigram.SetLinePoints(new Point(0.1, 0.9), new Point(0.5, -0.8), new Point(0.9, 0.9));
FlyProtocol.GetPoints().ForEach(point => programDigram.AddPoint(point.Value, point.Key));
}
