Implementation of COP algorithm. It creates a graph based on a forest of rounded obstacles.
A-Star is also implemented to find the shortest path on that graph.
Pathfinding with changing goal
Graph recalculation when obstacles move
Also ORCA have been integrated into a project with RVO-2 library.