Hi, our team is having issues with the Swerve Drive Specialties template code. The program seems to be ignoring the variables with the ANGLE_OFFSETS, no matter what we change them to, the wheels always go to the same position.
The values of the Pheonix Tuner seem to match the ANGLE_OFFSETS, but when we pull the angle of the steer from Phoenix Tuner, it does not match what’s on Shuffleboard.
We are using Falcon500s, CANCoders, and the SDS Mk4i L2 swerve module. We are currently testing robot-oriented control with the goal of moving to field-oriented control.
Any help will be appreciated