巡检机器人的多传感器校准方法及系统与流程
本发明涉及机器人智能巡检及多传感器协同感知,具体涉及巡检机器人的多传感器校准方法及系统。
背景技术:
1、变电站巡检机器人通常搭载激光雷达、视觉传感器等感知设备,用于对变电站内设备及运行环境进行自动巡检;为提高巡检效率和覆盖范围,现有系统通常采用多台巡检机器人协同作业,并对不同机器人采集的数据进行融合分析;由于各机器人搭载的传感器具有各自独立的坐标系,因此需要预先建立不同传感器之间的空间对应关系,以保证不同来源的点云数据能够转换至统一坐标系下进行处理。
2、现有多传感器校准方式通常在系统部署初期,将相关巡检机器人集中至预设标定区域,通过固定参照物完成传感器间的初始校准;然而,机器人在长期运行过程中会受到机械振动、温度变化、传感器拆装以及部件老化等因素影响,导致传感器安装姿态发生变化,使实际空间位姿逐渐偏离初始校准状态;由于这种偏移通常具有渐进性,在点云融合产生明显错位之前往往难以及时发现,从而影响多机器人协同感知结果的准确性;另一方面,多台巡检机器人在长期执行巡检任务时,其运行轨迹往往存在交叉、重合或邻近区域,不同机器人也可能在相近时间经过同一位置,这为不同传感器观测同一环境对象提供了条件;但是,现有巡检系统通常主要依据巡检路径和任务完成效率进行调度,缺乏对历史运行轨迹中机器人时空交汇规律的有效利用,也难以判断不同机器人在交汇时刻是否具有足够的共同观测区域;因此,正常巡检过程中大量潜在的交叉观测机会未能被用于传感器空间关系的验证;此外,当多个传感器能够观测同一物理实体时,不同传感器采集的点云数据能够反映其当前相对空间关系,但现有技术通常缺乏根据交叉观测数据持续判断传感器位姿是否发生偏移的机制;在传感器空间姿态发生变化后,若仍采用初始校准参数进行坐标转换,容易造成不同来源点云在统一坐标系下出现位置偏差。即使重新获得校准参数,受观测角度、点云匹配误差及环境变化等因素影响,同一物理实体在坐标转换后仍可能存在一定的几何不一致。
技术实现思路
1、本发明的目的在于提供巡检机器人的多传感器校准方法及系统,解决现有技术存在的问题。
2、为实现上述目的,本发明提供如下技术方案:巡检机器人的多传感器校准方法,包括:
3、s1、获取巡检任务中的多台巡检机器人的历史运行轨迹,通过对历史运行轨迹进行时空占据概率分析,并结合各巡检机器人的运动可达性筛选交汇位置,得到多台巡检机器人在同一时间段内到达同一空间位置的时空交汇节点;
4、s2、根据时空交汇节点,预测多台巡检机器人在交汇时刻的待校准传感器观测视野,获得多个待校准传感器观测视野之间的重叠观测区域;
5、s3、若重叠观测区域大于预设面积阈值,则触发交叉观测机制,获取多个待校准传感器在重叠观测区域内针对同一物理实体同步采集的第一点云数据;
6、s4、对第一点云数据进行特征提取与配准处理,得到第一点云数据之间的相对位姿变换矩阵;
7、s5、根据相对位姿变换矩阵与预先存储的初始校准矩阵进行差值计算,获得多个待校准传感器之间的位姿偏差数值;
8、s6、若位姿偏差数值超过预设偏差阈值,则判定多个待校准传感器发生空间姿态偏移,确定偏移捕获结果;
9、s7、根据偏移捕获结果,采用位姿偏差数值对初始校准矩阵进行逆向补偿计算,得到动态修正后的目标校准矩阵;
10、s8、获取目标校准矩阵,基于同一物理实体的几何一致性对目标校准矩阵的坐标转换结果进行约束修正,获得统一坐标系下的第二点云数据,并将对应的目标校准矩阵确定为多个待校准传感器的校准结果。
11、优选的,所述s1包括获取巡检任务中的多台巡检机器人的历史运行轨迹,根据历史运行轨迹获得时空占据概率;根据时空占据概率计算巡检机器人的运动可达范围;若运动可达范围存在空间交集,则将空间交集作为候选交汇位置;比对巡检机器人在候选交汇位置的到达状态,得到多台巡检机器人在同一时间段内到达同一空间位置的时空交汇节点。
12、优选的,所述s2包括根据时空交汇节点提取多台巡检机器人的初始位姿状态;根据初始位姿状态采用卡尔曼滤波算法预测多台巡检机器人的预测位姿状态;根据预测位姿状态计算全局坐标系位姿,并根据全局坐标系位姿生成待校准传感器观测视野;若待校准传感器观测视野相交,则对待校准传感器观测视野进行求交运算,获得多个待校准传感器观测视野之间的重叠观测区域。
13、优选的,所述s3包括若重叠观测区域大于预设面积阈值,则生成交叉观测触发指令;根据交叉观测触发指令获取原始点云集合;对原始点云集合进行时间对齐得到同步点云序列;根据同步点云序列的密度特征进行匹配,获取多个待校准传感器在重叠观测区域内针对同一物理实体同步采集的第一点云数据。
14、优选的,所述s4包括针对第一点云数据降采样获得稀疏点云序列;根据稀疏点云序列进行特征提取,得到显著特征子集,其中,对稀疏点云中的每一个点,以该点为中心构建邻域,根据邻域点在不同空间方向上的离散程度确定3个主方向,并依据邻域点沿各主方向的分布特征,将待分析点划分为边缘特征点、平面特征点或角点特征点,由边缘特征点、平面特征点或角点特征点组成显著特征子集;采用迭代最近点算法对显著特征子集进行匹配,得到对应点对集合;根据对应点对集合进行计算得到权重分配矩阵;通过权重分配矩阵进行分解处理,获得刚体变换估计结果;根据刚体变换估计结果得到第一点云数据之间的相对位姿变换矩阵。
15、优选的,所述s5包括根据相对位姿变换矩阵提取旋转平移向量,并获取初始校准矩阵;对旋转平移向量与初始校准矩阵进行维度匹配,得到目标变换矩阵与目标校准矩阵;对目标变换矩阵与目标校准矩阵进行差值计算,获得多个待校准传感器之间的位姿偏差数值。
16、优选的,所述s6包括若位姿偏差数值超过预设偏差阈值,则判定多个待校准传感器发生空间姿态偏移;根据空间姿态偏移进行映射处理得到目标网格节点,根据目标网格节点生成状态标识,由状态标识确定偏移捕获结果。
17、优选的,所述s7包括根据偏移捕获结果对位姿偏差数值进行拆解,得到旋转分量与平移向量,根据旋转分量与平移向量构建误差梯度矩阵;通过误差梯度矩阵确定补偿权重序列;若补偿权重序列大于预设阈值,则根据补偿权重序列对初始校准矩阵求逆,获得逆向补偿计算结果;根据逆向补偿计算结果得到动态修正后的目标校准矩阵。
18、优选的,所述s8包括获取目标校准矩阵,采用所述目标校准矩阵对多个待校准传感器采集的点云数据进行坐标转换,基于同一物理实体的几何一致性确定坐标转换结果的几何偏差,并根据所述几何偏差对目标校准矩阵进行约束修正,得到修正目标校准矩阵;采用所述修正目标校准矩阵进行坐标转换,获得统一坐标系下的第二点云数据,并将所述修正目标校准矩阵确定为多个待校准传感器的校准结果。
19、巡检机器人的多传感器校准系统,用于实现所述的巡检机器人的多传感器校准方法的步骤,所述系统包括:
20、节点确定模块,获取巡检任务中的多台巡检机器人的历史运行轨迹,通过对历史运行轨迹进行时空占据概率分析,并结合各巡检机器人的运动可达性筛选交汇位置,得到多台巡检机器人在同一时间段内到达同一空间位置的时空交汇节点;
21、重叠观测区域确定模块,根据时空交汇节点,采用卡尔曼滤波算法预测多台巡检机器人在交汇时刻的待校准传感器观测视野,获得多个待校准传感器观测视野之间的重叠观测区域;
22、交叉观测模块,若重叠观测区域大于预设面积阈值,则触发交叉观测机制,获取多个待校准传感器在重叠观测区域内针对同一物理实体同步采集的第一点云数据;
23、点云配准模块,通过迭代最近点算法对第一点云数据进行特征提取与配准处理,得到第一点云数据之间的相对位姿变换矩阵;
24、位姿偏差计算模块,根据相对位姿变换矩阵与预先存储的初始校准矩阵进行差值计算,获得多个待校准传感器之间的位姿偏差数值;
25、偏移捕获模块,如果位姿偏差数值超过预设偏差阈值,则判定多个待校准传感器发生空间姿态偏移,确定偏移捕获结果;
26、动态校准模块,根据偏移捕获结果,采用位姿偏差数值对初始校准矩阵进行逆向补偿计算,得到动态修正后的目标校准矩阵;
27、动态校准模块,获取目标校准矩阵,基于同一物理实体的几何一致性对目标校准矩阵的坐标转换结果进行约束修正,获得统一坐标系下的第二点云数据。
28、由上述技术方案可知,本发明具有如下有益效果:
29、该巡检机器人的多传感器校准方法及系统,通过对多台巡检机器人的历史运行轨迹进行时空占据概率分析并结合机器人运动可达性确定时空交汇节点,在不额外设置专用标定场景的情况下,能够从日常巡检过程中识别具有交叉观测条件的机器人交汇机会;进一步根据交汇节点预测待校准传感器的观测视野,并依据重叠观测区域触发针对同一物理实体的同步观测,使多台巡检机器人能够利用巡检过程中自然形成的共同观测数据进行传感器空间关系验证;通过对同步采集的点云数据进行配准并与初始校准矩阵进行比较,可以及时获得多个待校准传感器之间的位姿偏差,在偏差超过预设阈值时识别传感器空间姿态偏移,并根据位姿偏差对初始校准矩阵进行动态修正,从而降低机械振动、温度变化、传感器拆装及部件老化等因素造成的校准参数失效影响;同时,基于同一物理实体的几何一致性对坐标转换结果进行约束修正,有利于减小不同传感器点云在统一坐标系下的几何错位,提高多源点云数据的空间一致性和融合精度,由此能够在减少集中重新标定需求及对正常巡检任务干扰的同时,提高多巡检机器人长期协同作业过程中多传感器校准的及时性、稳定性和可靠性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com