专利汇可以提供面向大规模SLAM的多传感器融合与数据管理机制专利检索,专利查询,专利分析的服务。并且本 发明 公开了一种面向大规模SLAM的多 传感器 融合与数据管理机制。目的是面向大规模环境下,提升SLAM的 精度 、鲁棒性、数据存取效率。技术方案是:首先利用视觉、惯性测量单元、 里程计 等多种传感器信息融合的方法,形成优势互补,增强SLAM 框架 中的线性图优化环节;并提出一种数据管理机制,其能实现高效的数据存取机以 支撑 SLAM系统的实时性;基于上述多传感器信息融合策略与数据管理机制,采取集中式拓扑架构,由n个 机器人 节点 和一台 服务器 构成协同SLAM系统,有效应对未知的大规模环境下探索任务。,下面是面向大规模SLAM的多传感器融合与数据管理机制专利的具体信息内容。
1.面向大规模SLAM的多传感器融合与数据管理机制,其特征在于包括以下步骤:
第一步:每台机器人独立运行基于VINS-Mono改进的SLAM框架;
改进的具体步骤如下:
1.1测量处理前端,保留基于视觉的检测跟踪、IMU预积分,并新增里程计原始数据接收与缓存,增加三种传感器信息的数据对齐处理;
1.1.1接收图像,提取Harris角点,利用金字塔光流跟踪相邻帧,通过RANSAC去除异常点,进一步计算得到相机归一化平面下的特征点云,然后缓存特征点云数据;
1.1.2接收缓存IMU的数据,并进行预积分;
1.1.3接收缓存里程计数据;
1.1.4完成特征点云、IMU、里程计的数据对齐,保证相邻的特征点数据帧之间有完整的IMU数据,且每帧特征点数据帧能对应一条时间戳临近的里程计的数据,两者时间戳之差的绝对值不超过预先设定的阈值detal_t;
1.2非线性图优化,保留原有的视觉信息、IMU预积分信息,并新增里程计信息,通过三种信息联合优化求解滑窗内的状态;
1.2.1首先构建一个容量为m的滑动窗口,滑动窗口的每个单元保留原有的视觉信息、IMU预积分信息,并增加对一条步骤1.1.4所述的数据对齐的里程计信息;
1.2.2基于滑动窗口的第t-1、第t个单元中的里程计信息,计算机器人自滑窗内第t-1至第t单元对应的时间段的航偏角,记为odom_yaw,与滑窗中第t个单元的IMU预积分信息中的航偏角imu_yaw比较,若两者之差的绝对值在预先设定的阈值detal_yaw的范围内,则认为此时里程计没有打滑,数据可信度较高;
1.2.3对滑动窗口中的数据进行非线性优化,保留原有的IMU约束和视觉约束,新增里程计信息的约束,主要步骤为:遍历滑动窗口中的所有单元,计算其中相邻两个单元[t-1,t]内基于里程计信息计算的里程,记为odom_dist,其计算过程为odom_dist=[(xt-xt-1)2+(yt-yt-1)2]1/2,式中,xt和yt分别为滑动窗口中t单元中里程计记录的x轴方向位移、y方向位移,同理,xt-1和yt-1分别为滑动窗口中t-1单元中里程计记录的x轴方向位移、y方向位移,其中1≤t;
1.3闭环检测,改进后的具体步骤如下:
1.3.1以机器人SLAM建图起点为地图原点,构建边长为d的栅格地图;若将栅格的左下角点坐标记为(x0,y0),则该栅格包含的地图范围为{(x,y)|x0
1.3.2实时检测与机器人当前位置距离最近的栅格,确定栅格中心点,并从数据库中以栅格中心点index为检索条件,取回全部地图数据进行解码,实现数据的一级检索;
1.3.3在该栅格的地图数据中,通过对机器人当前位置坐标与历史关键帧坐标进行比对,找到与机器人当前位置最邻近的所有历史关键帧,并放入闭环检测关键帧比对库供其使用,实现数据的二级检索;
第二步:每台机器人关键帧数据管理模块,将抽样筛选过的关键帧或更新的位姿图发送给服务器;
第三步:服务器首先为每个VINS-Mono客户端建立一个带编号的关键帧数据队列,并将接收到的数据暂时统一存储在局部位姿数据缓冲池中;同时,服务器的检测线程开启工作,实时处理缓冲池中的关键帧数据,保证数据不在内存中冗余;
第四步:服务器端使用基于特征提取与特征匹配的方法,将每个客户端关键帧与基准客户端关键帧存储池逐一进行特征匹配,若检测到超过25个匹配点则进行关键帧位姿换算,并利用获得的坐标转换关系进行局部位姿图间的坐标融合,形成全局位姿图;
第五步:服务器初次计算得出的机器人间的位置转换关系会被存储记录,以便系统对整个机器人群体的位置掌握和行为调控;
第六步:随着客户端探索环境过程的继续,会不断产生新的位姿图或更新已有的位姿转换关系,因此客户端会不断更新在服务器中的局部位姿数据缓冲列表,并利用三维仿真器对全局位姿图进行实时更新显示。
标题 | 发布/更新时间 | 阅读量 |
---|---|---|
四足机器人在负载突变下基于ZMP理论的反应式鲁棒控制方法 | 2020-05-08 | 487 |
一种视觉机器人的地图表示系统及其构建方法 | 2020-05-17 | 697 |
一种用于多障碍环境的两轮自平衡车自主避障方法 | 2020-05-18 | 583 |
一种基于深度学习的2D+3D大飞机外形缺陷检测与分析方法 | 2020-05-08 | 965 |
一种应用配电网全域大数据的人工智能预测模型构方法 | 2020-05-13 | 788 |
一种半导体元器件缺陷检测方法和设备 | 2020-05-18 | 14 |
一种复杂异形曲面机器人三维测量的点云分割方法 | 2020-05-23 | 960 |
一种基于区块链实现的去中心化集群控制系统及工作方法 | 2020-05-23 | 6 |
一种线束自动包覆设备的控制方法 | 2020-05-17 | 849 |
一种无人驾驶交通导航信号设备和其管理系统 | 2020-05-12 | 420 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。