moved from aslam_visual_inertial