diff --git a/libraries/AP_DCM/AP_DCM.cpp b/libraries/AP_DCM/AP_DCM.cpp index abf00d9ba9..c6deb7f63f 100644 --- a/libraries/AP_DCM/AP_DCM.cpp +++ b/libraries/AP_DCM/AP_DCM.cpp @@ -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++; }