Added Termination when position error is to high.