log quaternion setpoint

This commit is contained in:
tumbili
2015-04-04 10:21:46 +02:00
committed by Lorenz Meier
parent a4bece7595
commit a530f16518
2 changed files with 9 additions and 1 deletions
+4
View File
@@ -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);
}