Browse Source

DCM: added a SITL_debug() for DCM normalisation errors

I have seen normalisation errors during simulation runs, but have not
yet tracked down the cause. This log message may help track things
down.
mission-4.1.18
Andrew Tridgell 13 years ago
parent
commit
245d265c6a
  1. 2
      libraries/AP_DCM/AP_DCM.cpp

2
libraries/AP_DCM/AP_DCM.cpp

@ -268,6 +268,8 @@ AP_DCM::renorm(Vector3f const &a, int &problem) @@ -268,6 +268,8 @@ AP_DCM::renorm(Vector3f const &a, int &problem)
renorm_sqrt_count++;
} else {
problem = 1;
SITL_debug("ERROR: DCM renormalisation error. renorm_val=%f\n",
renorm_val);
renorm_blowup_count++;
}

Loading…
Cancel
Save