mola_navstate_smoother

Sliding window Factor-graph data fusion for odometry, IMU, GNSS, and SE(3) pose/twist estimations.

This repository provides:

• NavStateFuse: C++ class to integrate odometry, IMU, and pose/twist estimations.

See package documentation.

Build and install

Refer to the root MOLA repository.

License

This package is released under the GNU GPL v3 license. Other options available upon request.

Changelog for package mola_state_estimation_smoother

3.0.2 (2026-10-01)

3.0.1 (2026-09-28)

• Smoother: work with GTSAM 4.3 (Kilted, Lyrical, Rolling)
• Anchor gauge freedoms ({map} origin and T_enu_to_map azimuth) instead of relying on weak priors
• test-gauge-anchors: require estimates in the late-map window; document anchor helpers
• test-two-odometries: fix covariance indices of the simulated sources
• Contributors: Jose Luis Blanco-Claraco

3.0.0 (2026-09-28)

• Average IMU readings when decimating instead of keeping one raw sample
• Random-walk increment sigma growth and a Huber kernel on pose factors; make a drifting pose source usable through fuse_pose()
• Always fuse wheel odometry as relative increments
• Implement estimated_trajectory(): read back the optimized keyframe poses
• Port to MRPT 3.x
• Never fuse a dataset's ground truth; add relative-pose factors to fuse_pose()
• Expose additional_isam2_update_steps as an environment knob
• Add a covariance floor on the pose reported to a front end
• Don't throw when writing back a keyframe the fixed-lag smoother marginalized
• Optional relative BetweenFactors for wheel odometry
• Wheel odometry's absolute covariance must accumulate
• MOLA_NAVSTATE_DUMP instrumentation and tunable integrator sigmas
• Never take a time difference through Clock::toDouble()
• Make wheel-odometry motion-model sigmas tunable
• Fix deprecation warning for fixed lag smoother, moved to stable
• Fuse raw IMU gyro readings as angular-velocity observations
• Covariance-aware short-term extrapolation
• Test coverage for the predict-twist low-pass filter
• Preserve predict-twist EMA history on same-stamp solves
• Smooth the predicted motion prior (predict-twist low-pass) and moderate default accel sigmas
• Default the shipped config to the real-time path
• Decouple the map->odom /tf child frame from the odometry source frame
• Publish map->odom from the estimator's own graph variable, plus optional base_link_fused
• Sub-ms estimated_navstate() via async backend and high-rate keyframe decimation
• Add nested profiler entries in the estimated_navstate path
• Don't let a late measurement drag the published stamp backwards
• Don't double-count the motion model when splicing a keyframe
• Actually rebuild the smoother on GTSAM failure
• Fix relocalize mode (GNSS+IMU init against a known map) crashing or never converging
• Fuse IMU absolute attitude into georeferencing and state estimation
• Default viz module to MolaVizImGui with a per-app imgui_app_name
• Serve the {odom_i} prediction frame-local, not via {map}
• Don't crash on estimated_navstate() for an unregistered odometry frame
• Contributors: Jose Luis Blanco-Claraco

2.4.2 (2026-06-04)

2.4.1 (2026-06-02)

2.4.0 (2026-05-11)

• FIX: reset() should reinitialize gtsam
• FIX: don't let gtsam exceptions to crash the node
• fix: support building in ROS2 humble with newer cmake
• Merge pull request #30 from MOLAorg/bump-cmake-version bump min req cmake version to 3.22
• bump min req cmake version to 3.22
• Contributors: Jose Luis Blanco-Claraco

2.3.1 (2026-05-04)

• Merge pull request #27 from MOLAorg/feature/ros2-integration-tests Add ROS 2 launch-testing integration tests for StateEstimationSmoother
• fix missing test dep
• workaround for older mola_yaml
• Fix frames of reference for the test checker
• Progress fixing integration test
• mock test code clean up
• More debug traces in python mock integration test
• Add ROS 2 launch-testing integration tests for StateEstimationSmoother Two end-to-end test scenarios driven by a Python sensor mock node.
• Merge pull request #26 from MOLAorg/fix/smoother-issues Fix misc smoother issues
• Clarify docs and fix test noise thresholds
• Remove copies of RegexCache.h and use the shared version in mola_kernel
• fix: make RegexCache move-assignable after adding std::mutex
• fix: guard IMU quaternion path against NaN components in fuse_imu

File truncated at 100 lines see the full file