-Add some more implementation details of the RRT algorithm, changed a good bit, so I'll probably have to work out some kinks with the merge
Merge branch 'master' of https://github.com/TheSentinel454/hubo_footstep_planner