Made joystick more robust
Fixed stuff with global robot and pointers in robot_class