CN118915076B 一种基于多波束声呐的水下同步定位与地图构建方法 (哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院))_第1页
CN118915076B 一种基于多波束声呐的水下同步定位与地图构建方法 (哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院))_第2页
CN118915076B 一种基于多波束声呐的水下同步定位与地图构建方法 (哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院))_第3页
CN118915076B 一种基于多波束声呐的水下同步定位与地图构建方法 (哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院))_第4页
CN118915076B 一种基于多波束声呐的水下同步定位与地图构建方法 (哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院))_第5页
已阅读5页,还剩50页未读 继续免费阅读

下载本文档

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

文档简介

一种基于多波束声呐的水下同步定位与地公开了一种基于多波束声呐的水下同步定位与2采用基于恒虚警率CFAR的检测技术,通过使用滑动窗口的形式确定使用Dbscan算法进行聚类,用于在给定数据集中发现高密度的区保留点云数目大于Ptsthreshold的在生成高斯块后,建立一个描述一张图片的高斯信息和邻接首先,搭建仿真环境进行模拟实验室的水池环境和机器人环境验证上述所提出的算2.根据权利要求1所述的一种基于多波束声呐的水下同步定位与地图构建方法,其特3.根据权利要求2所述的一种基于多波束声呐的水下同步定位与地图构建方法,其特4.根据权利要求3所述的一种基于多波束声呐的水下同步定位与地图构建方法,其特345回环检测获得非顺序因子加入到后端进行优化;同时为了解决ICP求解过程中陷入局部最67[0065]图29是本发明SLAM预测轨迹和现有BruceSLAM算法及动T8坐标系的原点设置与机器人的原点一致,记声呐坐标系的原点为O,其三个轴方向定义如9其划分为不同的簇,能够有效处理噪声点和密度不均匀的数据和不受初始化参数的影响,[0167]如图8所示是不同的Rmax对图密集程度的影响情况,第一列为体素滤波后的源点[0173]最终,将获取得到的descriptor1,descriptor2,...,descriptorm存储到[0175]基于步骤S23获得descriptors1和descriptors2前后两张图的描述子后,提出一种算法对两个描述子进行配准,简称GP(GraphMatching)算法,如图12所示。在遍历[0176]S241、首先使用相似度算法计算两个顶点的描述子descriptori和de相似度,获取得分score,通过公式(21)、(22)计算,其中m,n分别为descriptori和diff为给定参数角度阈值,参数随着机器人的运动速度来调整,以和航迹推算那边的关键帧距离生成条件保持一致,[0202]第二项描述了在给定的现有点云或地图Pt的情况下xt处观察到点云Ps的概率,如[0209]本发明提出一种基于图匹配建立描述子后计算描述子相似度寻找匹配点的GP算法,之后使用ICP优化获得初始的预测变换矩阵T0。定位为优化后的位姿,此时即此时长直线特征末端一般会出现一些高亮的回波点,而使用Akaze(Accelerated_KAZE)算[0224]通过GP算法提取匹配点,Akaze算法提取匹配点两套系统分别并行计算前后两帧z。中,两个连续姿态xk-1和xk之间的顺序因子可以用过在这两个时刻收集到的两个点云进行[0249]因子图其核心思想是通过根据里程计和不同传感器的测量信息对机器人和周围通过对比三者的轨迹误差,可以见到本发明GPSLAM预测轨迹与真实轨迹的平均误差mean回环检测获得非顺序因子加入到后端进行优化;同时为了解决ICP求解过程中陷入局部最[0291]最后应说明的是:以上实施例仅用以说明本发明的技术

温馨提示

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

评论

0/150

提交评论