Fixed a bug with the unidirectional rrt where we were only checking for goal if the target was goal
Fixed a bug with the unidirectional rrt where we were only checking for goal if the target was goal

dartsim/dart,axeisghost/DART6motionBlur,dartsim/dart,dartsim/dart,axeisghost/DART6motionBlur,dartsim/dart,axeisghost/DART6motionBlur,dartsim/dart