add sophus library