Skid Steer Generator

After months of work, the trajectory generator is finally ready to be run on the competition robot!

It follows a simple spline insanely well:

XDrive Generator

I modified the code to support X drives. It actually was able to simplify a bit, because the X-Drive is able to follow the path much easier.

Here is an output of the x-drive trajectory generator:

And some robot testing: