improved goal-checking in rrt-viewer