一种多模态传感的定位引导方法

技术领域

本发明涉多模态传感技术领域，尤其涉及一种多模态传感的定位引导方法。

背景技术

精准定位传感器等技术发展，推动智能行走作业装备广泛应用于农业、园林等室内/室外多环境全场景。

传统单一的传感器难以满足室内外混杂的机器人多环境全场景的自主行走的定位需求，北斗、IMU、视觉、激光雷达、UWB等多模融合成为自主导航定位的主要模式和重点方向。机器人或智能作业装备携带了多种传感器，依据不同的环境选择不同的传感器和定位数据，多环境作业的定位模式和算法无缝切换是自主导航定位的关键，现有融合算法对定位模式跳转切换自适应切换能力不足。

应用于机器人的多个传感器分别对环境进行感应，分别形成多个三维坐标系，由于设备与环境的缘故，将导致同一个物体对于不同坐标系的位置度相差偏差，这对智能行走作业装备在工作时，无法准确确认哪个坐标系为真实的坐标系，在作业过程中，可能出现明显的偏差。

因此，有必要提供一种多模态传感的定位引导方法来解决上述问题。

发明内容

为了解决上述问题，本发明的目的在于提供一种多模态传感的定位引导方法，以提高智能装备运行的准确度。

为了实现上述目的，本发明采用了如下技术方案：一种多模态传感的定位引导方法，包括如下步骤：多模态传感分别对目标确认，并分别形成相对不同坐标系中的不同特征，多个相机分别对目标进行拍照，各相机所拍摄的目标形成相互重叠的图像；该重叠的图像分别在不同相机的预定坐标系中形成不同的坐标区域；在同一组照片中，获得图像偏差与预设偏差，根据图像的偏差确认目标实际位置与预设位置的偏差；分别对获取的同一相机获得图像多个偏差值进行加权平均，获取多个重叠的图像实际的位置与角度的偏差值；将不同相机的坐标系映射至同一个映射坐标系中，在映射坐标系中，获取值得到最终定位的补偿量，其补偿量为各个映射坐标系中偏差总和。当多模态传感中相机传感信号量大于激光雷达传感信号量，采用S5中补偿量进行修正。

所述相机随设备前行，多个相机分别连续拍照，连续拍照之间预设间隔一段时间，同一时间拍的照片形成一组，多次拍照后形成的照片后形成多组照片。

综上所述，由于采用了上述技术方案，本发明的有益效果是：本发明通过多个相机传感，并对相机获得位置进行补偿，更加精准的确认位置的位置与偏转角度，从而使得激光雷达传感信号不强时，同样能保证位置更加精准。

附图说明

图1为本发明一种多模态传感的定位引导方法的流程示意图；

具体实施方式

下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范围。

参照图1所示，为本发明的多模态传感的定位引导方法的流程示意图。

本发明为一种多模态传感的定位引导方法，其利用多个不同模态的传感器对智能设备进行定位行走，保证定位精准度。

多模态传感的定位引导方法，包括如下步骤：

S1、多模态传感分别对目标确认，并分别形成相对不同坐标系中的不同特征，确认目标的实际位置的距离与角度；

本发明中，设备上安装惯性传感器、激光雷达、多个相机以及北斗导航四种环境感知传感器，由于各个模态中分别建立多个实际坐标系，该信息包括的位置、图像进行，通过上述的多模态传感方式对目标位置进行分析，并确认在各自坐标系中相对位置。同一目标相对不同坐标系中形成不同的位置。

S2、多个相机分别对目标进行拍照，各相机所拍摄的目标形成相互重叠的图像；

相机随设备前行，多个相机分别连续拍照，连续拍照之间通过人为预设间隔一段时间，但均为对同一目标拍照，同一时间拍的照片形成一组，多次拍照后形成的照片后形成多组照片；

S3、该重叠的图像分别在不同相机的预定坐标系中形成不同的坐标区域；在同一组照片中，获得图像偏差与预设偏差，根据图像的偏差确认目标实际位置与预设位置的偏差；

其偏差包括距离与角度的偏差值。

S4、分别对获取的同一相机获得图像多个偏差值进行加权平均，获取多个重叠的图像实际的位置与角度的偏差值；

例如：相机1获得偏差值为D1i；相机2获得的偏差值为D2i；相机3获得的偏差值为D3i；分别对D1i、D2i、D3i加权平均，形成⊿D1、⊿D2、⊿D3；随着相机不断的前行与运动，获得的偏差值在改变，加权平均值也不断在变化。

S5、将不同相机的坐标系映射至同一个映射坐标系中，在映射坐标系中，获取值得到最终定位的补偿量，其补偿量为各个映射坐标系中偏差总和。

S6、当多模态传感中相机传感信号量大于激光雷达传感信号量，采用上述补偿量进行修正。

本发明通过多个相机传感，并对相机获得位置进行补偿，更加精准的确认位置的位置与偏转角度，从而使得激光雷达传感信号不强时，同样能保证位置更加精准。

以上所述，仅为本发明较佳的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，根据本发明的技术方案及其发明构思加以等同替换或改变，都应涵盖在本发明的保护范围之内。