C++ RRT (Rapidly-exploring Random Tree) Implementation - View it on GitHub