providing external odometry to the ROS navigation stack
I am using a combination Realsense T265 and T435 and try to improve turtlebot2 navigation capabilities using RtabMap. The slam algorithm seems to work just fine, and the cameras position is quite accurately tracked. The problem comes when trying to use the ros navigation stack, which considers the robot location as being base_footprint, and not the my cameras position(which is more accurate). My tf trees starts with map-> odom which was two children: base_footprint and t265_odom_frame. Is there way of linking the base_footprint as a child of t265_odom_frame? /odom topic contains a set of /odom to /base_footprint tf transforms which are published by the mobile_base_nodlet_manager node. I assume I have to change this not and make it publish t265_odom_frame to base_footprint transforms, but I am not sure how and where I can do that.
As a reference, I started with this tutorial: rtab navigation and slightly modified to work with RS t265. In my demo, I can see how the robot model is following base_footprint while diverging from the pose estimation provided by the camera.
Thanks!