chore: Improved debugging outputs for GainMatrixSmoother (#3077)

IMO useful debugging logs
acts-project · Apr 4, 2024 · 9c8141e · 9c8141e
1 parent b0c64a0
commit 9c8141e
Showing 1 changed file with 10 additions and 2 deletions.
diff --git a/Core/src/TrackFitting/GainMatrixSmoother.cpp b/Core/src/TrackFitting/GainMatrixSmoother.cpp
@@ -35,8 +35,16 @@ Result<void> GainMatrixSmoother::calculate(
                   predictedCovariance(prev_ts).inverse();
 
   if (G.hasNaN()) {
-    // error = KalmanFitterError::SmoothFailed;  // set to error
-    // return false;                             // abort execution
+    ACTS_VERBOSE("Gain smoothing matrix G has NaNs");
+
+    ACTS_VERBOSE("Filtered covariance:\n" << filteredCovariance(ts));
+    ACTS_VERBOSE("Jacobian:\n" << jacobian(prev_ts));
+    ACTS_VERBOSE("Predicted covariance:\n" << predictedCovariance(prev_ts));
+    ACTS_VERBOSE("Inverse of predicted covariance:\n"
+                 << predictedCovariance(prev_ts).inverse());
+
+    ACTS_VERBOSE("Gain smoothing matrix G:\n" << G);
+
     return KalmanFitterError::SmoothFailed;
   }