SLAM是移动机器人建立环境的地图同时演绎出自己位置的过程。在SLAM中,平台的轨迹和所有地标的位置都是在线估计的,不需要任何位置的先验知识。
准备工作
考虑移动机器人运动经过一个环境使用安装在机器人上面传感器对大量未知的路标进行相对观测,如图1所示。在时刻k,定义如下变量:
:描述机器人位置和姿态的状态向量。
:控制向量,被用于在k-1时刻驱动机器人到k时刻的状态向量
:描述第i个路标位置的向量,它们的真实位置假定为静止的。
:在k时刻机器人观测到的第i个路标的位置。当在任何时刻都有大量被观测到的路标或者当一个特定的路标和讨论的不相关时,观测量将被简化成
。
除此之外,还定义了如下集合:
:机器人位置的历史值。
:控制输入量的历史值。
:所有路标的集合。