Added visual navigation test, dead-man switch to joystick controllers, and polar style drive