基于海量点云恢复3D圆锥的简化方程求解技术问询

Hey 老兄！既然你已经能用线性求解器搞定点云里的圆柱和球体了，那咱们把这套思路拓展到圆锥上——还是用代数拟合的路子，上手应该很快。

1. 先拟合通用二次曲面 #

圆锥属于二次曲面的一种，所以第一步先把点云代入二次曲面的通用方程，用线性求解器算出系数：

• 拿每个点云点(x_i, y_i, z_i)，代入下面的通用二次方程：

  A x_i² + B y_i² + C z_i² + D x_i y_i + E x_i z_i + F y_i z_i + G x_i + H y_i + I z_i + J = 0
  

• 把所有点的方程攒成一个N×10的齐次线性矩阵M，每一行就是[x_i², y_i², z_i², x_i y_i, x_i z_i, y_i z_i, x_i, y_i, z_i, 1]，我们要解的就是M · [A,B,C,D,E,F,G,H,I,J]^T = 0这个齐次系统。
• 用SVD分解求最小二乘解就行：对M做SVD分解M=UΣV^T，取V的最后一列（对应最小奇异值的特征向量）作为系数向量——因为是齐次方程，系数是比例意义上的，没问题。

2. 验证这个二次曲面是不是圆锥 #

拿到系数后，得确认它真的是圆锥，不是别的二次曲面：

2.1 检查二次型矩阵的秩 #

先构建二次型矩阵Q：

Q = [
  [A,   D/2, E/2],
  [D/2, B,   F/2],
  [E/2, F/2, C]
]

圆锥的Q矩阵秩必须是2（因为圆锥是退化的二次曲面，锥面的二次型矩阵秩都是2）。你可以用SVD看奇异值，如果有一个奇异值远小于另外两个（几乎是0），那秩就是2，符合条件。

2.2 找奇点（也就是圆锥的顶点） #

圆锥的顶点是二次曲面的奇点，满足三个线性方程：

A x0 + (D/2) y0 + (E/2) z0 + G/2 = 0
(D/2) x0 + B y0 + (F/2) z0 + H/2 = 0
(E/2) x0 + (F/2) y0 + C z0 + I/2 = 0

同时把(x0,y0,z0)代入二次曲面方程，左边得等于0。因为Q的秩是2，前三个方程的解是一条直线（就是圆锥的轴），这条直线和二次曲面的交点就是顶点，解出来就行。

3. 提取圆锥的几何参数 #

确认是圆锥后，就能把顶点、轴、半顶角这些关键参数抠出来了：

3.1 顶点P0 #

解上面的奇点方程组，得到的(x0,y0,z0)就是圆锥的顶点。

3.2 轴的方向向量 #

Q矩阵的零空间（对应奇异值为0的特征向量）就是圆锥的轴方向。因为Q秩是2，零空间是一维的，把这个特征向量单位化，就是轴的单位方向向量u。

3.3 半顶角θ #

随便拿一个不是顶点的点云点P，算向量v = P - P0，然后用这个式子算半顶角：

sinθ = ||v × u|| / ||v||

因为||v×u||等于||v|| * ||u|| * sinθ，u是单位向量，所以直接这么算就行。多拿几个点算平均，精度会更高。

4. 优化（可选） #

如果点云有噪声，第一次拟合的参数可能有点飘，你可以用非线性最小二乘做个微调：用初步得到的顶点、轴、半顶角当初始值，最小化所有点到圆锥的距离平方和，参数会更准。

内容的提问来源于stack exchange，提问作者phoenixdev