matlab求点到直线距离和到平面的距离代码

在MATLAB中，你可以使用向量代数来计算点到直线和点到平面的距离。以下是简单的代码示例：

**点到直线距离**：
假设有直线L通过点A(a1, a2)并平行于向量V(v1, v2)，而点P(x1, y1)是你想测距的点。

function dist = pointToLineDist(A, V, P)
    % A是直线起点坐标，V是直线方向向量，P是测试点坐标
    A = [A; 1]; % 将A转换为列向量以便与向量V相乘
    direction = cross([0, 1], V); % 计算垂直于直线的单位向量
    t = dot(P - A, direction) / norm(direction)^2; % 根据射影定理计算距离
    if t < 0
        t = 0; % 点在直线左侧，距离为0
    elseif t > 1
        t = 1; % 点在直线右侧，距离为|A-P|
    end
    dist = abs(t);
end

**点到平面距离**：
假设有一平面P defined by Ax + By + Cz + D = 0，其中A, B, C是法向量，D是常数，点P(x1, y1, z1)。

function dist = pointToPlaneDist(A, B, C, D, P)
    % A, B, C是平面法向量，D是常数，P是测试点
    n = [A; B; C]; % 法向量
    d = A*P(1) + B*P(2) + C*P(3) + D; % 平面方程中的系数
    dist = abs(d) / norm(n); % 按照公式计算距离
end