RRT or RRT* planning algorithm