Based on the WPILib StatespaceDifferentialDriveSimulation example project. https://github.com/wpilibsuite/allwpilib/tree/master/wpilibjExamples/src/main/java/edu/wpi/first/wpilibj/examples/statespacedifferentialdrivesimulation
Testing robot simulation.