mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-30 05:43:33 +08:00
log quaternion setpoint
This commit is contained in:
@@ -1495,6 +1495,10 @@ int sdlog2_thread_main(int argc, char *argv[])
|
||||
log_msg.body.log_ATSP.pitch_sp = buf.att_sp.pitch_body;
|
||||
log_msg.body.log_ATSP.yaw_sp = buf.att_sp.yaw_body;
|
||||
log_msg.body.log_ATSP.thrust_sp = buf.att_sp.thrust;
|
||||
log_msg.body.log_ATSP.q_w = buf.att_sp.q_d[0];
|
||||
log_msg.body.log_ATSP.q_x = buf.att_sp.q_d[1];
|
||||
log_msg.body.log_ATSP.q_y = buf.att_sp.q_d[2];
|
||||
log_msg.body.log_ATSP.q_z = buf.att_sp.q_d[3];
|
||||
LOGBUFFER_WRITE_AND_COUNT(ATSP);
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user