reset drivetrain to average of first new vision readings

[tortillini-tokki]

No description provided.

[amzoeee]

lgtm; i think we should test before running in a match though.

[augmentcode]

🤖 Augment PR Summary

Summary: Adds a post-bump odometry recovery path by hard-resetting drivetrain pose from the first valid vision updates.

Changes:

• On bump detection, clears camera history and sets a flag to reset pose on the next valid vision reading.
• In updatePoseEst(), when the flag is set, computes an averaged XY translation from available camera readings and calls m_drivetrain.resetPose, skipping normal vision fusion for that cycle.
• Adds VisionSubsystem.getAverageTranslation(...) to average translation across multiple camera pose estimates.

Technical Notes: The reset uses vision for translation while retaining the drivetrain/gyro-based heading.

_{🤖 Was this summary useful? React with 👍 or 👎}

[augmentcode]

Review completed. 3 suggestions posted.

Comment augment review to trigger a new review at any time.