Worked on teleop control for sim_server testing.