@@ -145,10 +145,9 @@ class GTSAM_EXPORT LeggedInvariantEKF : public LeftLinearEKF<ExtendedPose3d>,
145145 using Covariance = typename EkfBase::Covariance;
146146
147147 // / Construct the ExtendedPose3-based EKF.
148- GTSAM_EXPORT LeggedInvariantEKF (
149- const NavState& navState0, const Matrix& footholds0, const Matrix& P0,
150- const LeggedEstimatorParams& params,
151- const std::vector<std::string>& footNames = {});
148+ LeggedInvariantEKF (const NavState& navState0, const Matrix& footholds0,
149+ const Matrix& P0, const LeggedEstimatorParams& params,
150+ const std::vector<std::string>& footNames = {});
152151
153152 // / Return the current full covariance.
154153 Matrix covariance () const { return EkfBase::covariance (); }
@@ -173,12 +172,11 @@ class GTSAM_EXPORT LeggedInvariantEKF : public LeftLinearEKF<ExtendedPose3d>,
173172 }
174173
175174 // / Predict forward using one IMU sample.
176- GTSAM_EXPORT void predict (const Vector3& omegaBody,
177- const Vector3& specificForceBody,
178- double dt) override ;
175+ void predict (const Vector3& omegaBody, const Vector3& specificForceBody,
176+ double dt) override ;
179177
180178 // / Process all currently active contacts for the current step.
181- GTSAM_EXPORT void processContacts (
179+ void processContacts (
182180 const std::vector<ContactMeasurement>& activeContacts) override ;
183181
184182 // / Autonomous flow used by the left-linear prediction step.
@@ -206,18 +204,17 @@ class GTSAM_EXPORT LeggedInvariantEKF : public LeftLinearEKF<ExtendedPose3d>,
206204 };
207205
208206 // / Build an `ExtendedPose3(2+k)` state from base state and world footholds.
209- GTSAM_EXPORT static ExtendedPose3d MakeState (const NavState& navState,
210- const Matrix& footholds);
207+ static ExtendedPose3d MakeState (const NavState& navState,
208+ const Matrix& footholds);
211209
212210 // / Build the gravity-only left increment for one prediction step.
213- GTSAM_EXPORT static ExtendedPose3d GravityIncrement (size_t numFeet,
214- const Vector3& gravity,
215- double dt);
211+ static ExtendedPose3d GravityIncrement (size_t numFeet, const Vector3& gravity,
212+ double dt);
216213
217214 // / Build the IMU-only right increment for one prediction step.
218- GTSAM_EXPORT static ExtendedPose3d ImuIncrement (
219- size_t numFeet, const Vector3& omegaBody ,
220- const Vector3& specificForceBody, double dt);
215+ static ExtendedPose3d ImuIncrement (size_t numFeet, const Vector3& omegaBody,
216+ const Vector3& specificForceBody ,
217+ double dt);
221218
222219 // / Return the `ExtendedPose3` block index corresponding to a foot number.
223220 static size_t FootColumn (size_t foot) { return 2 + foot; }
@@ -229,10 +226,9 @@ class GTSAM_EXPORT LeggedInvariantEKF : public LeftLinearEKF<ExtendedPose3d>,
229226 Matrix footholdMatrix () const {
230227 return this ->X_ .xMatrix ().rightCols (static_cast <Eigen::Index>(numFeet ()));
231228 }
232- GTSAM_EXPORT void resetFootToMeasurement (size_t foot,
233- const Vector3& bodyPoint);
234- GTSAM_EXPORT void marginalizeFoot (size_t foot);
235- GTSAM_EXPORT virtual void applyContactUpdate (
229+ void resetFootToMeasurement (size_t foot, const Vector3& bodyPoint);
230+ void marginalizeFoot (size_t foot);
231+ virtual void applyContactUpdate (
236232 const std::vector<ContactMeasurement>& activeContacts);
237233 bool awaitingFullContactInitialization () const {
238234 return params_.useFullContactInitialization && !fullContactInitialized_;
@@ -266,10 +262,9 @@ class GTSAM_EXPORT LeggedInvariantEKF : public LeftLinearEKF<ExtendedPose3d>,
266262class GTSAM_EXPORT LeggedInvariantIEKF : public LeggedInvariantEKF {
267263 public:
268264 // / Construct the graph-update ExtendedPose3 estimator.
269- GTSAM_EXPORT LeggedInvariantIEKF (
270- const NavState& navState0, const Matrix& footholds0, const Matrix& P0,
271- const LeggedEstimatorParams& params,
272- const std::vector<std::string>& footNames = {});
265+ LeggedInvariantIEKF (const NavState& navState0, const Matrix& footholds0,
266+ const Matrix& P0, const LeggedEstimatorParams& params,
267+ const std::vector<std::string>& footNames = {});
273268
274269 protected:
275270 void applyContactUpdate (
0 commit comments