Discretize in SwerveSubsystem was breaking swerve controls for vision, making it difficult to tune the ProfiledPidControllers. Fixed that and quickly got them tuned for vision to move onto addressing other issues.
Checklist before requesting a review
[x] I have performed a self-review of my code.
[x] I have tested thoroughly.
[x] I have written documentation and explained about my changes to the best of my ability.
Describe your changes
Checklist before requesting a review