improved RRTPlanner's random point generation

* it should still take into account robot radius, but I'll leave that
* alone for now since I haven't checked everything to verify.