Add vtol states to sdlog2

This commit is contained in:
sander
2016-02-26 22:51:11 +01:00
parent 1165e0a946
commit b513edffcd
2 changed files with 7 additions and 1 deletions
+3
View File
@@ -1347,6 +1347,9 @@ int sdlog2_thread_main(int argc, char *argv[])
if(copy_if_updated(ORB_ID(vtol_vehicle_status), &subs.vtol_status_sub, &buf.vtol_status)) {
log_msg.msg_type = LOG_VTOL_MSG;
log_msg.body.log_VTOL.airspeed_tot = buf.vtol_status.airspeed_tot;
log_msg.body.log_VTOL.rw_mode = (uint8_t) buf.vtol_status.vtol_in_rw_mode;
log_msg.body.log_VTOL.trans_mode = (uint8_t) buf.vtol_status.vtol_in_trans_mode;
log_msg.body.log_VTOL.failsafe_mode = (uint8_t) buf.vtol_status.vtol_transition_failsafe;
LOGBUFFER_WRITE_AND_COUNT(VTOL);
}