Dual joystick control

Robot code uses #def in cmd.c to separate commands. Needs less hack