CN113733091B - 一种移动机器人室外高精度自主导航*** - Google Patents
一种移动机器人室外高精度自主导航*** Download PDFInfo
- Publication number
- CN113733091B CN113733091B CN202111088955.3A CN202111088955A CN113733091B CN 113733091 B CN113733091 B CN 113733091B CN 202111088955 A CN202111088955 A CN 202111088955A CN 113733091 B CN113733091 B CN 113733091B
- Authority
- CN
- China
- Prior art keywords
- robot
- image
- coordinate
- moving
- direct
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1661—Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种移动机器人室外高精度自主导航***,包括机械***和软件***;其机械***由3D扫描仪通过扫描和三维重现获取室外场景信息和室外物体信息;由视觉里程计通过图像信息处理获得移动机器人位移信息;由服务器在3D扫描仪和GPS定位设备之间收发指令和数据;由处理器对3D扫描仪和视觉里程计所述获取的图像进行格式转换以及分辨率调整;由运算模块对移动机器人在移动过程中所耗费的代价进行计算;其软件***包括机器人操作***ROS;本发明通过最优路径规划确定当前目标地点,并将机器人由当前所在地点向当前目标地点移动,循环执行直至机器人到达最终目标地点实现自主导航;本发明获取环境信息精准、自主运动过程稳定,成本低,优化效果显著。
Description
技术领域
本发明属于移动机器人自主导航领域,更具体地说涉及到一种适用于户外非结构化环境下的移动机器人高精度自主导航***。
背景技术
自主导航主要包括局部导航和全局导航两部分,为建立可靠的自主导航***,机器人需要一边对自身进行定位,一边根据传感器获取的周边环境信息构建局部地图,并完成全局路径的规划。目前虽然已经存在多种适用于室内外的移动机器人,但大多室内环境下的移动机器人采用的是红外传感器或依靠磁条导航等复杂且精度相对较低的设备,导致导航效果欠佳;还有部分室内环境下的移动机器人采用视觉或激光雷达传感器,其导航***中用来进行探测环境的装置也存在不足,例如:单目视觉传感器组成的探测装置无法精确获得物体的深度信息;双激光雷达传感器组成的探测装置仅能获取空间中两个平面内的障碍物信息,而无法获取周围障碍物的信息等,这导致机器人的导航精度受到影响;此外,利用惯性导航技术的室内机器人虽然可以通过测量加速度后积分得出相应的速度及位移,从而引导室内机器人朝特定方向前进,但是积分累积的误差会随时间而增加。
随着机器人应用场景的广泛,面对未知的环境、无法预测各种可能出现的障碍的非结构化的室外环境下,例如:移动机器人在火星、森林、沙漠等环境下工作时依靠传感器获取的数据不完整且难以处理;标准迭代最近点算法在迭代搜索最近点时只考虑几何信息,在动态环境和非结构化环境下,ICP无法单独实现精确的点云注册性能。
发明内容
本发明是为避免上述现有技术所存在的不足,提供一种移动机器人室外高精度自主导航***,实现移动机器人在室外环境下高精度自主导航,保证机器人获取环境信息更为精准、机器人自主运动过程的更加稳定,且实现成本低廉,优化效果明显。
本发明为解决技术问题采用如下技术方案:
本发明移动机器人室外高精度自主导航***的特点是其包括机械***和软件***;
所述机械***包括GPS定位设备、3D扫描仪、视觉里程计、服务器、处理器和运算模块;在所述机械***中:由所述3D扫描仪通过扫描和三维重现获取室外场景信息和室外物体信息;由所述视觉里程计通过图像信息处理获得移动机器人位移信息;由所述服务器在3D扫描仪和GPS定位设备之间收发指令和数据;由所述处理器对3D扫描仪和视觉里程计所述获取的图像进行格式转换以及分辨率调整;由所述运算模块对移动机器人在移动过程中所耗费的代价进行计算;所述软件***包括机器人操作***ROS;
将机器人开始移动之前的初始地点坐标记为坐标O,将所述初始地点坐标O存入在服务器中的close_list集合中;针对移动中的机器人,按如下步骤进行最优路径规划:
步骤1、利用所述GPS定位设备获得与机器人当前所在地点相邻且可直达的N个直达地点n的坐标集合A,n=1,2,......N;将所述坐标集合A存入在服务器中的open_list集合中,将机器人当前所在地点坐标记为坐标B存入在服务器中的close_list集合中;
步骤2、针对服务器中存储的坐标B和坐标集合A,由所述运算模块一一对应计算获得机器人由坐标B移动到坐标集合A中的各直达地点n所需付出的代价Fn,从N个代价Fn中筛选出最低代价Fmin;
步骤3、若对应于最低代价Fmin的直达地点的数量为1,即对应于最低代价Fmin的直达地点为唯一直达地点,则将所述唯一直达地点作为当前目标地点W,并进入步骤7;否则进入步骤4;
步骤4、对应于最低代价Fmin的直达地点的数量多于1,即对应于最低代价Fmin的直达地点并非为唯一直达地点,按如下方式确定当前目标地点W:将对应于最低代价Fmin的M个直达地点记为Wj,j=1,2...,M;所述运算模块通过计算分别获得机器人从初始地点坐标O移动到各直达地点Wj所付出的各代价Gj,从M个代价Gj中筛选出最低代价Gmin;
步骤5、若对应于最低代价Gmin的直达地点的数量为1,即对应于最低代价Gmin的直达地点为唯一直达地点,则将所述唯一直达地点作为当前目标地点W,并进入步骤7;否则进入步骤6;
步骤6、若对应于最低代价Gmin的直达地点的数量多于1,即对应于最低代价Fmin的直达地点并非为唯一直达地点,则在对应于最低代价Gmin的各直达地点中任选其一作为当前目标地点W,并进入步骤7;
步骤7、机器人由当前地点向当前目标地点W移动,在机器人到达当前目标地点W时即完成当前一步移动;随后,将当前目标地点W的坐标作为机器人下一步移动的当前所在地点的坐标,返回步骤1继续下一步移动,直至机器人到达最终的目标地点,结束路径规划。
本发明移动机器人室外高精度自主导航***的特点也在于所述可直达地点是按如下方式进行确定:设定机器人移动步距U,且将与机器人相距为U的地点视作相邻且可直达地点。
本发明移动机器人室外高精度自主导航***的特点也在于所述机器人移动步距U是按如下方式获得:利用视觉里程计将由3D扫描仪扫描获得、并保存在服务器中的关于室外场景的三维图像利用处理器转化为二维图像,以所述二维图像的重心为原点建立二维直角坐标系XOY,针对在T时段内的图像变换计算获得机器人在T时段内的的移动距离作为移动步距U。
本发明移动机器人室外高精度自主导航***的特点也在于:所述图像变换为图像发生缩放变换,针对图像发生缩放变换按如下方式计算获得机器人移动步距U:
将图像在二维直角坐标系中的坐标点记为Pi[xp,yp],图像发生缩放变换发生在机器人移动的(ti,tj)时段内,利用测量设备获得图像发生移动的速率v1,则图像在单位时段内发生的位位移S由式(5-1)计算获得:
在单位时段内,由于机器人移动使得由机器人测量设备观测到的图像发生缩放变换,在发生缩放变换后的图像中,坐标点Pi[xp,yp]对应变换为坐标点Pi‘[xp',yp'],根据相似定理,坐标点Pi[xp,yp]在单位时段发生缩放变换的倍数λ由式(5-2)计算获得:
式(5-2)中:
xp'和yp'为坐标点Pi‘[xp',yp']的坐标值;xp和yp为坐标点Pi[xp,yp]的坐标值;
机器人在单位时段内的位移量L如式(5-3)所示:
则,由式(5-4)计算获得机器人移动步距U:
移动步距U是机器人在(ti,tj)的时间段内发生的位移量,(ti,tj)时间段是由有限个单位时段所组成。
本发明移动机器人室外高精度自主导航***的特点也在于:所述图像变换为图像发生平移变换,针对图像发生平移变换按如下方式计算机器人移动步距U:图像发生平移变换发生在机器人移动的单位时段内,利用测量设备测得图像发生移动的速率v1,则图像在单位时段内发生的位移S由式(5-5)计算获得:
机器人在单位时段内的位移量L如式(5-6)所示:
L=υS (5-6)
式(5-6)中:
υ是在单位时段内图像平移的距离与机器人位移量的比值,υ≠0,1;
则,由式(5-7)计算获得机器人移动步距U:
移动步距U是机器人在(ti,tj)的时间段内发生的位移量,(ti,tj)时间段是由有限个单位时段所组成。
本发明移动机器人室外高精度自主导航***的特点也在于:机器人由当前所在地点移动到当前目标地点所付出的代价F为:
式(6-1)中:以γ表示路面影响因子,以e表示不同类型路面;以γe表示各不同类型路面的路面影响因子,共有四种不同类型的路面分别以e=I、e=II、e=III和e=IV进行表征。
本发明移动机器人室外高精度自主导航***的特点也在于:处于室外环境中的机器人的运动状态受到路面粗糙度C和路面坡度D的影响;并有:
式(7-1)中:θ为路面与水平面所成的倾角;H为机器人移动的水平位移,由视觉里程计测量得出;Z为变坡点相对于水平面的高度;路面影响因子γ由式(7-2)计算获得:
式(7-2)中:系数k是表征机器人在运动时受到外界影响导致自身产生晃动的剧烈程度的物理量;路面粗糙度C随不同类型路面所有不同,根据土层等效剪切波速和场地覆盖层厚度将路面划分为如下四种类型:
I类:指近海海面和海岛、海岸、湖岸及沙漠地区;
II类:指田野、乡村、丛林、丘陵以及房屋稀疏的乡镇和城市郊区;
III类:指有密集建筑群的城市市区;
IV类:指有密集建筑群且房屋较高的城市市区。
与已有技术相比,本发明有益效果体现在:
1、本发明利用3D扫描仪获取外部环境信息,通过最优路径规划实现移动机器人在室外环境下进行高精度自主导航,可以保证机器人获取环境信息更为精准、机器人自主运动过程的更加稳定,且实现成本低廉,优化效果明显。
2、本发明可以为室外环境下的服务型机器人、引导机器人等不同类型的机器人实现相似的功能提供参考。
附图说明
图1是本发明***构成框图;
图2是本发明中路径规划算法流程图;
具体实施方式
本发明移动机器人室外高精度自主导航***包括机械***和软件***。
参见图1,本实施例中机械***包括GPS定位设备、3D扫描仪、视觉里程计、服务器和处理器,并设置运算模块;在机械***中:由3D扫描仪通过扫描和三维重现获取室外场景信息和室外物体信息;由视觉里程计通过图像信息处理获得移动机器人位移信息;由服务器在3D扫描仪和GPS定位设备之间收发指令和数据;由处理器对3D扫描仪和视觉里程计获取的图像进行格式转换以及分辨率调整;由运算模块对移动机器人在移动过程中所耗费的代价进行计算。
如图1所示还包括建图与导航模块,机器人首先通过GPS模块获取全局地图信息后保存至服务器,通过全局地图信息得知目标地点的具***置后由初始地点向目标地点移动。在移动过程中,机器人依靠自身所携带的3D扫描仪获取周围的环境信息从而判断自己在全局地图中所处的具***置,并依据利用3D扫描仪获取的环境信息以及自身的位置信息不断地更新局部地图信息,从而有效地进行路径规划以付出最小的代价到达目标地点。
本实施例中,软件***包括机器人操作***ROS,将机器人开始移动之前的初始地点坐标记为坐标O,对于坐标O,首先,机器人利用携带的GPS定位设备接收卫星发出的导航定位信号,GPS定位设备是内置了GPS模块和移动通信模块的终端;其次,由GPS定位设备中内置的GPS模块将接收到的导航定位信号转化为计算机可识别并处理的数据后获取到机器人当前所在地的经纬度;最后GPS定位设备将通过移动通信模块将机器人当前地点所对应的经纬度上传至服务器,由服务器将经纬度信息解析成具体的三维坐标后再将坐标O存入close_list集合中;针对移动中的机器人,如图2所示流程,按如下步骤进行最优路径规划:
步骤1、机器人利用GPS定位设备与卫星群进行通讯,接受卫星群发送的位置、时间数据所组成的信号,基于数据计算并获得与机器人当前所在地点相邻且可直达的N个直达地点n的坐标集合,记为坐标集合A,n=1,2,……N;将坐标集合A存入在服务器中的open_list集合中,将机器人当前所在地点坐标记为坐标B,并将当前所在地点坐标B存入服务器中的close_list集合中。
步骤2、针对服务器中存储的坐标B和坐标集合A,由运算模块一一对应计算获得机器人由坐标B移动到坐标集合A中的各直达地点n所需付出的代价Fn,从N个代价Fn中筛选出最低代价Fmin。
步骤3、若对应于最低代价Fmin的直达地点的数量为1,即对应于最低代价Fmin的直达地点为唯一直达地点,则将唯一直达地点作为当前目标地点W,并进入步骤7;否则进入步骤4。
步骤4、对应于最低代价Fmin的直达地点的数量多于1,即对应于最低代价Fmin的直达地点并非为唯一直达地点,按如下方式确定当前目标地点W:
将对应于最低代价Fmin的M个直达地点记为Wj,j=1,2…,M;运算模块通过计算分别获得机器人从初始地点坐标O移动到各直达地点Wj所付出的各代价Gj,从M个代价Gj中筛选出最低代价Gmin。
步骤5、若对应于最低代价的直达地点的数量为1,即对应于最低代价Gmin的直达地点为唯一直达地点,则将唯一直达地点作为当前目标地点W,并进入步骤7;否则进入步骤6。
步骤6、若对应于最低代价Gmin的直达地点的数量多于1,即对应于最低代价Fmin的直达地点并非为唯一直达地点,则在对应于最低代价Gmin的各直达地点中任选其一作为当前目标地点W,并进入步骤7。
步骤7、机器人由当前地点向当前目标地点W移动,在机器人到达当前目标地点W时即完成当前一步移动。随后,将当前目标地点W的坐标存入服务器中的close_list集合,并将当前目标地点W作为机器人下一步移动的当前所在地点的坐标,返回步骤1继续下一步移动,直至机器人到达最终的目标地点,结束路径规划。
本实施例中通过路径规划引导机器人从初始地点向目标地点移动,能够实现机器人在移动过程中尽可能地避开例如:地面损毁严重、磁场强度过大、空气湿度过高、障碍物分布密集等环境相对恶劣的区域,从而可以降低对组成机器人所需的机械元件以及机器人自身所携带的电子设备造成损耗的概率,保证机器人自身的软硬件设备保持相对良好的运作状态。具体实施中,相应的技术措施也包括:
可直达地点是按如下方式进行确定:设定机器人移动步距U,且将与机器人相距为U的地点视作相邻且可直达地点。
机器人移动步距U是按如下方式获得:利用视觉里程计将由3D扫描仪扫描获得、并保存在服务器中的关于室外场景的三维图像利用处理器转化为二维图像,以二维图像的重心为原点建立二维直角坐标系XOY。在机器人移动过程中3D扫描仪随着机器人同步移动,移动过程中,3D扫描仪将激光以点、线或阵列的形式投射至室外场景中的物体表面,根据物体反射光判断物体的位置获得其坐标信息并上传至服务器;3D扫描仪不仅能够基于反射光的角度获得物体的几何信息,还能够将室外场景的立体信息转换为计算机可直接处理的数据。基于此,根据在T时段内二维图像的变换情况能够计算获得机器人在T时段内的的移动距离作为移动步距U。
图像变换有两种不同的形式,一种是图像发生缩放变换,另一种是图像发生平移变换;
具体实施中,针对图像发生缩放变换按如下方式计算获得机器人移动步距U:将图像在二维直角坐标系中的坐标点记为Pi[xp,yp],图像发生缩放变换发生在机器人移动的(ti,tj)时段内,利用测量设备图像发生移动的速率v1,则图像在单位时段内发生的位移S由式(5-1)计算获得:
在单位时段内,由于机器人移动使得由机器人测量设备观测到的图像发生缩放变换,在发生缩放变换后的图像中,坐标点Pi[xp,yp]对应变换为坐标点Pi‘[xp′,yp′],根据相似定理,坐标点Pi[xp,yp]在单位时段发生缩放变换的倍数λ可由式(5-2)计算获得:
式(5-2)中:
xp′和yp′为坐标点Pi‘[xp′,yp′]的坐标值;xp和yp为坐标点Pi[xp,yp]的坐标值;
机器人在单位时段内的位移量L如式(5-3)所示:
移动步距U是机器人在(ti,tj)的时间段内发生的位移量,(ti,tj)时间段是由有限个单位时段所组成。
针对图像发生平移变换按如下方式计算机器人移动步距U:图像发生平移变换发生在机器人移动的单位时段内,利用测量设备测得图像发生移动的速率v1,则图像在单位时段内发生的位移S由式(5-5)计算获得:
机器人在单位时段内的位移量L如式(5-6)所示:
L=υS (5-6)
式(5-6)中:υ是在单位时段内图像平移的距离与机器人位移量的比值,υ≠0,l;
则,由式(5-7)计算获得机器人移动步距U:
移动步距U是机器人在(ti,tj)的时间段内发生的位移量,(ti,tj)时间段是由有限个单位时段所组成。
机器人由当前所在地点移动到当前目标地点W所付出的代价F为:
式(5-8)中:以γ表示路面影响因子,以e表示不同类型路面,γe即表示为各不同类型路面的路面影响因子,共有四种不同类型的路面分别以e=I、e=II、e=III和e=IV进行表征;路面影响因子γ用来表征由于路面本身所具有的物理属性对机器人运动状态造成的影响,例如:处于室外环境中的机器人的运动状态受到路面粗糙度C和路面坡度D的影响;并有:
式(5-9)中:θ为路面与水平面所成的倾角;H为机器人移动的水平位移,由视觉里程计测量得出;Z为变坡点相对于水平面的高度;
路面影响因子γ由式(7-2)计算获得:
式(5-10)中:系数k是表征机器人在运动时受到外界影响导致自身产生晃动的剧烈程度的物理量;路面坡度D是表征地表单元陡缓的程度的物理量,表达方式如式(5-9);路面粗糙度C随不同类型路面所有不同,根据土层等效剪切波速和场地覆盖层厚度将路面划分为如下四种类型:
I类:指近海海面和海岛、海岸、湖岸及沙漠地区;
II类:指田野、乡村、丛林、丘陵以及房屋稀疏的乡镇和城市郊区;
III类:指有密集建筑群的城市市区;
IV类:指有密集建筑群且房屋较高的城市市区。
路面粗糙度C指的是路表面骨料的棱角阻碍机器人移动的能力,通常与路面摩擦系数和路表构造深度有关,会随着路面类型所对应等级的上升而对机器人的运动状态造成相对更强的影响,从而使机器人在到达目标地点的过程中付出更高的代价。
本发明中机器人是以3D扫描仪为捕获环境信息的工具,使机器人在移动过程中能够准确的识别周边环境中障碍物的分布地点以有效地避让,保证自身运动的稳定性;并根据自身的定位与最终目标地点进行合理的路径规划,减小移动过程受到外界干扰。
Claims (7)
1.一种移动机器人室外高精度自主导航***,其特征是:包括机械***和软件***;
所述机械***包括GPS定位设备、3D扫描仪、视觉里程计、服务器、处理器和运算模块;在所述机械***中:由所述3D扫描仪通过扫描和三维重现获取室外场景信息和室外物体信息;由所述视觉里程计通过图像信息处理获得移动机器人位移信息;由所述服务器在3D扫描仪和GPS定位设备之间收发指令和数据;由所述处理器对3D扫描仪和视觉里程计所述获取的图像进行格式转换以及分辨率调整;由所述运算模块对移动机器人在移动过程中所耗费的代价进行计算;所述软件***包括机器人操作***ROS;
将机器人开始移动之前的初始地点坐标记为坐标O,将所述初始地点坐标O存入在服务器中的close_list集合中;针对移动中的机器人,按如下步骤进行最优路径规划:
步骤1、利用所述GPS定位设备获得与机器人当前所在地点相邻且可直达的N个直达地点n的坐标集合A,n=1,2,……N;将所述坐标集合A存入在服务器中的open_list集合中,将机器人当前所在地点坐标记为坐标B存入在服务器中的close_list集合中;
步骤2、针对服务器中存储的坐标B和坐标集合A,由所述运算模块一一对应计算获得机器人由坐标B移动到坐标集合A中的各直达地点n所需付出的代价Fn,从N个代价Fn中筛选出最低代价Fmin;
步骤3、若对应于最低代价Fmin的直达地点的数量为1,即对应于最低代价Fmin的直达地点为唯一直达地点,则将所述唯一直达地点作为当前目标地点W,并进入步骤7;否则进入步骤4;
步骤4、对应于最低代价Fmin的直达地点的数量多于1,即对应于最低代价Fmin的直达地点并非为唯一直达地点,按如下方式确定当前目标地点W:
将对应于最低代价Fmjn的M个直达地点记为Wj,j=1,2…,M;所述运算模块通过计算分别获得机器人从初始地点坐标O移动到各直达地点Wj所付出的各代价Gj,从M个代价Gj中筛选出最低代价Gmin;
步骤5、若对应于最低代价Gmin的直达地点的数量为1,即对应于最低代价Gmin的直达地点为唯一直达地点,则将所述唯一直达地点作为当前目标地点W,并进入步骤7;否则进入步骤6;
步骤6、若对应于最低代价Gmin的直达地点的数量多于1,即对应于最低代价Fmin的直达地点并非为唯一直达地点,则在对应于最低代价Gmin的各直达地点中任选其一作为当前目标地点W,并进入步骤7;
步骤7、机器人由当前地点向当前目标地点W移动,在机器人到达当前目标地点W时即完成当前一步移动;随后,将当前目标地点W的坐标作为机器人下一步移动的当前所在地点的坐标,返回步骤1继续下一步移动,直至机器人到达最终的目标地点,结束路径规划。
2.根据权利要求1所述的移动机器人室外高精度自主导航***,其特征是:所述可直达地点是按如下方式进行确定:设定机器人移动步距U,且将与机器人相距为U的地点视作相邻且可直达地点。
3.根据权利要求2所述的移动机器人室外高精度自主导航***,其特征是:所述机器人移动步距U是按如下方式获得:利用视觉里程计将由3D扫描仪扫描获得、并保存在服务器中的关于室外场景的三维图像利用处理器转化为二维图像,以所述二维图像的重心为原点建立二维直角坐标系XOY,针对在T时段内的图像变换计算获得机器人在T时段内的移动距离作为移动步距U。
4.根据权利要求3所述的移动机器人室外高精度自主导航***,其特征是:所述图像变换为图像发生缩放变换,针对图像发生缩放变换按如下方式计算获得机器人移动步距U:将图像在二维直角坐标系中的坐标点记为Pi[xp,yp],图像发生缩放变换发生在机器人移动的(ti,tj)时段内,利用测量设备获得图像发生移动的速率v1,则图像在单位时段内发生的位移S由式(5-1)计算获得:
在单位时段内,由于机器人移动使得由机器人测量设备观测到的图像发生缩放变换,在发生缩放变换后的图像中,坐标点Pi[xp,yp]对应变换为坐标点Pi‘[xp',yp'],根据相似定理,坐标点Pi[xp,yp]在单位时段发生缩放变换的倍数λ由式(5-2)计算获得:
式(5-2)中:
xp'和yp'为坐标点Pi‘[xp',yp']的坐标值;xp和yp为坐标点Pi[xp,yp]的坐标值;
机器人在单位时段内的位移量L如式(5-3)所示:
则,由式(5-4)计算获得机器人移动步距U:
移动步距U是机器人在(ti,tj)的时间段内发生的位移量,(ti,tj)时间段是由有限个单位时段所组成。
5.根据权利要求3所述的移动机器人室外高精度自主导航***,其特征是:所述图像变换为图像发生平移变换,针对图像发生平移变换按如下方式计算机器人移动步距U:图像发生平移变换发生在机器人移动的单位时段内,利用测量设备测得图像发生移动的速率v1,则图像在单位时段内发生的位移S由式(5-5)计算获得:
机器人在单位时段内的位移量L如式(5-6)所示:
L=υS (5-6)
式(5-6)中:
υ是在单位时段内图像平移的距离与机器人位移量的比值,υ≠0,1;
则,由式(5-7)计算获得机器人移动步距U:
移动步距U是机器人在(ti,tj)的时间段内发生的位移量,(ti,tj)时间段是由有限个单位时段所组成。
7.根据权利要求6所述的移动机器人室外高精度自主导航***,其特征是:处于室外环境中的机器人的运动状态受到路面粗糙度C和路面坡度D的影响;并有:
式(7-1)中:θ为路面与水平面所成的倾角,H为机器人移动的水平位移,由视觉里程计测量得出,Z为变坡点相对于水平面的高度;
路面影响因子γ由式(7-2)计算获得:
式(7-2)中:系数k是表征机器人在运动时受到外界影响导致自身产生晃动的剧烈程度的物理量;路面粗糙度C随不同类型路面所有不同,根据土层等效剪切波速和场地覆盖层厚度将路面划分为如下四种类型:
I类:指近海海面和海岛、海岸、湖岸及沙漠地区;
II类:指田野、乡村、丛林、丘陵以及房屋稀疏的乡镇和城市郊区;
III类:指有密集建筑群的城市市区;
IV类:指有密集建筑群且房屋较高的城市市区。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111088955.3A CN113733091B (zh) | 2021-09-16 | 2021-09-16 | 一种移动机器人室外高精度自主导航*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111088955.3A CN113733091B (zh) | 2021-09-16 | 2021-09-16 | 一种移动机器人室外高精度自主导航*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113733091A CN113733091A (zh) | 2021-12-03 |
CN113733091B true CN113733091B (zh) | 2022-08-30 |
Family
ID=78739407
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111088955.3A Active CN113733091B (zh) | 2021-09-16 | 2021-09-16 | 一种移动机器人室外高精度自主导航*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113733091B (zh) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105116902A (zh) * | 2015-09-09 | 2015-12-02 | 北京进化者机器人科技有限公司 | 一种移动机器人避障导航的方法和*** |
CN106607907A (zh) * | 2016-12-23 | 2017-05-03 | 西安交通大学 | 一种移动视觉机器人及其测控方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8271132B2 (en) * | 2008-03-13 | 2012-09-18 | Battelle Energy Alliance, Llc | System and method for seamless task-directed autonomy for robots |
KR101761313B1 (ko) * | 2010-12-06 | 2017-07-25 | 삼성전자주식회사 | 로봇 및 로봇의 경로생성방법 |
US9969081B2 (en) * | 2012-07-27 | 2018-05-15 | Alberto Daniel Lacaze | Method and system for the directed control of robotic assets |
-
2021
- 2021-09-16 CN CN202111088955.3A patent/CN113733091B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105116902A (zh) * | 2015-09-09 | 2015-12-02 | 北京进化者机器人科技有限公司 | 一种移动机器人避障导航的方法和*** |
WO2017041730A1 (zh) * | 2015-09-09 | 2017-03-16 | 北京进化者机器人科技有限公司 | 一种移动机器人避障导航的方法和*** |
CN106607907A (zh) * | 2016-12-23 | 2017-05-03 | 西安交通大学 | 一种移动视觉机器人及其测控方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113733091A (zh) | 2021-12-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Barber et al. | Geometric validation of a ground-based mobile laser scanning system | |
CN109709801A (zh) | 一种基于激光雷达的室内无人机定位***及方法 | |
Zhao et al. | Reconstructing textured CAD model of urban environment using vehicle-borne laser range scanners and line cameras | |
JP2009294214A (ja) | 地形構造を用いたナビゲーション方法及びシステム | |
CN1149916A (zh) | 地理数据的收集,分析,测量和存储方法 | |
Toth | R&D of mobile LIDAR mapping and future trends | |
CN101782642B (zh) | 多传感器融合的测量目标绝对定位的方法及装置 | |
Scaioni et al. | Technical aspects related to the application of sfm photogrammetry in high mountain | |
CN110986888A (zh) | 一种航空摄影一体化方法 | |
Khoshelham et al. | Vehicle positioning in the absence of GNSS signals: Potential of visual-inertial odometry | |
Chellappa et al. | On the positioning of multisensor imagery for exploitation and target recognition | |
Grejner-Brzezinska et al. | From Mobile Mapping to Telegeoinformatics | |
IL267309B2 (en) | Terrestrial observation device with positioning functionality | |
CN113733091B (zh) | 一种移动机器人室外高精度自主导航*** | |
Ellum et al. | Land-based integrated systems for mapping and GIS applications | |
CN116027351A (zh) | 一种手持/背包式slam装置及定位方法 | |
Iannucci et al. | Cross-Modal Localization: Using automotive radar for absolute geolocation within a map produced with visible-light imagery | |
Chan | Feature-Based Boresight Self-Calibration of a Mobile Mapping System | |
Tamimi et al. | Performance Assessment of a Mini Mobile Mapping System: Iphone 14 pro Installed on a e-Scooter | |
Ishii et al. | Autonomous UAV flight using the Total Station Navigation System in Non-GNSS Environments | |
Wei | Multi-sources fusion based vehicle localization in urban environments under a loosely coupled probabilistic framework | |
Chen et al. | Panoramic epipolar image generation for mobile mapping system | |
Niu et al. | Directly georeferencing terrestrial imagery using MEMS-based INS/GNSS integrated systems | |
Li et al. | Terrestrial mobile mapping towards real-time geospatial data collection | |
Guo et al. | Research on 3D geometric modeling of urban buildings based on airborne lidar point cloud and image |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |