using sophus_catkin