点到平面的垂足 matlab代码

以下是一个简单的 Matlab 代码来计算点到平面的垂足：

function [foot_point] = point_to_plane_proj(point, plane_normal, plane_point)
% point: 点的位置，格式为 [x, y, z]
% plane_normal: 平面的法向量，格式为 [x, y, z]
% plane_point: 平面上的点，格式为 [x, y, z]

% 计算点到平面的距离
distance = dot(plane_normal, point - plane_point) / norm(plane_normal);

% 计算垂足的位置
foot_point = point - distance * plane_normal;
end

该函数将点的位置、平面的法向量和平面上的一个点作为输入，并返回该点到平面的垂足位置。