Added: a-star, a-star shortest path, RRT search