Changed control_sim to only compensate for joint angles.