本文要解决如下问题:给定一些三维空间点,要求用直线拟合这些点,求出直线方程。
一、直线方程的三种表示方法:
参考:空间直线的点向式方程 - 百度文库 (baidu.com)
空间直线方程 - 百度文库 (baidu.com)
1.一般式:
它实际上表示,直线是两个平面的交线,因此可以由两个平面方程得到,即:
2.点向式(标准方程):
(m, n, p) 为直线方程的方向向量;(x0, y0, z0) 为直线上的一个点。需要注意的是(x-x0, y-y0, z-z0)的方向和方向向量是平行的,也因此推导出了上面的方程。
3.参数方程:
由此就可以得到:
二、利用最小二乘,由三维空间数据点拟合直线方程:
参考文献:《三维空间点中基于最小二乘法的分段直线拟合方法》 薛丽红,2015年7月,齐齐哈尔学报,第31卷第4期
相应链接:https://www.doc88.com/p-8189740853644.html
联立上面的方程,就可以得到:
公式中,划红线的2,是该篇文章的笔误,应该是n, n表示数据点的个数。
由此我们就可以得到k1, b1, k2, b2。如果想要把它转换成空间直线标准方程,可以先任意取一个z0值,根据k1,b1,k2,b2 就可以求出x0, y0, 然后任意取一个p值,根据k1, k2, 就可以求出m, n值,代入到标准方程即可(所以,标准方程不是唯一的,需要从标准方程的定义去理解为什么不是唯一的)。
三、python 代码实现:
## 由空间3维点拟合出一条直线
def linear_fitting_3D_points(points):'''用直线拟合三维空间数据点。参考https://www.doc88.com/p-8189740853644.html 《三维空间点中基于最小二乘法的分段直线拟合方法》 薛丽红,2015年7月,齐齐哈尔学报,第31卷第4期注意; 文中的公式推导有误,k1,b1,k2,b2中的系数2, 应该为n,n表示数据点的个数。直线方程可以转化成如下形式(具体见上面的文献):x = k1 * z + b1y = k2 * z + b2Input:points --- List, 三维空间数据点,例如:[[2,3,48],[4,5,50],[5,7,51]]返回值是公式系数 k1, b1, k2, b2'''#表示矩阵中的值Sum_X=0.0Sum_Y=0.0Sum_Z=0.0Sum_XZ=0.0Sum_YZ=0.0Sum_Z2=0.0for i in range(0,len(points)):xi=points[i][0]yi=points[i][1]zi=points[i][2]Sum_X = Sum_X + xiSum_Y = Sum_Y + yiSum_Z = Sum_Z + ziSum_XZ = Sum_XZ + xi*ziSum_YZ = Sum_YZ + yi*ziSum_Z2 = Sum_Z2 + zi**2n = len(points) # 点数den = n*Sum_Z2 - Sum_Z * Sum_Z # 公式分母k1 = (n*Sum_XZ - Sum_X * Sum_Z)/ denb1 = (Sum_X - k1 * Sum_Z)/nk2 = (n*Sum_YZ - Sum_Y * Sum_Z)/ denb2 = (Sum_Y - k2 * Sum_Z)/nreturn k1, b1, k2, b2
如有错误,请指正。谢谢!