make sophus catkin package