Skip to content

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.

tbowers7 and others added 4 commits February 3, 2026 15:37
* Add vision examples from good teams
* WIP: Getting 254's vision code to compile
* FRC254's 2024 vision code builds! -- Next step is to mesh in the parts of the vision code I need for the circular vision buffer to the base vision subsystem.
* WIP: Adding SPAM's vision code
* SPAM / FRC180 vision now builds -- The vision subsystem from FRC180 / SPAM now builds within the 2486 code base.  Next steps are to figure out which parts of the various vision combination schemes I want to use and hack together something!
* Add 6328's 2025 drive-to-pose algorithm
* Make cleaner diff against Az-RBSI
* Update FRC254's vision to 2025 version
* Fix rebase error
* Clean non-ASCII characters
* Compilable Vision with pose buffering -- Create a pose buffer and use timestamps to match vision values with those from odometry to reduce jitter.  Also be able to define certain tags in whose location we trust more (e.g. HUB in 2026) in the event of field misshapenness.  Weave the new Vision structure together with the drivetrain to allow for timestamped pose insertion into the estimator.

---------

Co-authored-by: NutHouse coco-prog-3 <github@team2486.org>
* Clean up the Accelerometer / IMU subsystems -- Clean up the code, but also specifically allow the RIO or IMU to be "on its side" (i.e., Z is not necessarily "up").
* Clean up Drive.java
* Clean the Moudule modules a bit
* Clean non-ASCII characters
* Reduce drivebase periodic cycle time by using primitives
* Clean up the Vision module
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 tbowers7 added the bug Something isn't working label Feb 9, 2026
@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
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