利用matlab求点到直线距离和垂足坐标(空间)

参考链接：三维空间：点到直线垂足坐标公式推导_垂足 三维 计算_仰望星空_LiDAR的博客-CSDN博客

 

matlab 代码：

% P0 O点
% P1 A点
% P2 B点

P0=[3 6 0];
P1=[0 0 0];
P2=[10 0 0];

x0=P0(1);
y0=P0(2);
z0=P0(3);

x1=P1(1);
y1=P1(2);
z1=P1(3);

x2=P2(1);
y2=P2(2);
z2=P2(3);

K=-((x1-x0)*(x2-x1)+(y1-y0)*(y2-y1)+(z1-z0)*(z2-z1))/((x2-x1)^2+(y2-y1)^2+(z2-z1)^2);

xN=K*(x2-x1)+x1
yN=K*(y2-y1)+y1
zN=K*(z2-z1)+z1