线段拟合

线段特征上的扫描点满足 (1)。本文的线段特征定义为:L: [dL, φL, PLs, PLe]T,如图1所示。其中,dL为笛卡尔坐标系中原点(激光传感器所在位置)到线段的距离, φL为线段特征的倾角,PLs为线段特征起点,PLe为线段特征终点。线段特征在笛卡尔坐标系下方程为:

                                                                                                                                                                          (1)

其中,dL > 0,-π < φLπxi = ρicosφiyi = ρisinφi

图1 线段

前几节中,通过统计学方法划分出若干区域,为了准确提取线段特征,采用带约束的最小二乘法对每个划分区域特征进行特征提取,将(1)式转换为如下形式:

                                                                                                                                                                   (2)

式中 SE——线段端点。

将上式改写为矩阵形式有:

                                                                                                                                                        (3)

其中。由于α22=1,引入拉格朗日乘子λ,得:

                                                                                                                                                                                             (4)

其中,,满足JTCJ=1。令,得:

                                                                                                                                                                                                          (5)

解上式的广义特征值与广义特征向量,S为一个正定矩阵,待求特征向量J一定对应最小的特征值λ。当αβ确定以后,可以求得:

                                                                                                                                                                                                     (6)

然后,求出线段特征dL。最后,转换到全局坐标系下。

文献[1]给出了一种误差传播方法,通过最小化隐含的关系方程F(I,O),给出最终误差(I输入误差,O输出误差)。将误差扩展到协方差矩阵,可以通过输入的协方差矩阵ΣI,得到输出的协方差矩阵ΣL。则有:

                                                                                                                                        (7)

其中,令:

                                                                                                                                                                                      (8)

代入最后计算出ΣL

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 1
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值