Dev log 2 of Fieldsim redo

What did i do?

I wrote a basic swerve controller, it allows you to drive the robot around and it even has field oriented driving! I also imported the test field that you might have seen at competitions for robot testing.

Side notes:

The old mesh for the robot was kinda(extremely) unoptimized. So i replaced it with cubes. Check the screenshot for wireframe view.