Robot-localization porting to ROS2

Let’s keep this discussion over on the source repo, thanks. I’ll respond when I have some time (travelling at the moment).