improved RRTPlanner's random point generation

* Floor_Border is an unplayable part of the floor and should not
* be needed for any calculations

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