Attempt to resolve Windows linking

Author: dellaert

gtsam/navigation/PreintegratedRotation.cpp

@@ -68,7 +68,8 @@ bool PreintegratedRotation::equals(const PreintegratedRotation& other,
       && equal_with_abs_tol(delRdelBiasOmega_, other.delRdelBiasOmega_, tol);
 }
 
-Rot3 PreintegratedRotation::IncrementalRotation::operator()(
+namespace internal {
+Rot3 IncrementalRotation::operator()(
     const Vector3& bias, OptionalJacobian<3, 3> H_bias) const {
   // First we compensate the measurements for the bias
   Vector3 correctedOmega = measuredOmega - bias;
@@ -93,12 +94,13 @@ Rot3 PreintegratedRotation::IncrementalRotation::operator()(
   }
   return incrR;
 }
+}  // namespace internal
 
 void PreintegratedRotation::integrateGyroMeasurement(
     const Vector3& measuredOmega, const Vector3& biasHat, double deltaT,
     OptionalJacobian<3, 3> F) {
   Matrix3 H_bias;
-  IncrementalRotation f{measuredOmega, deltaT, p_->body_P_sensor};
+  internal::IncrementalRotation f{measuredOmega, deltaT, p_->body_P_sensor};
   const Rot3 incrR = f(biasHat, H_bias);
 
   // Update deltaTij and rotation

gtsam/navigation/PreintegratedRotation.h

@@ -176,32 +176,6 @@ class GTSAM_EXPORT PreintegratedRotation {
 
   /// @}
 
-  /// @name Internal, exposed for testing only
-  /// @{
-
-  /**
-   * @brief Function object for incremental rotation.
-   * @param measuredOmega The measured angular velocity (as given by the sensor)
-   * @param deltaT The time interval over which the rotation is integrated.
-   * @param body_P_sensor Optional transform between body and IMU.
-   */
-  struct IncrementalRotation {
-    const Vector3& measuredOmega;
-    const double deltaT;
-    const std::optional<Pose3>& body_P_sensor;
-
-    /**
-     * @brief Integrate angular velocity, but corrected by bias.
-     * @param bias The bias estimate
-     * @param H_bias Jacobian of the rotation w.r.t. bias.
-     * @return The incremental rotation
-     */
-    Rot3 operator()(const Vector3& bias,
-                    OptionalJacobian<3, 3> H_bias = {}) const;
-  };
-
-  /// @}
-
   /// @name Deprecated API
   /// @{
 
@@ -250,4 +224,28 @@ class GTSAM_EXPORT PreintegratedRotation {
 template <>
 struct traits<PreintegratedRotation> : public Testable<PreintegratedRotation> {};
 
+namespace internal {
+/**
+ * @brief Function object for incremental rotation.
+ * @param measuredOmega The measured angular velocity (as given by the sensor)
+ * @param deltaT The time interval over which the rotation is integrated.
+ * @param body_P_sensor Optional transform between body and IMU.
+ */
+struct IncrementalRotation {
+  const Vector3& measuredOmega;
+  const double deltaT;
+  const std::optional<Pose3>& body_P_sensor;
+
+  /**
+   * @brief Integrate angular velocity, but corrected by bias.
+   * @param bias The bias estimate
+   * @param H_bias Jacobian of the rotation w.r.t. bias.
+   * @return The incremental rotation
+   */
+  Rot3 operator()(const Vector3& bias,
+                  OptionalJacobian<3, 3> H_bias = {}) const;
+};
+
+}  // namespace internal
+
 }  /// namespace gtsam

gtsam/navigation/tests/testPreintegratedRotation.cpp

@@ -52,8 +52,7 @@ TEST(PreintegratedRotation, integrateGyroMeasurement) {
 
   // Check the value.
   Matrix3 H_bias;
-  PreintegratedRotation::IncrementalRotation f{measuredOmega, deltaT,
-                                               p->getBodyPSensor()};
+  internal::IncrementalRotation f{measuredOmega, deltaT, p->getBodyPSensor()};
   const Rot3 incrR = f(bias, H_bias);
   Rot3 expected = Rot3::Roll(omega * deltaT);
   EXPECT(assert_equal(expected, incrR, 1e-9));
@@ -98,8 +97,7 @@ TEST(PreintegratedRotation, integrateGyroMeasurementWithTransform) {
 
   // Check the value.
   Matrix3 H_bias;
-  PreintegratedRotation::IncrementalRotation f{measuredOmega, deltaT,
-                                               p->getBodyPSensor()};
+  internal::IncrementalRotation f{measuredOmega, deltaT, p->getBodyPSensor()};
   Rot3 expected = Rot3::Pitch(omega * deltaT);
   EXPECT(assert_equal(expected, f(bias, H_bias), 1e-9));