Lightning Framework Fake Pull Request

I made this PR to myself so that Ioan/Mark can add comments inline if desired.
You should just use this side of the if. GoalState is also a sampleable goal region. Look at how RRTConnect is implemented, for example.