AP_Nav_Common.cpp 689 B

12345678910111213141516171819202122232425
  1. #include "AP_Nav_Common.h"
  2. #include <AP_HAL/AP_HAL.h>
  3. #include <AP_Logger/AP_Logger.h>
  4. /*
  5. write an EKF timing message
  6. */
  7. void Log_EKF_Timing(const char *name, uint64_t time_us, const struct ekf_timing &timing)
  8. {
  9. AP::logger().Write(
  10. name,
  11. "TimeUS,Cnt,IMUMin,IMUMax,EKFMin,EKFMax,AngMin,AngMax,VMin,VMax",
  12. "QIffffffff",
  13. time_us,
  14. timing.count,
  15. (double)timing.dtIMUavg_min,
  16. (double)timing.dtIMUavg_max,
  17. (double)timing.dtEKFavg_min,
  18. (double)timing.dtEKFavg_max,
  19. (double)timing.delAngDT_min,
  20. (double)timing.delAngDT_max,
  21. (double)timing.delVelDT_min,
  22. (double)timing.delVelDT_max);
  23. }