Added a curvature algorithm that works with the new ROS Groovy
Galapagos! Also, the GeometricMapping algorithm works with
aforementioned algorithm. Consider it Mapping 2.0.