【技术实现步骤摘要】
基于局部地图匹配的轨迹推算方法、介质、终端和装置
本专利技术涉及导航定位领域,尤其涉及一种基于局部地图匹配的轨迹推算方法、介质、终端和装置。
技术介绍
随着电子硬件的进步以及处理器算力的提升,能够实时响应的移动机器人正逐步走进人类的日常生活中。其中,定位能力是机器人实现自主移动的关键。定位是机器人通过感知自身和周围环境信息,经过一定的数据融合处理计算自身位姿的过程。目前机器人定位一般分为相对定位与绝对定位。常用的绝对定位包括全球定位系统(GPS)、超声波定位系统等。由于机器人的工作区域通常是确定且有限的,因为一般不考虑机器人在地球中的位置,而只需考虑其在工作区域的绝对位置即可。常用的相对定位是指惯性导航或者里程计算法。惯性导航主要使用惯性测量单元(IMU)提供的三轴加速度、三轴陀螺仪或者三轴磁强计。在静止状态下,通过磁强计与加速度计获取自身方向姿态。在运动状态下,通过加速度计获取位置,通过陀螺仪校正姿态。里程计算法主要使用轮上编码器,运动状态下,根据主动轮上编码器的旋转脉冲计数来计算机器人的相对位姿,根据起始位姿可以累积出机器人在工作区域的当前绝对位姿。近年来,相对定位有了可观的进展。通过里程计算法得到机器人的位姿已经不限于轮上编码器的使用。不同于根据自身信息推算自身的位姿,根据环境信息,机器人一样可以推算出自身相对位姿信息。比如,利用相邻激光点云或者视觉图像的相对位移反推出机器人的相对位移。相邻点云或者图像的相对位移信息可以通过匹配计算得到。根据起始位姿,通过累积计算机器人同样可以得到自身在工作区域的绝对位 ...
【技术保护点】
1.一种基于局部地图匹配的轨迹推算方法,其特征在于,包括以下步骤:/n步骤1,将起始位置处获取的初始帧点云作为参考点云;/n步骤2,并将所述参考点云变换为栅格地图;/n步骤3,获取与参考点云相邻的第二帧点云,并作为当前点云;/n步骤4,对当前点云与参考点云进行匹配,生成当前点云相对于参考点云的第一相对位姿;/n步骤5,累积所述第一相对位姿生成第二帧点云的绝对位姿,并在第二帧点云的绝对位姿将所述第二帧点云添加到栅格地图;/n步骤6,获取与第二帧点云相邻的第三帧点云,对第三帧点云与第二帧点云进行匹配生成第三帧点云相对于第二帧点云的第二相对位姿,并在第二帧点云的绝对位姿将所述第三帧点云添加到当前栅格地图;/n步骤7,提取所述第二相对位姿的角度,并基于地图匹配算法和当前栅格地图生成第三帧点云的绝对位姿;/n步骤8,判断第三帧点云的绝对位姿与起始位置的距离是否大于预设距离,若否,则将第三帧点云更新为当前点云,且继续获取点云数据并重复步骤4-步骤8推算机器人轨迹;若是,则删除当前栅格地图,并将第三帧点云的绝对位姿作为起始位置,将第三帧点云作为参考点云,重复步骤2-步骤8,重新建立栅格地图并推算机器 ...
【技术特征摘要】
1.一种基于局部地图匹配的轨迹推算方法,其特征在于,包括以下步骤:
步骤1,将起始位置处获取的初始帧点云作为参考点云;
步骤2,并将所述参考点云变换为栅格地图;
步骤3,获取与参考点云相邻的第二帧点云,并作为当前点云;
步骤4,对当前点云与参考点云进行匹配,生成当前点云相对于参考点云的第一相对位姿;
步骤5,累积所述第一相对位姿生成第二帧点云的绝对位姿,并在第二帧点云的绝对位姿将所述第二帧点云添加到栅格地图;
步骤6,获取与第二帧点云相邻的第三帧点云,对第三帧点云与第二帧点云进行匹配生成第三帧点云相对于第二帧点云的第二相对位姿,并在第二帧点云的绝对位姿将所述第三帧点云添加到当前栅格地图;
步骤7,提取所述第二相对位姿的角度,并基于地图匹配算法和当前栅格地图生成第三帧点云的绝对位姿;
步骤8,判断第三帧点云的绝对位姿与起始位置的距离是否大于预设距离,若否,则将第三帧点云更新为当前点云,且继续获取点云数据并重复步骤4-步骤8推算机器人轨迹;若是,则删除当前栅格地图,并将第三帧点云的绝对位姿作为起始位置,将第三帧点云作为参考点云,重复步骤2-步骤8,重新建立栅格地图并推算机器人轨迹。
2.根据权利要求1所述的基于局部地图匹配的轨迹推算方法,其特征在于,采用迭代最近点算法ICP生成当前点云相对于参考点云的第一相对位姿以及第三帧点云相对于第二帧点云的第二相对位姿,所述迭代最近点算法ICP的迭代次数设定为2-5次,初始变换设定为(0,0,0)。
3.根据权利要求1或2所述的基于局部地图匹配的轨迹推算方法,其特征在于,所述预设距离为10-20米。
4.根据权利要求3所述的基于局部地图匹配的轨迹推算方法,其特征在于,采用轮式差分驱动模型累积所述第一相对位姿生成所述第二帧点云的绝对位姿。
5.一种计算机可读存储介质,其特征在于,存储有计算机程序,所述计算机程序被处理器执行时,实现权利要求1-4任一项所述的基于局部地图匹配的轨迹推算方法。
6.一种基于局部地图匹配的轨迹推算终端,其特征在于,包括权利要求5所述的计算机可读存储介质和处理器,所述处理器...
【专利技术属性】
技术研发人员:蔡龙生,李国飞,
申请(专利权)人:上海有个机器人有限公司,
类型:发明
国别省市:上海;31
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。