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 basefootprint, and not the my cameras position(which is more accurate). My tf trees starts with map-> odom which was two children: basefootprint and t265odomframe. Is there way of linking the basefootprint as a child of t265odomframe? /odom topic contains a set of /odom to /basefootprint tf transforms which are published by the mobilebasenodletmanager node. I assume I have to change this not and make it publish t265odomframe to basefootprint 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!