Change method of determining 'done' for joints, should prevent the blocking error