Skip to content

Odometry fix maybe. check it#32

Open
Jack0wack0 wants to merge 12 commits into
KKAY99:mainfrom
Jack0wack0:Odometry_fix
Open

Odometry fix maybe. check it#32
Jack0wack0 wants to merge 12 commits into
KKAY99:mainfrom
Jack0wack0:Odometry_fix

Conversation

@Jack0wack0
Copy link
Copy Markdown
Contributor

No description provided.

…ks the robot is huge. this fixes robotstate kinematics.
… information from too many sources. wheel based odometry should only go to getState().Pose from CTRE. fixed the RobotConfig(0,0,null) and added negative yaw because pigeon2 is CW-Positive, and WPILib expects CCW-positive.
… sized all arrays to m_limeLights.length instead of empty {}, changed the averaging divisor to validCount (cameras that actually reported) instead of total camera count, and fixed the highest-confidence selector logic which was comparing an index to a confidence value.
Copy link
Copy Markdown
Contributor Author

@Jack0wack0 Jack0wack0 left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

works on my machine

@KKAY99
Copy link
Copy Markdown
Owner

KKAY99 commented Mar 19, 2026 via email

@Jack0wack0
Copy link
Copy Markdown
Contributor Author

We disabled limelight intententionally for our testing.

On Wed, Mar 18, 2026, 5:51 PM Jack0wack0 @.***> wrote:


You can view, comment on, or merge this pull request online at:

#32

Commit Summary

cd25f89

temp odometry fix, must require testing

729917f

fixing current limits

b27bdb7

use kmaxangularspeed instead of kmaxspeed

0e368f1

fix #1, trackwidth expects meters, not inches. 2d rotation thinks the robot

is huge. this fixes robotstate kinematics.

79f669c

removed unused imports

f64b3d9

removed import, removed m_poseEstimator. pathplanner is getting false

information from too many sources. wheel based odometry should only go to

getState().Pose from CTRE. fixed the RobotConfig(0,0,null) and added

negative yaw because pigeon2 is CW-Positive, and WPILib expects

CCW-positive.

0074cdd

Four bugs fixed: initialized m_limeLightNames with new ArrayList<>(), sized

all arrays to m_limeLights.length instead of empty {}, changed the

averaging divisor to validCount (cameras that actually reported) instead of

total camera count, and fixed the highest-confidence selector logic which

was comparing an index to a confidence value.

e3ddf09

claude vision fix

File Changes

(5 files https://github.com/KKAY99/5454/pull/32/files)

  • M

2026/5454-2026-GameBot-Imported/src/main/java/frc/robot/Constants.java

https://github.com/KKAY99/5454/pull/32/files#diff-fc8194a5310b8ccc72f73fed42d35ea32107c4142cab5ca8ee8a14f82d87132f

(5)

  • M

2026/5454-2026-GameBot-Imported/src/main/java/frc/robot/RobotContainer.java

https://github.com/KKAY99/5454/pull/32/files#diff-e04298b17b1b7aed7d6e289281a867db96dcb59a1cbdfc58ab031c2f93451225

(69)

  • M

2026/5454-2026-GameBot-Imported/src/main/java/frc/robot/TunerConstants.java

https://github.com/KKAY99/5454/pull/32/files#diff-6fa2e0f1ed389ba8a99ea0bcf422ffbfbc912943b8108bf357e0dacc62c240e4

(17)

  • M

2026/5454-2026-GameBot-Imported/src/main/java/frc/robot/subsystems/CommandSwerveDrivetrain.java

https://github.com/KKAY99/5454/pull/32/files#diff-18a1a6bd775cb5299547f9b3ad26cdab9863af24f5c2066fd995cd93cbf68076

(63)

  • M

2026/5454-2026-GameBot-Imported/src/main/java/frc/robot/utilities/LimelightManager.java

https://github.com/KKAY99/5454/pull/32/files#diff-47159e8af8362d4c1e66e8aa4edd7dd1fd2e2fe62c95e056641cfedc3d29688a

(34)

Patch Links:

Reply to this email directly, view it on GitHub

#32, or unsubscribe

https://github.com/notifications/unsubscribe-auth/ACQQU7XD5ZR3LKNCR2ISKNL4RMR7JAVCNFSM6AAAAACWXGUQECVHI2DSMVQWIX3LMV43ASLTON2WKOZUGA4TQMJTGY4DKNY

.

You are receiving this because you are subscribed to this thread.Message

ID: @.***>

should probably re-enable? I can comment it out.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

2 participants