Added swerve code from 2013BunnyBot and fixed mag division.