Harshal Deshpande

Hi @willstott101, Great. I think it makes sense to start adding tests which only have the main model of the robot. Later we can start adding sensor in the SDF....

Thanks. Will take a look at it. I was on vacation over the past few days. Haven't had a chance to look at the code

  Taking around 0.4 secs to find path in this env with expand_dis = 0.1   In this env it's taking around 2s to build the tree

@threewisemonkeys-as this lgtm. Just go through the code once. I've mostly reused the code from rrt, but still let me know if there are any issues

I think we should keep RRTConnect and BidirectionalRRT separate

Added RRTConnect in #98. Bidirectional RRT* is yet to be added.

https://github.com/arturmiller/pybind11_examples This might be useful