3维点云拟合平面

思路:用已知的三维点坐标拟合一个平面

  • 三维平面方程
    cos ⁡ α ⋅ X i + cos ⁡ β ⋅ Y i + cos ⁡ γ ⋅ Z i + d = 0 \cos \alpha \cdot X_i+\cos \beta \cdot Y_i+\cos \gamma \cdot Z_i +d=0 cosαXi+cosβYi+cosγZi+d=0
  • 点到直线距离
    d i s t a n c e = ∣ A x 0 + B y 0 + C z 0 + D ∣ A 2 + B 2 + C 2 distance=\frac{|Ax_0+By_0+Cz_0+D|}{\sqrt{A^2+B^2+C^2}} distance=A2+B2+C2 Ax0+By0+Cz0+D
  • 优化的目标函数
    d i = ∣ cos ⁡ α ⋅ X i + cos ⁡ β ⋅ Y i + cos ⁡ γ ⋅ Z i − d ∣ d_i = |\cos\alpha\cdot X_i+\cos\beta\cdot Y_i+\cos \gamma \cdot Z_i-d| di=cosαXi+cosβYi+cosγZid
    约束条件: cos ⁡ 2 α + cos ⁡ 2 β + cos ⁡ 2 γ = 1 \cos^2\alpha+\cos^2 \beta+\cos^2\gamma=1 cos2α+cos2β+cos2γ=1
    拉格朗日对偶问题:
    f = ∑ n = 0 N d i 2 − λ ⋅ ( cos ⁡ 2 α + cos ⁡ 2 β + cos ⁡ 2 γ − 1 ) f=\sum_{n=0}^N d_i^2-\lambda\cdot(\cos^2\alpha+\cos^2\beta+\cos^2\gamma-1) f=n=0Ndi2λ(cos2α+cos2β+cos2γ1)
  • 求目标函数f的极小值
    ∂ f ∂ d i = 2 ⋅ ∑ n = 0 N d i = 2 ∑ n = 0 N ∣ cos ⁡ α ⋅ X i + cos ⁡ β ⋅ Y
  • 0
    点赞
  • 5
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值