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; }