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.
This commit is contained in:
Andrew Tridgell 2012-02-14 21:06:42 +11:00
parent 601a991a46
commit 245d265c6a

View File

@ -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++;
}