Add joy_control and teleop