C++ robotics library