Simple code for a VRC Swerve drive. Could be updated with actual PID, but this is a start.
simple code to control a VEX V5 swerve drive