rgb_depth_system does not show sensors in place after optimization

[miguelriemoliveira]

After optimizing this system, it seem like we have good results:

But the sensors do not appear to be well matched in rviz: