Swerve Drive localization Simulation

[realjoshuau]

Move simulated robot around glass field2D using natural joystick commands.

[3LucasZ]

I believe this is completed, please send video of sim working when you are available. Thanks :).

[realjoshuau]

Sure. Will send once available to work on FRC (came back from trip today)