一种移动设备的分级定位方法、装置及移动设备与流程

摘要: 本发明涉及移动机器人定位与导航,具体涉及一种移动设备的分级定位方法、装置及移动设备。背景技术:1、目前,在工业自动化及移动机器人领域,移动设备通常采用激光sla...
一种移动设备的分级定位方法、装置及移动设备与流程

本发明涉及移动机器人定位与导航,具体涉及一种移动设备的分级定位方法、装置及移动设备。

背景技术:

1、目前,在工业自动化及移动机器人领域,移动设备通常采用激光slam等全局定位技术进行自主导航,以满足长距离行驶的路径规划需求。然而,在实际生产作业中,移动设备不仅需要在全局范围内保持稳定的位置估计,还需在与外部协同设备进行物料交接或精密对接时达到极高的定位精度。现有的全局定位技术在长期运行过程中容易因环境变化、传感器噪声等因素产生累积漂移误差,导致定位精度逐渐下降;而单纯依赖高精度的局部定位手段虽然能够满足对接精度要求,但其耗时较长,若仅在到达目标点后被动触发,会显著增加整体作业节拍,影响生产效率。此外,当作业环境发生突变或移动设备因安全策略急停后,全局定位系统的置信度往往难以快速恢复,进一步加剧了定位失效的风险。因此,急需一种能够在不牺牲整体作业节拍的前提下,有效抑制全局定位长期漂移并提升复杂环境下定位鲁棒性的分级定位方案。

技术实现思路

1、针对现有技术存在的移动设备全局定位累积漂移与高精度对接作业节拍难以兼顾的问题,本发明通过一种移动设备的分级定位方法、装置及移动设备,实现全局粗定位与局部精定位的闭环协同与自适应调节。

2、为实现上述目的,本发明采用如下技术方案:

3、一种移动设备的分级定位方法,分级定位包括全局粗定位和局部精定位,包括:基于第一传感器数据,确定所述移动设备在全局坐标系中的全局粗定位数据;响应于所述移动设备接近目标区域,基于外部协同设备的交互时序信号触发局部精定位模块,以获取所述移动设备相对于预设标志物的局部精定位数据;基于所述局部精定位数据对所述全局粗定位数据进行在线补偿,以更新所述全局粗定位数据;基于更新后的所述全局粗定位数据的实时置信度,自适应调节所述局部精定位模块的触发频率,以保障所述移动设备的分级定位精度。

4、通过构建全局粗定位与局部精定位的分级架构,利用外部协同设备的交互时序信号预测性触发精定位,并将精定位结果反馈补偿粗定位误差,同时根据置信度动态调整触发策略,实现了在不增加额外硬件成本和不牺牲整体作业节拍的前提下,有效抑制全局定位的长期漂移并提升系统在复杂环境和异常工况下的定位鲁棒性与对接精度。

5、可选的,所述基于外部协同设备的交互时序信号触发局部精定位模块,包括:获取所述外部协同设备发送的准备状态信号;在所述移动设备到达所述目标区域前的预设距离处,响应于所述准备状态信号触发所述局部精定位模块,以使获取所述局部精定位数据与执行所述外部协同设备基于所述准备状态信号触发的准备动作并行。

6、通过将局部精定位的触发时机前置于移动设备到达目标区域之前,并利用外部协同设备的准备动作时间窗口并行执行精定位读取过程,巧妙地将精定位耗时隐藏于设备交互的时序空隙中,从而在保证亚毫米级对接精度的同时,避免了因等待精定位完成而造成的整体作业节拍损失,显著提升了生产线的流转效率。

7、可选的,所述准备状态信号包括提前叫料信号或安全门打开信号中的至少一种;所述预设距离基于所述移动设备的当前移动速度和所述局部精定位模块的预估读取耗时动态计算,所述预设距离满足所述移动设备以所述当前移动速度行驶至所述目标区域的时间大于或等于所述预估读取耗时。

8、可选的,所述基于所述局部精定位数据对所述全局粗定位数据进行在线补偿,以更新所述全局粗定位数据,包括:计算所述局部精定位数据指示的绝对位置与所述全局粗定位数据指示的估计位置之间的位置偏差;基于所述位置偏差补偿所述全局粗定位数据的累积漂移误差;基于所述位置偏差更新全局粗定位地图中对应区域的特征匹配权重。

