Code for a swerve using SRX Mag Encoders wired to roboRIO. Based off SDS template code - View it on GitHub