Python 求點到直線的垂足

Python 求點到直線的垂足

在已知一個點，和一條已知兩個點的直線的狀況下

運算公式參考連接：https://www.cnblogs.com/mazhenyu/p/3508735.html

 1 def getFootPoint(point, line_p1, line_p2):  2     """
 3  @point, line_p1, line_p2 : [x, y, z]  4     """
 5     x0 = point[0]  6     y0 = point[1]  7     z0 = point[2]  8     
 9     x1 = line_p1[0] 10     y1 = line_p1[1] 11     z1 = line_p1[2] 12     
13     x2 = line_p2[0] 14     y2 = line_p2[1] 15     z2 = line_p2[2] 16     
17     k = -((x1 - x0) * (x2 - x1) + (y1 - y0) * (y2 - y1) + (z1 - z0) * (z2 - z1)) / \ 18         ((x2 - x1) ** 2 + (y2 - y1) ** 2 + (z2 - z1) ** 2)*1.0 19     
20     xn = k * (x2 - x1) + x1 21     yn = k * (y2 - y1) + y1 22     zn = k * (z2 - z1) + z1 23     
24     return (xn, yn, zn)