Functioning mechanum drive and py_frc simulation.
Stupid fast-forwarding