基于自然物体的单目自动驾驶导航方法、系统及装置与流程

文档序号:30172925发布日期:2022-05-26 11:03阅读:来源:国知局

技术特征:
1.一种基于自然物体的单目自动驾驶导航方法,其特征在于,包括以下步骤:在机器人移动过程中,机器人控制模块获取第一图像、第二图像及目标位置图像,其中,第一图像为第一时段运动到第一位置点的图像,第二图像为第二时段运动到的第二位置点的图像;以机器人成像胶片所在平面作为x轴,以目标位置方向作为y轴的正方向,建立空间轨迹直角坐标系;在所述空间轨迹直角坐标系内,通过第一图像得到机器人中心点到机器人成像中心的第一像素距离,通过第二图像得到机器人中心点到机器人成像中心的第二像素距离,通过第一图像和第二图像得到机器人中心点发生的移动位移;基于第一像素距离、第二像素距离及移动位移并结合预设差值模型得到实际距离差值,并将实际距离差值与预设距离差值进行对比;根据实际距离差值和预设距离差值的大小关系,机器人控制模块调整运动方向,控制机器人靠近或远离目标位置点的方向运动。2.根据权利要求1所述的基于自然物体的单目自动驾驶导航方法,其特征在于,所述基于第一像素距离、第二像素距离及移动位移并结合预设差值模型得到实际距离差值,包括以下步骤:基于第一像素距离及预设成像距离,结合预设角度计算模型得到机器人在第一时段机器人中心点与目标位置点的第一夹角;基于第二像素距离及预设成像距离,结合预设角度计算模型得到机器人在第二时段机器人中心点与目标位置点的第二夹角;基于第一夹角、第二夹角及移动位移并结合预设差值模型得到实际距离差值。3.根据权利要求1或2所述的基于自然物体的单目自动驾驶导航方法,其特征在于,所述预设差值模型表示为:其中,s=h1-h2,α1表示第一夹角,α2表示第二夹角,s表示移动位移,h1表示目标位置点到成像底片的垂直距离,h2表示目标位置点到第二时段下机器人中心在y轴的距离,h表示实际距离差值。4.根据权利要求3所述的基于自然物体的单目自动驾驶导航方法,其特征在于,所述预设角度计算模型为:其中,α表示夹角,d表示对边,l表示邻边;将第一像素距离设为d1,第二像素距离设为d2,预设成像距离设为l,则所述预设角度计算模型表示为:计算模型表示为:其中,α1表示第一夹角,α2表示第二夹角。
5.根据权利要求1所述的基于自然物体的单目自动驾驶导航方法,其特征在于,所述根据实际距离差值和预设距离差值的大小关系,机器人控制模块调整运动方向,控制机器人靠近或远离目标位置点的方向运动,包括以下步骤:若实际距离差值大于预设距离差值,机器人控制模块调整运动方向,控制机器人向目标位置点靠近且偏移;若实际距离差值小于预设距离差值,机器人控制模块调整运动方向,控制机器人远离目标位置点的方向运动;若实际距离差值等于预设距离差值,机器人控制模块则不调整运动方向。6.根据权利要求5所述的基于自然物体的单目自动驾驶导航方法,其特征在于,所述控制机器人向目标位置点靠近且偏移,包括以下步骤:基于实际距离差值h与预设距离差值h1,得到实际距离差值与预设距离差值的差值δh=h-h1>0;通过移动位移s和δh得到偏移夹角α3,α3=arctan(δh/s);基于偏移夹角α3和δh得到待调整转弯向角度β,β=f(α3,δh),其中f表示调整函数;按照待调整转弯向角度β向目标位置靠近。7.根据权利要求5所述的基于自然物体的单目自动驾驶导航方法,其特征在于,所述控制机器人远离目标位置点的方向运动,包括以下步骤:基于实际距离差值h与预设距离差值h1,得到实际距离差值与预设距离差值的差值δh=h-h1<0;通过移动位移s和δh得到偏移夹角α3,α3=arctan(δh/s);基于偏移夹角α3和δh得到待调整转弯向角度β,β=f(α3,δh),其中f表示调整函数;按照待调整转弯向角度β向目标位置远离。8.一种基于自然物体的单目自动驾驶导航系统,其特征在于,包括信息获取模块、坐标建立模块、第一计算模块、第二计算模块及方向调整模块;所述信息获取模块,用于在机器人移动过程中,机器人控制模块获取第一图像、第二图像及目标位置图像,其中,第一图像为第一时段运动到第一位置点的图像,第二图像为第二时段运动到的第二位置点的图像;所述坐标建立模块,用于以机器人成像胶片所在平面作为x轴,以目标位置方向作为y轴的正方向,建立空间轨迹直角坐标系;所述第一计算模块,用于在所述空间轨迹直角坐标系内,通过第一图像得到机器人中心点到机器人成像中心的第一像素距离,通过第二图像得到机器人中心点到机器人成像中心的第二像素距离,通过第一图像和第二图像得到机器人中心点发生的移动位移;所述第二计算模块,用于基于第一像素距离、第二像素距离及移动位移并结合预设差值模型得到实际距离差值,并将实际距离差值与预设距离差值进行对比;所述方向调整模块,用于根据实际距离差值和预设距离差值的大小关系,机器人控制模块调整运动方向,控制机器人靠近或远离目标位置点的方向运动。9.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至7任意一项所述的方法步骤。10.一种基于自然物体的单目自动驾驶导航装置,包括存储器、处理器以及存储在所述
存储器中并在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至7任意一项所述的方法步骤。

技术总结
本发明公开一种基于自然物体的单目自动驾驶导航方法、系统及装置,方法包括:在机器人移动过程中,机器人控制模块获取第一图像、第二图像及目标位置图像;建立空间轨迹直角坐标系;得到第一像素距离及第二像素距离,通过第一图像和第二图像得到机器人中心点发生的移动位移;结合预设差值模型得到实际距离差值,并将实际距离差值与预设距离差值进行对比;根据实际距离差值和预设距离差值的大小关系,机器人控制模块调整运动方向。本发明基于机器人的直线运动进行参考,进而建立空间轨迹直角坐标系,通过机器人视角判断机器人离目标位置的距离以及是否偏移目标距离;不需要依赖GPS等定位系统,能够直接使用,后续应用很方便,工作量大大的减小。量大大的减小。量大大的减小。


技术研发人员:万义良 陈先刚 万义才
受保护的技术使用者:苏州书农科技有限公司
技术研发日:2022.02.16
技术公布日:2022/5/25
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1