Invalidate path if current position is more than 15cm away form the planned position