向量版 点到平面距离 的推导

平面方程:  p*n  + d  = 0 ; p 为平面上一点,  n 为法线,  d 为原点到平面的距离


点到平面距离的推导过程, 重点是法线n是单位向量, 这就简化了推导, 使其更容易理解.

如图所示:



首先:  Q到平面的距离  r  =  |Q - Q'|

其次:  平面法向量n 和  Q-Q' 平行, 又因为n是单位向量, 可得  Q-Q'   = rn

然后:  Q = rn + Q',  然后两边乘以 n 得  nQ  = rn*n + Q'n

之后:  因为Q'在平面上, 所以由平面方程得 Q'n  + d  = 0 , 即 Q'n = -d 

最后:  n是单位向量, 得  nQ = r + (-d);即 r = nQ + d


### 计算点到平面距离 在点云配准过程中,计算点到平面距离是一项关键技术。通常情况下,该距离用于评估两个点云之间的拟合程度以及优化变换参数。 对于一个已知法向量 \( \mathbf{n}=(a,b,c)^{T} \) 和平面上一点 \( P_{0}(x_0,y_0,z_0) \),可以定义平面方程为: \[ ax + by + cz + d = 0 \] 其中, \[ d=-(ax_0+by_0+cz_0) \] 设有点 \( Q(x_q, y_q, z_q) \),则点Q到上述平面距离D可由下述闭式公式表示[^1]: \[ D=\frac{|ax_q+by_q+cz_q+d|}{\sqrt{a^{2}+b^{2}+c^{2}}} \] 此公式的推导基于几何原理中的垂直投影概念,在实际编程实现时可以直接利用这个公式快速获得所需结果。 下面给出Python代码片段来展示具体的实现方式: ```python import numpy as np def point_to_plane_distance(point, plane_normal, plane_point): """ Calculate the distance from a single point to a given plane. Args: point (np.array): Coordinates of query point [x, y, z]. plane_normal (np.array): Normal vector of target plane [nx, ny, nz]. plane_point (np.array): Any known point on the target plane [px, py, pz]. Returns: float: Distance between input point and specified plane. """ # Compute 'd' value according to plane equation d = -plane_normal.dot(plane_point) numerator = abs(np.sum(plane_normal * point) + d) denominator = np.sqrt(np.sum(plane_normal ** 2)) return numerator / denominator # Example usage if __name__ == "__main__": pnt = np.array([1., 2., 3.]) # Query Point coordinates pln_nml = np.array([-1., 0., 0.5]) # Plane normal vector pln_pnt = np.array([4., 5., 6.]) # Known point lying within the same plane dist = point_to_plane_distance(pnt, pln_nml, pln_pnt) print(f"The calculated distance is {dist:.4f}") ```
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

黑不溜秋的

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值