Skip to content

Comments

Fix Pose Bug (Issue #140)#141

Merged
tbowers7 merged 25 commits intodevelopfrom
fix_pose_bug
Feb 20, 2026
Merged

Fix Pose Bug (Issue #140)#141
tbowers7 merged 25 commits intodevelopfrom
fix_pose_bug

Conversation

@tbowers7
Copy link
Collaborator

@tbowers7 tbowers7 commented Feb 7, 2026

Fix the pose bug described in #140 .

The background is that the combination of vision with the new pose buffer causes wild oscillations in the Pose2d YAW of the robot, even when the robot is physically not moving.

In Progress

This PR is still in progress.

Closes #140.

The SIM mode was not separately gated behind an `else`, so REAL mode was
double-adding pose estimates.
@tbowers7 tbowers7 changed the base branch from main to develop February 7, 2026 23:11
@tbowers7
Copy link
Collaborator Author

tbowers7 commented Feb 9, 2026

Apparently, the gyro with the new pose buffering is having problems, too. 🤦

tbowers7 and others added 2 commits February 9, 2026 10:46
* Add GSG instructions related to building the Pi Box

* Limit stall current

* Begin the vision documentation

* Minor Nits to vision docs

* Update vision docs

---------

Co-authored-by: Lewis Ruskin <Lew.ruskin”@gmail.com>
* Update PhotonLib

* Update YAGSL

* Revert Phoenix libraries to non-replay versions -- YAGSL no longer depends on the replay versions of the Phoenix 5/6 libraries.

* Update PhotonLib to 2026.2.2
@tbowers7 tbowers7 added the bug Something isn't working label Feb 9, 2026
tbowers7 and others added 6 commits February 9, 2026 10:52
* Add a "RBSI-standard" AdvantageScope layout -- Primarily for tournament troubleshooting by CSA's.

* Revert drivebase power port assignments -- No changes to be pushed to teams in case they already updated these in their templated code.
Merge in development work for the v26.1 release.
Bumps com.diffplug.spotless from 8.1.0 to 8.2.0.

---
updated-dependencies:
- dependency-name: com.diffplug.spotless
  dependency-version: 8.2.0
  dependency-type: direct:production
  update-type: version-update:semver-minor
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>
Bumps com.diffplug.spotless from 8.2.0 to 8.2.1.

---
updated-dependencies:
- dependency-name: com.diffplug.spotless
  dependency-version: 8.2.1
  dependency-type: direct:production
  update-type: version-update:semver-patch
...

Signed-off-by: dependabot[bot] <support@github.com>
Co-authored-by: dependabot[bot] <49699333+dependabot[bot]@users.noreply.github.com>
@tbowers7 tbowers7 changed the base branch from develop to main February 11, 2026 16:53
@tbowers7 tbowers7 marked this pull request as draft February 11, 2026 16:53
@tbowers7 tbowers7 mentioned this pull request Feb 16, 2026
That plot (purple exploding to tens of thousands of feet) is exactly what
you see when the time-alignment math is applying the odometry delta in the
wrong reference frame. The fused pose stays sane because it’s only aligning
aw camera estimates (which are usually already close to odom), but the smoother
repeatedly re-aligns already-fused field poses across a sliding window — and a
small frame mistake turns into a huge “ping-pong” once you do it over and over.
Got the pose buffering cleaned up and working.  Next step is to clean the
code so that it's easy to read and clean up any extraneous additions.
@tbowers7 tbowers7 changed the base branch from main to v26release February 17, 2026 17:02
@tbowers7 tbowers7 changed the base branch from v26release to main February 17, 2026 17:03
@tbowers7 tbowers7 marked this pull request as ready for review February 17, 2026 19:40
Next step: clean up the logging to remove extraneous debug statements.
@tbowers7 tbowers7 changed the base branch from main to develop February 20, 2026 18:24
@tbowers7 tbowers7 merged commit 39dca7b into develop Feb 20, 2026
5 checks passed
@tbowers7 tbowers7 deleted the fix_pose_bug branch February 20, 2026 18:27
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

bug Something isn't working

Projects

None yet

Development

Successfully merging this pull request may close these issues.

[BUG] Pose Estimator

1 participant