Eigen学习4：Vector运算计算距离和角度
求一点到原点的距离Vector3d v(x,y,z);double dis1= v.norm(); // 等于 sqrt(x^2+y^2) , 即距离double dis2 = v.squaredNorm(); // (x^2+y^2)求两点之间的距离d v1(x1,y1,z1);Vector3d v2(x2,y2,z2);double dis = (v1-v2).norm();两个向量之间的夹角Vector3d v1(x1,y1,z1),.
