Implementation of the Obstacle Avoidance algorithm in C++ - View it on GitHub