Browse Source

DataFlash: wrap yaw targets in ATT log

master
Andrew Tridgell 6 years ago
parent
commit
6dffb209d2
  1. 4
      libraries/DataFlash/LogFile.cpp

4
libraries/DataFlash/LogFile.cpp

@ -1362,8 +1362,8 @@ void DataFlash_Class::Log_Write_Attitude(AP_AHRS &ahrs, const Vector3f &targets) @@ -1362,8 +1362,8 @@ void DataFlash_Class::Log_Write_Attitude(AP_AHRS &ahrs, const Vector3f &targets)
roll : (int16_t)ahrs.roll_sensor,
control_pitch : (int16_t)targets.y,
pitch : (int16_t)ahrs.pitch_sensor,
control_yaw : (uint16_t)targets.z,
yaw : (uint16_t)ahrs.yaw_sensor,
control_yaw : (uint16_t)wrap_360_cd(targets.z),
yaw : (uint16_t)wrap_360_cd(ahrs.yaw_sensor),
error_rp : (uint16_t)(ahrs.get_error_rp() * 100),
error_yaw : (uint16_t)(ahrs.get_error_yaw() * 100)
};

Loading…
Cancel
Save