Fixed thigh_teleop issues.