log pitch setpoint after modifying it

This commit is contained in:
Roman
2016-03-30 21:05:26 +02:00
committed by tumbili
parent db2a53d95d
commit f7c0518a61
@@ -314,6 +314,7 @@ void Standard::update_mc_state()
euler(1) = pitch_sp_corrected;
R_sp.from_euler(euler(0), euler(1), euler(2));
memcpy(&_v_att_sp->R_body[0], R_sp.data, sizeof(_v_att_sp->R_body));
_v_att_sp->pitch_body = pitch_sp_corrected;
math::Quaternion q_sp;
q_sp.from_dcm(R_sp);
memcpy(&_v_att_sp->q_d[0], &q_sp.data[0], sizeof(_v_att_sp->q_d));