A C++ based library for robotic algorithms and tools development