|
|
|
@ -316,6 +316,7 @@ void Standard::update_mc_state()
@@ -316,6 +316,7 @@ void Standard::update_mc_state()
|
|
|
|
|
// calculate the desired pitch seen in the heading frame
|
|
|
|
|
// this value corresponds to the amount the vehicle would try to pitch forward
|
|
|
|
|
float pitch_forward = asinf(body_z_sp(0)); |
|
|
|
|
|
|
|
|
|
// only allow pitching forward up to threshold, the rest of the desired
|
|
|
|
|
// forward acceleration will be compensated by the pusher
|
|
|
|
|
if (pitch_forward < -_params_standard.down_pitch_max) { |
|
|
|
|