Added visualization for circles traversed at each path point
Fixed circle marker array visualization bugs
WIP - Bezier spline class
WIP - Cubic spline re-integration
Fixed compile errors and swapped out c++11 features for legacy versions