Here is our offseason swerve code. We were able to get the limelight to track a target and drive in auto. This is borrowed heavily from 4048 (Thanks)!. We using the Swerve Drive Specialties modules, Andymark absolute encoders, and Pigeon for gyro.
Good luck to all in the new season. We are really hoping the field will be swerve friendly.