画点到直线的垂线matlab

问题遇到的现象和发生背景

在三维空间中确定一个点到直线的距离,直线是通过其他的点拟合的

问题相关代码,请勿粘贴截图
运行结果及报错内容
我的解答思路和尝试过的方法
我想要达到的结果

首先是直线的定义,我这里用的y=kx+b,即点斜式的方案

k = 1;
b = 2;
xp = 2; % 点的x坐标
yp = 2; % 点的y坐标
f1 =@(x) k*x+b;
f2 = @(x) -1/k*x+yp+1/k*xp;
fplot(f1,[-5,5],'r'); hold on % 画图
fplot(f2,[-5,5],'b')
plot(xp,yp, 'ro')
axis equal

效果:

img