Skip to content
Snippets Groups Projects
Commit 068b5a54 authored by Andrew Tridgell's avatar Andrew Tridgell
Browse files

Replay: prevent float exception in log writing

parent f4fc910f
No related branches found
No related tags found
No related merge requests found
...@@ -462,12 +462,12 @@ void loop() ...@@ -462,12 +462,12 @@ void loop()
float posN = (float)(posNED.x); // metres North float posN = (float)(posNED.x); // metres North
float posE = (float)(posNED.y); // metres East float posE = (float)(posNED.y); // metres East
float posD = (float)(posNED.z); // metres Down float posD = (float)(posNED.z); // metres Down
int16_t gyrX = (int16_t)(6000*degrees(gyroBias.x)); // centi-deg/min float gyrX = (float)(6000*degrees(gyroBias.x)); // centi-deg/min
int16_t gyrY = (int16_t)(6000*degrees(gyroBias.y)); // centi-deg/min float gyrY = (float)(6000*degrees(gyroBias.y)); // centi-deg/min
int16_t gyrZ = (int16_t)(6000*degrees(gyroBias.z)); // centi-deg/min float gyrZ = (float)(6000*degrees(gyroBias.z)); // centi-deg/min
// print EKF1 data packet // print EKF1 data packet
fprintf(ekf1f, "%.3f %u %d %d %u %.2f %.2f %.2f %.2f %.2f %.2f %d %d %d\n", fprintf(ekf1f, "%.3f %u %d %d %u %.2f %.2f %.2f %.2f %.2f %.2f %.0f %.0f %.0f\n",
hal.scheduler->millis() * 0.001f, hal.scheduler->millis() * 0.001f,
hal.scheduler->millis(), hal.scheduler->millis(),
roll, roll,
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment