• 小豆包的学习之旅:传感器观测模型


      传感器观测模型,主要针对激光测距传感器进行说明。

    1.Beam Model 测量光束模型

      激光测量光束模型是对激光测量过程的近似物理描述,激光测距仪沿激光发出的光束测量周围物体的距离。该模型将一条沿光束进行的测量$p(z_{t}|x_{t},m)$表达为四种概率密度的混合。认为存在四种类型的测量误差。

    2.Likehood Field 似然场模型

       主要思想是将激光传感器扫描的端点投影到地图的全局坐标系下。机器人$t$时刻的位姿为$x_{t}=(x,y, heta)^T$,传感器的安装位置相对于机器人的中心坐标$(x_{k,sens}    y_{k,sens})^T$,激光光束相对于机器人的朝向(Heading direction)的角度为$ heta_{k,sens}$。激光测量端点的坐标为$z_{t}^k$,相对于激光器中心。激光扫描到的点投影到地图的全局坐标系坐标为$(x_{z_t^k} y_{z_t^k})$.

    [left( {egin{array}{*{20}{c}}
    {{x_{z_t^k}}}\
    {{y_{z_t^k}}}
    end{array}} ight) = left( {egin{array}{*{20}{c}}
    x\
    y
    end{array}} ight) + left( {egin{array}{*{20}{c}}
    {cos heta }&{ - sin heta }\
    {sin heta }&{cos heta }
    end{array}} ight)left( {egin{array}{*{20}{c}}
    {{x_{k,sens}}}\
    {{y_{k,sens}}}
    end{array}} ight) + z_t^kleft( {egin{array}{*{20}{c}}
    {cos ( heta + { heta _{k,sens}})}\
    {sin ( heta + { heta _{k,sens}})}
    end{array}} ight)]

      该模型认为存在三种类型的噪声和不确定性。即:测量误差$p_{hit}$,最大测量距离$p_{max}$,背景噪声$p_{rand}$

      (1)测量误差$p_{hit}$,描述的是测量点到对应地图上物体之间存在的误差。

    [{{ m{p}}_{{ m{hit}}}}left( {{ m{z}}_t^k|{x_t},m} ight) = {varepsilon _{{sigma _{hit}}}}left( {dist} ight)]

      (2)最大测量距离$p_{max}$,激光的最大观测会产生很大的似然值。

      (3)用一个均匀分布$p_{rand}$描述观测中的随机噪声

      已知t时刻位姿$x_t$和地图m的情况下,则观测到$ z_t^k$的概率$p(z_t^k|x_{t},m)$

    [{ m{p}}left( {{ m{z}}_t^k|{x_t},m} ight) = {z_{hit}} cdot {p_{hit}} + {z_{rand}} cdot {p_{rand}} + {z_{max }} cdot {p_{max }}]

      其中$z_{hit}$,$z_{rand}$,$z_{max}$为权重。


    总结:

      机器人的运动模型主要是对机器人的运动过程进行建模,利用的是传感器对机器人运动的观测数据(如里程计)。

      激光传感器的作用主要是感知周围环境,获取的扫描数据在SLAM过程中有两个作用:一是构建地图(占用概率栅格地图);另外一个是扫描匹配,优化里程计获取的机器人位姿,扫描匹配是建立局部子图和全局地图位置关系的过程,常用到的就是传感器观测模型。[SLAM]2D激光扫描匹配方法

      地图的更新时一个增量过程,每个时刻扫描的新的观测数据都要融合到现有的地图中,占用概率栅格地图介绍了一种增量更新地图的方法。

      

  • 相关阅读:
    [LeetCode] 714. Best Time to Buy and Sell Stock with Transaction Fee
    [LeetCode] 309. Best Time to Buy and Sell Stock with Cooldown
    [LeetCode] 1291. Sequential Digits
    [LeetCode] 188. Best Time to Buy and Sell Stock IV
    [LeetCode] 123. Best Time to Buy and Sell Stock III
    [LeetCode] 581. Shortest Unsorted Continuous Subarray
    [LeetCode] 1041. Robot Bounded In Circle
    [LeetCode] 1110. Delete Nodes And Return Forest
    [LeetCode] 421. Maximum XOR of Two Numbers in an Array
    [LeetCode] 1109. Corporate Flight Bookings
  • 原文地址:https://www.cnblogs.com/yhlx125/p/6661544.html
Copyright © 2020-2023  润新知