|
|
|
@ -445,25 +445,25 @@ void AP_MotorsHeli_Dual::move_actuators(float roll_out, float pitch_out, float c
@@ -445,25 +445,25 @@ void AP_MotorsHeli_Dual::move_actuators(float roll_out, float pitch_out, float c
|
|
|
|
|
limit.throttle_upper = false; |
|
|
|
|
|
|
|
|
|
if (_dual_mode == AP_MOTORS_HELI_DUAL_MODE_TRANSVERSE) { |
|
|
|
|
if (pitch_out < -_cyclic_max/4500.0f) { |
|
|
|
|
pitch_out = -_cyclic_max/4500.0f; |
|
|
|
|
limit.roll_pitch = true; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (pitch_out > _cyclic_max/4500.0f) { |
|
|
|
|
pitch_out = _cyclic_max/4500.0f; |
|
|
|
|
limit.roll_pitch = true; |
|
|
|
|
} |
|
|
|
|
if (pitch_out < -_cyclic_max/4500.0f) { |
|
|
|
|
pitch_out = -_cyclic_max/4500.0f; |
|
|
|
|
limit.roll_pitch = true; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (pitch_out > _cyclic_max/4500.0f) { |
|
|
|
|
pitch_out = _cyclic_max/4500.0f; |
|
|
|
|
limit.roll_pitch = true; |
|
|
|
|
} |
|
|
|
|
} else { |
|
|
|
|
if (roll_out < -_cyclic_max/4500.0f) { |
|
|
|
|
roll_out = -_cyclic_max/4500.0f; |
|
|
|
|
limit.roll_pitch = true; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (roll_out > _cyclic_max/4500.0f) { |
|
|
|
|
roll_out = _cyclic_max/4500.0f; |
|
|
|
|
limit.roll_pitch = true; |
|
|
|
|
} |
|
|
|
|
if (roll_out < -_cyclic_max/4500.0f) { |
|
|
|
|
roll_out = -_cyclic_max/4500.0f; |
|
|
|
|
limit.roll_pitch = true; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (roll_out > _cyclic_max/4500.0f) { |
|
|
|
|
roll_out = _cyclic_max/4500.0f; |
|
|
|
|
limit.roll_pitch = true; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|