fixed code style in standard.cpp

This commit is contained in:
Andreas Antener
2016-06-02 13:22:00 +02:00
committed by Lorenz Meier
parent ac9a81c0c7
commit 9ec9210a08
+2 -1
View File
@@ -312,10 +312,11 @@ void Standard::update_mc_state()
matrix::Dcmf R_yaw = matrix::Eulerf(0.0f, 0.0f, -euler(2));
body_z_sp = R_yaw * body_z_sp;
body_z_sp.normalize();
// 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) {