Browse Source

GCS_MAVLink: log vision data pitch/roll/yaw in degree

master
chobits 6 years ago committed by Randy Mackay
parent
commit
ed12c6719d
  1. 8
      libraries/GCS_MAVLink/GCS_Common.cpp

8
libraries/GCS_MAVLink/GCS_Common.cpp

@ -2216,15 +2216,15 @@ void GCS_MAVLINK::log_vision_position_estimate_data(const uint64_t usec,
const float yaw) const float yaw)
{ {
DataFlash_Class::instance()->Log_Write("VISP", "TimeUS,RemTimeUS,PX,PY,PZ,Roll,Pitch,Yaw", DataFlash_Class::instance()->Log_Write("VISP", "TimeUS,RemTimeUS,PX,PY,PZ,Roll,Pitch,Yaw",
"ssmmmrrr", "FF000000", "QQffffff", "ssmmmddh", "FF000000", "QQffffff",
(uint64_t)AP_HAL::micros64(), (uint64_t)AP_HAL::micros64(),
(uint64_t)usec, (uint64_t)usec,
(double)x, (double)x,
(double)y, (double)y,
(double)z, (double)z,
(double)roll, (double)(roll * RAD_TO_DEG),
(double)pitch, (double)(pitch * RAD_TO_DEG),
(double)yaw); (double)(yaw * RAD_TO_DEG));
} }
void GCS_MAVLINK::handle_att_pos_mocap(mavlink_message_t *msg) void GCS_MAVLINK::handle_att_pos_mocap(mavlink_message_t *msg)

Loading…
Cancel
Save