A demo of some swerve drive code

All angles in this codebase are relative to terminal position

If the robot is going forward, the wheels are all at 90 deg

IF the robot is going right, the wheels are all at 0 deg