CN114646937B 一种slam与uwb的实时融合与建图方法 (北京理工大学重庆创新中心)_第1页
CN114646937B 一种slam与uwb的实时融合与建图方法 (北京理工大学重庆创新中心)_第2页
CN114646937B 一种slam与uwb的实时融合与建图方法 (北京理工大学重庆创新中心)_第3页
CN114646937B 一种slam与uwb的实时融合与建图方法 (北京理工大学重庆创新中心)_第4页
CN114646937B 一种slam与uwb的实时融合与建图方法 (北京理工大学重庆创新中心)_第5页
已阅读5页,还剩17页未读 继续免费阅读

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

本发明公开了一种SLAM与UWB的实时融合与体当前时刻的位姿估计以及各超宽带节点的位3输出的当前时刻的智能体的位姿估计以及各超宽带节点的位置作为步骤2的输入。本发明将LiDAR传感器与UWB传感器融合在一起,融合UWB和LiDAR以提高基于UWB的定位和映射的准确性2步骤3、基于高斯-牛顿方法求取当前时刻所述智能体根据步骤1输出的所述智能体和各超宽带节点的定位信息构建动采用扩展卡尔曼滤波算法对所述动态观测模型进行更新,得到更新的利用基于高斯-牛顿方法的扫描匹配过程,将当前时刻观测到的光束端点与当前时刻所述扫描匹配过程在一个多分辨率网格中进行,从低分辨率的网格超宽带节点建立的局部框架下构建和更新激光雷3[0001]本发明涉及机器人定位与导航技术领域,特别是一种SLAM与UWB的实时融合与建[0002]SLAM(Simulaneouslocalizaionandmapping)已在移动机器人领域中有着广泛[0003]在基于LiDAR的SLAM中可以使用UWB传感器融合的方法消除累积误差并增强鲁棒性。但是UWB的距离分辨率低于LiDAR(激光测距误差约为1cm,约为UWB测距误差的十分之4在以两个设定的超宽带节点建立的局部框架下构建和更WideBand)传感器融合在一起,融合UWB和LiDAR以提高基于UWB的定位和映射的准确性和S3输出的当前时刻的智能体的位姿估计以及各超宽带节点的5[0037]智能体进入未知区域后,抛投位置已知的超宽带节点和以两个设定的超宽带节点建立的局部框架下构建和更[0046]NLOS(NonLineofSight)传播对于高分辨率定位系统影响很大,因为在距离测于EKF(ExtendedKalmanFilter)的UWB测距可以获得机器人以及锚点的位姿和速度估计,[0049]本实施例以9个超宽带节点为例,其包括4个位置已知的超宽带节点和5个位置未6[0051]在本实例中应用提供的基于SLAM与UWB的实时融合与建图方法,通过分布式定位p327[0077]其中矩阵D表示A的对角线构成的矩阵,-L和-U分别表示矩阵A的严格下三角矩阵[0078]K*1=N⃞+b,k=0,1,.[0080]*4=D-1(L+U)⃞+D-1b89[0126]栅格地图每个栅格都用0-1表示障碍物占据的概率。利用双线性插值法计算占用i,j=

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论