Working robocar test code

Sarang's adding a better (?) version later bee-tee-dubs