示例#1
0
文件: graph.cpp 项目: Barbakas/LMA
 bool operator()(const Pose& pose, const Point3D& point3d, double (&res) [2]) const
 {
 	res[0] = pose.norm() + point3d.norm();
 	res[1] = pose.squaredNorm() + point3d.squaredNorm();
 	return true;
 }