Started working on teleop control with joystick.