mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-22 18:07:34 +08:00
log pitch setpoint after modifying it
This commit is contained in:
@@ -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));
|
||||
|
||||
Reference in New Issue
Block a user