swerve_test

mouse controls dx and xy while arrow keys control dtheta.

This is a visulaisation of the wheel speeds and rotations depending on dx,dy,and dt. Just uses math from the google doc. Wheel speeds have no uper limit so they will be inf if you are trying to rotate around the center of the robot as speeds are calculated based on the change in position of the center of the robot.