9、通过将高精度的绝对位置数据作为观测值反向注入全局粗定位系统,不仅实时消除了累积漂移误差,还通过更新特征匹配权重增强了地图中关键区域的定位稳定性,构建了“精定位反哺粗定位”的闭环校正机制,确保了移动设备在长期连续运行中全局定位质量的持续可靠。

10、可选的,所述基于所述位置偏差补偿所述全局粗定位数据的累积漂移误差,包括:将所述位置偏差作为观测值输入至扩展卡尔曼滤波器或图优化模型中,通过状态估计更新所述移动设备的位姿状态;其中,所述扩展卡尔曼滤波器的状态向量包括所述移动设备在全局坐标系中的位置坐标、姿态角和速度分量,所述位置偏差作为观测量通过观测方程与状态预测值之间的残差最小化来修正所述位姿状态;所述基于所述位置偏差更新全局粗定位地图中对应区域的特征匹配权重,包括:在所述全局粗定位地图中,调整所述对应区域内的环境特征在后续位姿匹配过程中的置信度权重,其中,所述置信度权重的调整量与所述位置偏差的绝对值负相关。

11、可选的,所述基于更新后的所述全局粗定位数据的实时置信度,自适应调节所述局部精定位模块的触发频率,以保障所述移动设备的分级定位精度,包括:实时评估所述全局粗定位数据的实时置信度,得到置信度指标;当所述置信度指标低于预设置信度阈值时,提高所述局部精定位模块的触发频率;当所述置信度指标大于或等于所述预设置信度阈值时,降低或维持所述局部精定位模块的触发频率。

12、可选的,所述方法还包括:当检测到安全策略触发导致所述移动设备停止运行,或检测到人工介入操作时,在安全状态解除后,强制将所述全局粗定位数据的所述置信度指标重置为零;在所述移动设备下一次移动时,提高所述局部精定位模块的触发频率,直至重新获取满足预设精度要求的所述局部精定位数据;其中,所述预设精度要求为所述局部精定位数据的位置精度达到预设精度阈值,且所述全局粗定位数据的所述置信度指标恢复至大于或等于所述预设置信度阈值。

13、可选的,所述方法还包括:在基于所述局部精定位数据完成所述在线补偿后,触发所述移动设备内部的机械微调机构进行二次位姿微调;联动设置于所述移动设备末端的视觉系统对目标对象进行视觉补偿,以形成多级精度传递闭环;其中,所述视觉补偿包括:通过所述视觉系统对所述目标对象进行拍照识别,得到所述目标对象的实际位置与所述移动设备的当前位姿之间的视觉偏差,并基于所述视觉偏差执行末端位姿补偿。

14、此外,本发明还提供了一种移动设备的分级定位装置,包括:全局粗定位模块,用于基于第一传感器数据,确定所述移动设备在全局坐标系中的全局粗定位数据;预测性触发模块,用于响应于所述移动设备接近目标区域,基于外部协同设备的交互时序信号触发局部精定位模块,以获取所述移动设备相对于预设标志物的局部精定位数据;反馈校正模块,用于基于所述局部精定位数据对所述全局粗定位数据进行在线补偿,以更新所述全局粗定位数据;自适应调节模块,用于基于更新后的所述全局粗定位数据的实时置信度,自适应调节所述局部精定位模块的触发频率,以保障所述移动设备的分级定位精度。

15、此外,本发明还提供了一种移动设备,包括:车体;第一传感器组件,设置于所述车体;局部精定位传感器组件,设置于所述车体;处理器,与所述第一传感器组件和所述局部精定位传感器组件通信连接,所述处理器被配置为执行如上述方案所述的分级定位方法。

16、有益效果:

17、本发明通过基于第一传感器数据确定全局粗定位数据,并在接近目标区域时基于外部协同设备的交互时序信号预测性触发局部精定位模块获取绝对位置数据,进而将该局部精定位数据反馈至全局粗定位系统进行在线补偿以更新全局粗定位数据,同时基于更新后的全局粗定位数据的实时置信度自适应调节局部精定位模块的触发频率以保障分级定位精度。该技术方案利用分级定位架构与闭环反馈机制,将局部高精度绝对位置信息作为校正源实时消除全局粗定位的累积漂移误差,并通过预测性触发策略将精定位耗时并行隐藏于外部设备的准备时序中,解决了全局定位长期漂移与高精度对接作业节拍相互制约的问题,在不增加硬件成本和不牺牲整体作业效率的前提下,显著提升了移动设备在复杂动态环境及异常工况下的定位鲁棒性与对接精度。