Control integration testing

[AbBaSaMo]

• [ ] steering controller must be updated and tested
• [ ] determine interface to drive wheels
• [ ] pid implementation considerations

Basically, send it random cmd_twist, maybe via teleop twist joy and observe movements while raised on blocks