计算空间点到直线的距离

利用向量的叉积计算空间点到直线的距离，Eigen库已经给我封装好了只需按着要求调用就好了。
举个简单的例子如下：已知空间直线的方向向量表示为(m,n,p)，已知直线上一点坐标为B（x0,y0,z0），求解空间点A（x,y,z）B到直线的距离d
需要构建两个向量：

Eigen::Vector4d vec1（m,n,p,0） ;//方向向量
vec1.normalize() ;//单位化
Eigen::Vector4d vec2(x-x0,y-y0,z-z0, 0);// 空间点方向向量
double dst = vec1.cross3(vec2).squaredNorm() ;
double d=sqrt(dst)

是不是很简单！