(WIP) Gaussian RIO 2.0 - now in C++ and more ROS friendly - View it on GitHub