Repository navigation
feat(localization): add OdometryFusion (E1) and LandmarkLocalization (E3) - #39
Merged
Merged
Conversation
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com> Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
Wheel and gyroscope EKF on SE(2) with state (x, y, heading, gyro bias): the mean follows the exact SE(2) arc, the covariance uses midpoint Jacobians with speed-scaled wheel noise and a bias random walk, and the wheel yaw-rate, heading and position updates go through the upstream residual-form Kalman update, so slip is caught by the chi-square gate and heading residuals are wrapped. The roadmap canonical example now points at MonteCarloLocalization. Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com> Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
Range-bearing EKF against a known landmark map: body-frame odometry increments composed onto the pose with the F1 increment noise rotated into the world, observations matched by identity or by minimum Mahalanobis distance, chi-square gated and applied through the upstream residual-form Kalman update with the bearing residual wrapped. Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com> Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com> Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
✅
|
| Descriptor | Linter | Files | Fixed | Errors | Max errors | Warnings | Elapsed time |
|---|---|---|---|---|---|---|---|
| ✅ ACTION | actionlint | 7 | 0 | 0 | 0.52s | ||
| ✅ CPP | clang-format | 201 | 0 | 0 | 0 | 1.71s | |
| ✅ CPP | cppcheck | 201 | 0 | 0 | 3.11s | ||
| ✅ DOCKERFILE | hadolint | 1 | 0 | 0 | 0.28s | ||
| ✅ JSON | jsonlint | 8 | 0 | 0 | 0.09s | ||
| ✅ JSON | prettier | 8 | 2 | 0 | 0 | 0.28s | |
| ✅ MARKDOWN | markdownlint | 90 | 0 | 0 | 0 | 1.77s | |
| ✅ MARKDOWN | markdown-table-formatter | 90 | 0 | 0 | 0 | 0.18s | |
| lychee | 137 | 2 | 0 | 2.14s | |||
| ✅ YAML | prettier | 12 | 0 | 0 | 0 | 0.4s | |
| ✅ YAML | yamllint | 12 | 0 | 0 | 0.45s |
Detailed Issues
⚠️ SPELL / lychee - 2 errors
[ERROR] failed to verify TLS certificate: invalid peer certificate: UnknownIssuer
📝 Summary
---------------------
🔍 Total..........357
🔗 Unique.........127
✅ Successful.....345
⏳ Timeouts.........0
🔀 Redirected.......5
👻 Excluded.........9
❓ Unknown..........0
🚫 Errors...........2
⛔ Unsupported......2
Errors in .github/workflows/static-analysis.yml
[403] https://binaries.sonarsource.com/Distribution/sonar-scanner-cli/sonar-scanner-cli-$ (at 37:21) | Rejected status code: 403 Forbidden
Errors in doc/kinematics/InverseKinematics.md
[ERROR] https://mathweb.ucsd.edu/~sbuss/ResearchWeb/ikmethods/iksurvey.pdf (at 125:169) | SSL certificate not trusted. Use --insecure if site is trusted
Hint: Followed 5 redirects. You might want to consider replacing redirecting URLs with the resolved URLs. Use verbose mode (`-v`/`-vv`) to see redirection details.
Hint: You can configure accepted/rejected response codes with `-a` or `--accept`
Notices
REPOSITORY_GITLEAKS, REPOSITORY_KICS. See Removed linters to find their replacements.
See detailed reports in MegaLinter artifacts
Your project could benefit from a custom flavor, which would allow you to run only the linters you need, and thus improve runtime performances. (Skip this info by defining FLAVOR_SUGGESTIONS: false)
- Documentation: Custom Flavors
- Command:
npx mega-linter-runner@10.1.0 --custom-flavor-setup --custom-flavor-linters ACTION_ACTIONLINT,CPP_CPPCHECK,CPP_CLANG_FORMAT,DOCKERFILE_HADOLINT,JSON_JSONLINT,JSON_PRETTIER,MARKDOWN_MARKDOWNLINT,MARKDOWN_MARKDOWN_TABLE_FORMATTER,SPELL_LYCHEE,YAML_PRETTIER,YAML_YAMLLINT

Show us your support by starring ⭐ the repository
…claration and definition The declaration named the position covariance 'covariance', which also shadowed the filter's covariance member. Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com> Claude-Session: https://claude.ai/code/session_014WUWh44uw7k4JjMd6YkAwN
|
This file contains hidden or bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
Add this suggestion to a batch that can be applied as a single commit.This suggestion is invalid because no changes were made to the code.Suggestions cannot be applied while the pull request is closed.Suggestions cannot be applied while viewing a subset of changes.Only one suggestion per line can be applied in a batch.Add this suggestion to a batch that can be applied as a single commit.Applying suggestions on deleted lines is not supported.You must change the existing code in this line in order to create a valid suggestion.Outdated suggestions cannot be applied.This suggestion has been applied or marked resolved.Suggestions cannot be applied from pending reviews.Suggestions cannot be applied on multi-line comments.Suggestions cannot be applied while the pull request is queued to merge.Suggestion cannot be applied right now. Please check back later.



Bumps numerical-toolbox to
b93d6e0, which brings inResidualKalmanUpdate(NT74, embedded-pro/numerical-toolbox-cpp#367). Then it ships the two localization specs that NT74 unblocked.f7b15dc+c91acfcb93d6e0.f4d8d37OdometryFusion: wheel and gyroscope EKF on SE(2) with a gyro-bias state.3b64372LandmarkLocalization: range–bearing EKF against a known landmark map.Each item commit includes the header, coverage
.cpp, tests (the spec's 6 cases each), doc, index rows, and removal of the spec and its roadmap rows.robotics.localizationnow linksnumerical.filters.activeandrobotics.mobile.Highlights
IncrementDeviation, rotated into the world frame.Deviations from the specs
outlier_is_gatedalso checks two of the spec's edge cases, which keeps coverage at 100%: an unknown id returnsSingularwith no landmark, and a map larger thanMaxLandmarksis rejected.FindByIdandNearesthelpers.<float, 8>alongside the spec's<float, 16>.roadmap/README.mdcanonical example now points tolocalization/MonteCarloLocalization.Verification
ctest: 7/7.OdometryFusion.hppandLandmarkLocalization.hpp.-Wall -Wextra -Werror -Wshadowwith-DROBOTICS_TOOLBOX_COVERAGE_BUILD, with dependency headers treated as system headers.clang-format.validate-docsOK; no doc line over 400 characters; tables aligned.Generated by Claude Code