add heuristic to detect jumps in joint-space distance