Safety, stop, slowdown interpolator if speed, position, torque error too large