public MovmentComandAX12[] GetMovements()
{
YawServo.SetAngle(Yaw);
PitchServo.SetAngle(Pitch);
RollServo.SetAngle(Roll);
List<MovmentComandAX12> movmentComands = new List<MovmentComandAX12>();
movmentComands.Add(YawServo.GetMovment());
movmentComands.Add(PitchServo.GetMovment());
movmentComands.Add(RollServo.GetMovment());
return movmentComands.ToArray();
}