From f81879aff6b53e385caee0db561833348f262efa Mon Sep 17 00:00:00 2001
From: Frank Dellaert <dellaert@gmail.com>
Date: Fri, 16 May 2025 15:45:07 -0400
Subject: [PATCH] Fix include for Retract

---
 examples/IEKF_NavstateExample.cpp | 11 ++++++-----
 1 file changed, 6 insertions(+), 5 deletions(-)

diff --git a/examples/IEKF_NavstateExample.cpp b/examples/IEKF_NavstateExample.cpp
index ef3ef204b..fcbede1ef 100644
--- a/examples/IEKF_NavstateExample.cpp
+++ b/examples/IEKF_NavstateExample.cpp
@@ -17,6 +17,7 @@
  */
 
 #include <gtsam/base/Matrix.h>
+#include <gtsam/base/VectorSpace.h>
 #include <gtsam/base/OptionalJacobian.h>
 #include <gtsam/navigation/InvariantEKF.h>
 #include <gtsam/navigation/NavState.h>
@@ -73,23 +74,23 @@ int main() {
   z2 << 0.6, 0, 0;
 
   cout << "=== Init ===\nX: " << ekf.state() << "\nP: " << ekf.covariance()
-       << "\n\n";
+    << "\n\n";
 
   // --- first predict/update ---
   ekf.predict(dynamics(imu1), dt, Q);
   cout << "--- After predict 1 ---\nX: " << ekf.state()
-       << "\nP: " << ekf.covariance() << "\n\n";
+    << "\nP: " << ekf.covariance() << "\n\n";
   ekf.update(h_gps, z1, R);
   cout << "--- After update 1 ---\nX: " << ekf.state()
-       << "\nP: " << ekf.covariance() << "\n\n";
+    << "\nP: " << ekf.covariance() << "\n\n";
 
   // --- second predict/update ---
   ekf.predict(dynamics(imu2), dt, Q);
   cout << "--- After predict 2 ---\nX: " << ekf.state()
-       << "\nP: " << ekf.covariance() << "\n\n";
+    << "\nP: " << ekf.covariance() << "\n\n";
   ekf.update(h_gps, z2, R);
   cout << "--- After update 2 ---\nX: " << ekf.state()
-       << "\nP: " << ekf.covariance() << "\n";
+    << "\nP: " << ekf.covariance() << "\n";
 
   return 0;
 }