CN114415664A - 一种机器人导航方法及装置 - Google Patents
一种机器人导航方法及装置 Download PDFInfo
- Publication number
- CN114415664A CN114415664A CN202111544843.4A CN202111544843A CN114415664A CN 114415664 A CN114415664 A CN 114415664A CN 202111544843 A CN202111544843 A CN 202111544843A CN 114415664 A CN114415664 A CN 114415664A
- Authority
- CN
- China
- Prior art keywords
- robot
- pose
- determining
- current
- dimensional code
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 48
- 238000012937 correction Methods 0.000 claims abstract description 37
- 238000012545 processing Methods 0.000 claims description 3
- 230000008569 process Effects 0.000 abstract description 11
- 238000004891 communication Methods 0.000 description 14
- 238000004590 computer program Methods 0.000 description 10
- 238000003860 storage Methods 0.000 description 6
- 230000009471 action Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 3
- 230000006378 damage Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000003491 array Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000011065 in-situ storage Methods 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 239000000575 pesticide Substances 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000005507 spraying Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
- G05D1/0263—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using magnetic strips
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本申请提供了一种机器人导航方法及装置,属于机器人技术领域。本申请通过,获取机器人对应的目标路径,所述目标路径包括至少一个矫正路径点及所述矫正路径点对应的第一位姿;当所述机器人移动至任一所述矫正路径点对应的位置范围内时,通过所述机器人携带的拍摄装置拍摄所述位置范围内的二维码,得到第一图像;基于所述第一图像确定所述机器人的当前位姿;基于所述第一位姿和所述当前位姿确定所述机器人的移动策略。从而在机器人移动过程中,利用预先在移动路线中设置的二维码进行精准定位,提高定位精度。
Description
技术领域
本申请涉及机器人技术领域,尤其涉及一种机器人导航方法及装置。
背景技术
中国是温室种植的大国,截止2020年,我国温室面积已突破210万公顷。同时,机器人在温室的巡检、采摘、喷药等环节的运用也越来越广泛。在温室中作业的机器人如果缺乏高效且准确的导航系统将会导致机器人在运行过程中碾压菜垄,或者在局部陷入死区而原地停止运行等故障。
传统的导航系统,一般以激光导航为主,但其定位精度一般在正负5cm左右,由于定位精度不高,常需要结合其他方式实现精准定位。目前,常用的方式是,结合激光导航与磁条完成整个激光导航过程。然而,通过结合激光导航与磁条进行导航的方式,前期需要在地面进行大量铺设磁条的工作,不仅会增加材料成本和人工成本,有时甚至会对地面设施造成一定程度的破坏。
发明内容
本申请实施例的目的在于提供一种机器人导航方法及装置,以解决通过结合激光导航与磁条的方式完成导航过程存在成本高的问题。
具体技术方案如下:
第一方面,提供了一种机器人导航方法,所述方法包括:
获取机器人对应的目标路径,所述目标路径包括至少一个矫正路径点及所述矫正路径点对应的第一位姿;
当所述机器人移动至任一所述矫正路径点对应的位置范围内时,通过所述机器人携带的拍摄装置拍摄所述位置范围内的二维码,得到第一图像;
基于所述第一图像确定所述机器人的当前位姿;
基于所述第一位姿和所述当前位姿确定所述机器人的移动策略。
可选地,所述基于所述第一图像确定所述机器人的当前位姿,包括:
获取所述拍摄装置拍摄所述第一图像的拍摄信息;
解析所述第一图像中的二维码信息,得到所述二维码的位置和所述二维码的朝向角;
基于所述拍摄信息确定所述机器人相对于所述二维码的相对位置和相对角度;
基于所述二维码的位置、所述二维码的朝向角、所述相对位置及所述相对角度,确定所述机器人的当前位姿。
可选地,所述当前位姿包括:当前位置和当前姿态;
所述基于所述二维码的位置、所述二维码的朝向角、所述相对位置及所述相对角度,确定所述机器人的当前位姿,包括:
基于所述二维码的位置和所述相对位置,确定所述机器人的当前位置,以及,基于所述相对角度和所述二维码的朝向角,确定所述机器人的当前姿态。
可选地,所述基于所述第一位姿和所述当前位姿确定所述机器人的移动策略,包括:
确定所述当前位姿和所述第一位姿是否符合预设条件;
在所述当前位姿和所述第一位姿符合预设条件时,控制所述机器人由所述当前位姿移动至所述第一位姿;
在所述当前位姿和所述第一位姿不符合预设条件时,确定下一矫正路径点对应的第二位姿,并控制所述机器人由所述当前位姿移动至所述第二位姿。
可选地,所述第一位姿包括第一位置和第一姿态,所述当前位姿包括当前位置和当前姿态,
所述确定所述当前位姿和所述第一位姿是否符合预设条件,包括:
确定所述第一位置和所述当前位置的距离,并判断所述当前姿态和所述第一姿态是否一致;
在所述距离大于或等于预设距离阈值时,确定所述当前位姿和所述第一位姿符合预设条件,
或,
在所述距离为零,且,所述当前姿态和所述第一姿态不一致时,确定所述当前位姿和所述第一位姿符合预设条件。
可选地,在所述距离大于零,且,所述距离小于预设距离阈值时,确定所述当前位姿和所述第一位姿不符合预设条件。
可选地,所述目标路径还包括至少一个转折路径点,所述方法还包括:
当所述机器人移动至任一所述转折路径点的位置范围时,确定所述机器人所处位置,以及,确定所述转折路径点对应的下一转折路径点;
利用所述拍摄装置拍摄所述机器人所处位置的第二图像;
基于所述第二图像确定所述机器人所处环境中的障碍物信息;
基于所述机器人所处位置、所述障碍物信息和所述下一转折路径点的位置确定转弯策略;
控制所述机器人按照所述转弯策略进行转弯。
第二方面,提供了一种机器人导航装置,所述装置包括:
获取模块,用于获取机器人对应的目标路径,所述目标路径包括至少一个矫正路径点及所述矫正路径点对应的第一位姿;
拍摄模块,用于当所述机器人移动至任一所述矫正路径点对应的位置范围内时,通过所述机器人携带的拍摄装置拍摄所述位置范围内的二维码,得到第一图像;
第一确定模块,用于基于所述第一图像确定所述机器人的当前位姿;
第二确定模块,用于基于所述第一位姿和所述当前位姿确定所述机器人的移动策略。
可选地,所述第一确定模块,具体用于:
获取所述拍摄装置拍摄所述第一图像的拍摄信息;
解析所述第一图像中的二维码信息,得到所述二维码的位置和所述二维码的朝向角;
基于所述拍摄信息确定所述机器人相对于所述二维码的相对位置和相对角度;
基于所述二维码的位置、所述二维码的朝向角、所述相对位置及所述相对角度,确定所述机器人的当前位姿。
可选地,所述当前位姿包括:当前位置和当前姿态;
所述所述第一确定模块,还用于:
基于所述二维码的位置和所述相对位置,确定所述机器人的当前位置,以及,基于所述相对角度和所述二维码的朝向角,确定所述机器人的当前姿态。
可选地,所述第二确定模块,具体用于:
确定所述当前位姿和所述第一位姿是否符合预设条件;
在所述当前位姿和所述第一位姿符合预设条件时,控制所述机器人由所述当前位姿移动至所述第一位姿;
在所述当前位姿和所述第一位姿不符合预设条件时,确定下一矫正路径点对应的第二位姿,并控制所述机器人由所述当前位姿移动至所述第二位姿。
可选地,所述第一位姿包括第一位置和第一姿态,所述当前位姿包括当前位置和当前姿态,
所述所述第二确定模块,还用于:
确定所述第一位置和所述当前位置的距离,并判断所述当前姿态和所述第一姿态是否一致;
在所述距离大于或等于预设距离阈值时,确定所述当前位姿和所述第一位姿符合预设条件,
或,
在所述距离为零,且,所述当前姿态和所述第一姿态不一致时,确定所述当前位姿和所述第一位姿符合预设条件。
可选地,所述所述第二确定模块,还用于:
在所述距离大于零,且,所述距离小于预设距离阈值时,确定所述当前位姿和所述第一位姿不符合预设条件。
可选地,所述目标路径还包括至少一个转折路径点,所述装置还包括控制模块,所述控制模块,用于:
当所述机器人移动至任一所述转折路径点的位置范围时,确定所述机器人所处位置,以及,确定所述转折路径点对应的下一转折路径点;
利用所述拍摄装置拍摄所述机器人所处位置的第二图像;
基于所述第二图像确定所述机器人所处环境中的障碍物信息;
基于所述机器人所处位置、所述障碍物信息和所述下一转折路径点的位置确定转弯策略;
控制所述机器人按照所述转弯策略进行转弯。
第三方面,提供了一种电子设备,包括处理器、通信接口、存储器和通信总线,其中,处理器,通信接口,存储器通过通信总线完成相互间的通信;
存储器,用于存放计算机程序;
处理器,用于执行存储器上所存放的程序时,实现第一方面任一所述的方法步骤。
第四方面,提供了一种计算机可读存储介质,其特征在于,所述计算机可读存储介质内存储有计算机程序,所述计算机程序被处理器执行时实现第一方面任一所述的方法步骤。
第五方面,提供了一种包含指令的计算机程序产品,当其在计算机上运行时,使得计算机执行上述任一所述的机器人导航方法。
本申请实施例有益效果:
本申请实施例提供了一种机器人导航方法及装置,本申请通过,首先,获取机器人对应的目标路径,所述目标路径包括至少一个矫正路径点及所述矫正路径点对应的第一位姿;然后,当所述机器人移动至任一所述矫正路径点对应的位置范围内时,通过所述机器人携带的拍摄装置拍摄所述位置范围内的二维码,得到第一图像;然后,基于所述第一图像确定所述机器人的当前位姿;最后,基于所述第一位姿和所述当前位姿确定所述机器人的移动策略。
即,通过本申请,可以在机器人移动过程中,利用预先在移动路线中设置的二维码进行精准定位,从而提高定位精度,进而确定机器人的移动策略,从而实现精准导航,并且,利用二维码实现精准定位具有成本低,且,容易实现的优点。
当然,实施本申请的任一产品或方法并不一定需要同时达到以上所述的所有优点。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,对于本领域普通技术人员而言,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本申请实施例提供的一种机器人导航方法的流程图;
图2为本申请另一实施例提供的一种机器人导航方法的流程图;
图3为本申请另一实施例提供的一种机器人导航方法的流程图;
图4为本申请实施例提供的一种机器人导航装置的结构示意图;
图5为本申请实施例提供的一种电子设备的结构示意图。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
由于,目前通过结合激光导航与磁条进行导航的方式,前期需要在地面进行大量铺设磁条的工作,不仅会增加材料成本和人工成本,有时甚至会对地面设施造成一定程度的破坏。为此,本申请实施例提供了一种机器人导航方法,可以应用于机器人控制。
下面将结合具体实施方式,对本申请实施例提供的一种机器人导航方法进行详细的说明,如图1所示,具体步骤如下:
S101,获取机器人对应的目标路径,所述目标路径包括至少一个矫正路径点及所述矫正路径点对应的第一位姿。
本申请实施例提供的机器人导航方法可以应用于机器人导航控制器中,用于控制机器人移动。
在本申请实施例中,预先在环境地图以及用户在该环境地图中设置的起点和终点的基础上,利用路线规划算法规划出目标路径。
进一步地,可以在机器人上设置激光雷达,利用机器人自身携带的激光雷达对所处环境进行扫描,构建该环境地图。
作为一种实施方式,在规划目标路径前,用户在设置起点和终点的同时,还可以在起点和终点之间添加多个目标点以及目标点对应的抵达顺序,其中目标点可以是转折点,然后进行多目标约束下的路线规划,从而获得多个目标点之间的导航数据,然后,在该导航数据的基础上利用多目标优化算法对机器人工作时的路线进行规划,从而规划出目标路径。
进一步地,目标路径用于指示机器人具体如何移动,其包括多个路径点和该路径点对应的位姿。其中,可以将目标路径中的任一路径点作为矫正路径点,而由于一般直线移动过程中发生偏离的情况较少,而转弯过程中发生偏离的情况较多,因此,也可以将多个目标点,即转折点,作为矫正路径点。
S102,当所述机器人移动至任一所述矫正路径点对应的位置范围内时,通过所述机器人携带的拍摄装置拍摄所述位置范围内的二维码,得到第一图像。
在本申请实施例中,预先在矫正路径点对应的位置范围内设置二维码,二维码中存储了该二维码的ID及在环境地图中的信息,例如位置和朝向角等信息。
进一步地,二维码可以是以直至图片的形式设置,也可以通过显示屏进行显示。
具体地,当机器人移动至任一矫正路径点对应的位置范围内时,控制机器人在该位置范围内寻找二维码,在找到对应的二维码时,通过机器人携带的拍摄装置拍摄该二维码,得到第一图像。
S103,基于所述第一图像确定所述机器人的当前位姿。
S104,基于所述第一位姿和所述当前位姿确定所述机器人的移动策略。
在本申请实施例中,由于二维码中存储了该二维码的ID及在环境地图中的信息,因此,可以通过解析第一图像中的二维码,确定机器人的当前位姿,进而通过第一位姿和当前位姿确定机器人的移动策略。
本申请实施例中,可以在机器人移动过程中,利用预先在移动路线中设置的二维码进行精准定位,从而提高定位精度,进而确定机器人的移动策略,从而实现精准导航,并且,利用二维码实现精准定位具有成本低,且,容易实现的优点。
在本申请又一实施例中,如图2所示,所述S103,可以包括以下步骤:
S201,获取所述拍摄装置拍摄所述第一图像的拍摄信息。
在本申请实施例中,拍摄装置的拍摄信息包括拍摄距离和拍摄角度,具体地,可以预先在该位置范围内各个位置以不同角度拍摄该二维码得到对应的图像,并存储各个图像与拍摄位置和拍摄角度的对应关系,在收到拍摄装置拍摄的第一图像后,即可将第一图像与预先存储的图像进行比对,得到对应的拍摄距离和拍摄角度。通过该方案确定拍摄信息,计算量小,简单高效。
S202,解析所述第一图像中的二维码信息,得到所述二维码的位置和所述二维码的朝向角。
在本申请实施例中,可以通过解析第一图像中的二维码信息,得到二维码的位置和二维码的朝向角。
S203,基于所述拍摄信息确定所述机器人相对于所述二维码的相对位置和相对角度。
在本申请实施例中,拍摄信息包括拍摄距离和拍摄角度,根据拍摄距离和拍摄角度可以确定机器人相对于二维码的相对方向和相对距离,即相对位置,其中机器人相对于二维码的相对方向即相对角度。
S204,基于所述二维码的位置、所述二维码的朝向角、所述相对位置及所述相对角度,确定所述机器人的当前位姿。
在本申请实施例中,由于二维码的位置和朝向角已知,因此,可以基于二维码的位置、二维码的朝向角、机器人相对于二维码的相对位置及相对角度,确定机器人的当前位姿。其中,当前位姿包括:当前位置和当前姿态。
具体地,基于所述二维码的位置和所述相对位置,确定所述机器人的当前位置,以及,基于所述相对角度和所述二维码的朝向角,确定所述机器人的当前姿态,即,机器人的当前航向角。
其中,二维码在环境地图中的位置和朝向角已知,根据机器人相对于二维码的相对位置及二维码的位置进行转换,即可得到机器人在地图中的当前位置,同理,根据机器人相对于二维码的相对角度及二维码的朝向角进行转换,即可得到机器人的当前姿态。
本申请实施例中,可以通过拍摄预先在移动路线中设置的二维码,确定机器人相对于二维码的位置和角度,进而根据二维码中解析的二维码的位置和朝向角,确定机器人的位置和航向角,从而实现对机器人的精准定位,提高定位精度。
在本申请又一实施例中,所述S104,可以包括以下步骤:
步骤一,确定所述当前位姿和所述第一位姿是否符合预设条件。
步骤二,在所述当前位姿和所述第一位姿符合预设条件时,控制所述机器人由所述当前位姿移动至所述第一位姿。
步骤三,在所述当前位姿和所述第一位姿不符合预设条件时,确定下一矫正路径点对应的第二位姿,并控制所述机器人由所述当前位姿移动至所述第二位姿。
在本申请实施例中,首先,确定当前位姿和第一位姿是否符合预设条件。在当前位姿和第一位姿符合预设条件时,控制机器人由当前位姿移动至第一位姿;在当前位姿和第一位姿不符合预设条件时,确定下一矫正路径点对应的第二位姿,并控制机器人由当前位姿移动至第二位姿。
其中,第一位姿包括第一位置和第一姿态,当前位姿包括当前位置和当前姿态,作为一种可实施的方式,可以通过以下步骤确定当前位姿和第一位姿是否符合预设条件:
确定所述第一位置和所述当前位置的距离,并判断所述当前姿态和所述第一姿态是否一致;
在所述距离大于或等于预设距离阈值时,确定所述当前位姿和所述第一位姿符合预设条件,
或,
在所述距离为零,且,所述当前姿态和所述第一姿态不一致时,确定所述当前位姿和所述第一位姿符合预设条件;
在所述距离大于零,且,所述距离小于预设距离阈值时,确定所述当前位姿和所述第一位姿不符合预设条件。
该实施方式中,在距离大于或等于预设距离阈值时,意味着机器人当前位置距离第一位置较远,此时确定当前位姿和第一位姿符合预设条件;在距离为零,且,当前姿态和第一姿态不一致时,意味着机器人当前位置即第一位置,仅姿态与第一姿态不一致,此时,确定当前位姿和第一位姿符合预设条件;在距离大于零,且,距离小于预设距离阈值时,意味着机器人当前位置距离第一位置较近,此时确定当前位姿和第一位姿不符合预设条件。
本申请实施例中,在所述当前位姿和所述第一位姿符合预设条件时,意味着机器人偏离比较严重,或者仅姿态存在偏差,控制所述机器人由所述当前位姿移动至所述第一位姿,从而实现对机器人位置的矫正;在当前位姿和第一位姿不符合预设条件时,意味着机器人偏离不严重,无需控制机器人先移动至第一位姿,直接确定下一矫正路径点对应的第二位姿,并控制机器人由当前位姿移动至第二位姿。从而减少机器人的移动路程,节约计算资源。
在本申请又一实施例中,如图3所示,所述方法还可以包括以下步骤:
S301,当所述机器人移动至任一所述转折路径点的位置范围时,确定所述机器人所处位置,以及,确定所述转折路径点对应的下一转折路径点。
在本申请实施例中,所述目标路径还包括至少一个转折路径点,即,发生转折的路径点。预先设置每个转折路径点对应的位置范围。
具体地,当机器人移动至任一转折路径点的位置范围时,确定机器人所处位置,以及,确定该转折路径点对应的下一转折路径点。
进一步地,可以通过激光导航定位机器人所处位置,或者,根据预设的二维码定位机器人所处位置,或者,利用拍摄装置拍摄周围环境信息,与预存的环境信息进行比对从而定位机器人所处位置。
S302,利用所述拍摄装置拍摄所述机器人所处位置的第二图像。
S303,基于所述第二图像确定所述机器人所处环境中的障碍物信息。
S304,基于所述机器人所处位置、所述障碍物信息和所述下一转折路径点的位置确定转弯策略。
S305,控制所述机器人按照所述转弯策略进行转弯。
在本申请实施例中,利用所述拍摄装置拍摄机器人所处位置的第二图像,可以通过提取第二图像的特征,确定第二图像中显示的机器人所处位置的环境情况,从而基于第二图像确定机器人所处环境中的障碍物信息,进而,可以利用路线规划算法基于机器人所处位置、所处环境中的障碍物信息和下一转折路径点的位置计算得到转弯策略,其中,转弯策略包括:转弯半径、转弯方向及转弯速度。最后,控制机器人按照该转弯策略进行转弯。
本申请实施例中,在机器人处于任一转折路径点时,可以根据拍摄装置拍摄的环境情况,确定转弯策略,使转弯策略更加符合该转折路径点所处环境的实际情况,进而按照该转弯策略进行转弯,使机器人的转弯过程更加顺畅。
基于相同的技术构思,本申请实施例还提供了一种机器人导航装置,如图4所示,该装置包括:
获取模块401,用于获取机器人对应的目标路径,所述目标路径包括至少一个矫正路径点及所述矫正路径点对应的第一位姿;
拍摄模块402,用于当所述机器人移动至任一所述矫正路径点对应的位置范围内时,通过所述机器人携带的拍摄装置拍摄所述位置范围内的二维码,得到第一图像;
第一确定模块403,用于基于所述第一图像确定所述机器人的当前位姿;
第二确定模块404,用于基于所述第一位姿和所述当前位姿确定所述机器人的移动策略。
可选地,所述第一确定模块,具体用于:
获取所述拍摄装置拍摄所述第一图像的拍摄信息;
解析所述第一图像中的二维码信息,得到所述二维码的位置和所述二维码的朝向角;
基于所述拍摄信息确定所述机器人相对于所述二维码的相对位置和相对角度;
基于所述二维码的位置、所述二维码的朝向角、所述相对位置及所述相对角度,确定所述机器人的当前位姿。
可选地,所述当前位姿包括:当前位置和当前姿态;
所述所述第一确定模块,还用于:
基于所述二维码的位置和所述相对位置,确定所述机器人的当前位置,以及,基于所述相对角度和所述二维码的朝向角,确定所述机器人的当前姿态。
可选地,所述第二确定模块,具体用于:
确定所述当前位姿和所述第一位姿是否符合预设条件;
在所述当前位姿和所述第一位姿符合预设条件时,控制所述机器人由所述当前位姿移动至所述第一位姿;
在所述当前位姿和所述第一位姿不符合预设条件时,确定下一矫正路径点对应的第二位姿,并控制所述机器人由所述当前位姿移动至所述第二位姿。
可选地,所述第一位姿包括第一位置和第一姿态,所述当前位姿包括当前位置和当前姿态,
所述所述第二确定模块,还用于:
确定所述第一位置和所述当前位置的距离,并判断所述当前姿态和所述第一姿态是否一致;
在所述距离大于或等于预设距离阈值时,确定所述当前位姿和所述第一位姿符合预设条件,
或,
在所述距离为零,且,所述当前姿态和所述第一姿态不一致时,确定所述当前位姿和所述第一位姿符合预设条件;
在所述距离大于零,且,所述距离小于预设距离阈值时,确定所述当前位姿和所述第一位姿不符合预设条件。
可选地,所述目标路径还包括至少一个转折路径点,所述装置还包括控制模块,所述控制模块,用于:
当所述机器人移动至任一所述转折路径点的位置范围时,确定所述机器人所处位置,以及,确定所述转折路径点对应的下一转折路径点;
利用所述拍摄装置拍摄所述机器人所处位置的第二图像;
基于所述第二图像确定所述机器人所处环境中的障碍物信息;
基于所述机器人所处位置、所述障碍物信息和所述下一转折路径点的位置确定转弯策略;
控制所述机器人按照所述转弯策略进行转弯。
基于相同的技术构思,本申请实施例还提供了一种电子设备,如图5所示,包括处理器111、通信接口112、存储器113和通信总线114,其中,处理器111,通信接口112,存储器113通过通信总线114完成相互间的通信,
存储器113,用于存放计算机程序;
处理器111,用于执行存储器113上所存放的程序时,实现如下步骤:
获取机器人对应的目标路径,所述目标路径包括至少一个矫正路径点及所述矫正路径点对应的第一位姿;
当所述机器人移动至任一所述矫正路径点对应的位置范围内时,通过所述机器人携带的拍摄装置拍摄所述位置范围内的二维码,得到第一图像;
基于所述第一图像确定所述机器人的当前位姿;
基于所述第一位姿和所述当前位姿确定所述机器人的移动策略。
上述电子设备提到的通信总线可以是外设部件互连标准(Peripheral ComponentInterconnect,PCI)总线或扩展工业标准结构(Extended Industry StandardArchitecture,EISA)总线等。该通信总线可以分为地址总线、数据总线、控制总线等。为便于表示,图中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。
通信接口用于上述电子设备与其他设备之间的通信。
存储器可以包括随机存取存储器(Random Access Memory,RAM),也可以包括非易失性存储器(Non-Volatile Memory,NVM),例如至少一个磁盘存储器。可选的,存储器还可以是至少一个位于远离前述处理器的存储装置。
上述的处理器可以是通用处理器,包括中央处理器(Central Processing Unit,CPU)、网络处理器(Network Processor,NP)等;还可以是数字信号处理器(Digital SignalProcessing,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现场可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。
在本申请提供的又一实施例中,还提供了一种计算机可读存储介质,该计算机可读存储介质内存储有计算机程序,所述计算机程序被处理器执行时实现上述任一机器人导航方法的步骤。
在本申请提供的又一实施例中,还提供了一种包含指令的计算机程序产品,当其在计算机上运行时,使得计算机执行上述实施例中任一机器人导航方法。
在上述实施例中,可以全部或部分地通过软件、硬件、固件或者其任意组合来实现。当使用软件实现时,可以全部或部分地以计算机程序产品的形式实现。所述计算机程序产品包括一个或多个计算机指令。在计算机上加载和执行所述计算机程序指令时,全部或部分地产生按照本申请实施例所述的流程或功能。所述计算机可以是通用计算机、专用计算机、计算机网络、或者其他可编程装置。所述计算机指令可以存储在计算机可读存储介质中,或者从一个计算机可读存储介质向另一个计算机可读存储介质传输,例如,所述计算机指令可以从一个网站站点、计算机、服务器或数据中心通过有线(例如同轴电缆、光纤、数字用户线(DSL))或无线(例如红外、无线、微波等)方式向另一个网站站点、计算机、服务器或数据中心进行传输。所述计算机可读存储介质可以是计算机能够存取的任何可用介质或者是包含一个或多个可用介质集成的服务器、数据中心等数据存储设备。所述可用介质可以是磁性介质,(例如,软盘、硬盘、磁带)、光介质(例如,DVD)、或者半导体介质(例如固态硬盘Solid State Disk(SSD))等。
需要说明的是,在本文中,诸如“第一”和“第二”等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
以上所述仅是本申请的具体实施方式,使本领域技术人员能够理解或实现本申请。对这些实施例的多种修改对本领域的技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本申请的精神或范围的情况下,在其它实施例中实现。因此,本申请将不会被限制于本文所示的这些实施例,而是要符合与本文所申请的原理和新颖特点相一致的最宽的范围。
Claims (8)
1.一种机器人导航方法,其特征在于,所述方法包括:
获取机器人对应的目标路径,所述目标路径包括至少一个矫正路径点及所述矫正路径点对应的第一位姿;
当所述机器人移动至任一所述矫正路径点对应的位置范围内时,通过所述机器人携带的拍摄装置拍摄所述位置范围内的二维码,得到第一图像;
基于所述第一图像确定所述机器人的当前位姿;
基于所述第一位姿和所述当前位姿确定所述机器人的移动策略。
2.根据权利要求1所述的方法,其特征在于,所述基于所述第一图像确定所述机器人的当前位姿,包括:
获取所述拍摄装置拍摄所述第一图像的拍摄信息;
解析所述第一图像中的二维码信息,得到所述二维码的位置和所述二维码的朝向角;
基于所述拍摄信息确定所述机器人相对于所述二维码的相对位置和相对角度;
基于所述二维码的位置、所述二维码的朝向角、所述相对位置及所述相对角度,确定所述机器人的当前位姿。
3.根据权利要求2所述的方法,其特征在于,所述当前位姿包括:当前位置和当前姿态;
所述基于所述二维码的位置、所述二维码的朝向角、所述相对位置及所述相对角度,确定所述机器人的当前位姿,包括:
基于所述二维码的位置和所述相对位置,确定所述机器人的当前位置,以及,基于所述相对角度和所述二维码的朝向角,确定所述机器人的当前姿态。
4.根据权利要求1所述的方法,其特征在于,所述基于所述第一位姿和所述当前位姿确定所述机器人的移动策略,包括:
确定所述当前位姿和所述第一位姿是否符合预设条件;
在所述当前位姿和所述第一位姿符合预设条件时,控制所述机器人由所述当前位姿移动至所述第一位姿;
在所述当前位姿和所述第一位姿不符合预设条件时,确定下一矫正路径点对应的第二位姿,并控制所述机器人由所述当前位姿移动至所述第二位姿。
5.根据权利要求4所述的方法,其特征在于,所述第一位姿包括第一位置和第一姿态,所述当前位姿包括当前位置和当前姿态,
所述确定所述当前位姿和所述第一位姿是否符合预设条件,包括:
确定所述第一位置和所述当前位置的距离,并判断所述当前姿态和所述第一姿态是否一致;
在所述距离大于或等于预设距离阈值时,确定所述当前位姿和所述第一位姿符合预设条件,
或,
在所述距离为零,且,所述当前姿态和所述第一姿态不一致时,确定所述当前位姿和所述第一位姿符合预设条件。
6.根据权利要求5所述的方法,其特征在于,所述方法还包括:
在所述距离大于零,且,所述距离小于预设距离阈值时,确定所述当前位姿和所述第一位姿不符合预设条件。
7.根据权利要求1所述的方法,其特征在于,所述目标路径还包括至少一个转折路径点,所述方法还包括:
当所述机器人移动至任一所述转折路径点的位置范围时,确定所述机器人所处位置,以及,确定所述转折路径点对应的下一转折路径点;
利用所述拍摄装置拍摄所述机器人所处位置的第二图像;
基于所述第二图像确定所述机器人所处环境中的障碍物信息;
基于所述机器人所处位置、所述障碍物信息和所述下一转折路径点的位置确定转弯策略;
控制所述机器人按照所述转弯策略进行转弯。
8.一种机器人导航装置,其特征在于,所述装置包括:
获取模块,用于获取机器人对应的目标路径,所述目标路径包括至少一个矫正路径点及所述矫正路径点对应的第一位姿;
拍摄模块,用于当所述机器人移动至任一所述矫正路径点对应的位置范围内时,通过所述机器人携带的拍摄装置拍摄所述位置范围内的二维码,得到第一图像;
第一确定模块,用于基于所述第一图像确定所述机器人的当前位姿;
第二确定模块,用于基于所述第一位姿和所述当前位姿确定所述机器人的移动策略。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111544843.4A CN114415664A (zh) | 2021-12-16 | 2021-12-16 | 一种机器人导航方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111544843.4A CN114415664A (zh) | 2021-12-16 | 2021-12-16 | 一种机器人导航方法及装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114415664A true CN114415664A (zh) | 2022-04-29 |
Family
ID=81267020
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111544843.4A Pending CN114415664A (zh) | 2021-12-16 | 2021-12-16 | 一种机器人导航方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114415664A (zh) |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106970629A (zh) * | 2017-05-22 | 2017-07-21 | 北京京东尚科信息技术有限公司 | 无人搬运车的控制方法和装置 |
US20180297207A1 (en) * | 2017-04-14 | 2018-10-18 | TwoAntz, Inc. | Visual positioning and navigation device and method thereof |
CN110260867A (zh) * | 2019-07-29 | 2019-09-20 | 浙江大华技术股份有限公司 | 一种机器人导航中位姿确定、纠正的方法、设备及装置 |
CN110319834A (zh) * | 2018-03-30 | 2019-10-11 | 深圳市神州云海智能科技有限公司 | 一种室内机器人定位的方法及机器人 |
CN110347160A (zh) * | 2019-07-17 | 2019-10-18 | 武汉工程大学 | 一种基于双摄像头扫码的自动引导车及其导航方法 |
WO2019237775A1 (zh) * | 2018-06-15 | 2019-12-19 | 华为技术有限公司 | 一种图像信息采集方法和装置 |
CN113296118A (zh) * | 2021-05-24 | 2021-08-24 | 福建盛海智能科技有限公司 | 一种基于激光雷达与gps的无人驾驶绕障方法与终端 |
CN113589821A (zh) * | 2020-08-20 | 2021-11-02 | 深圳市海柔创新科技有限公司 | 仓库机器人导航路线预约 |
CN113664838A (zh) * | 2021-10-21 | 2021-11-19 | 季华实验室 | 机器人定位放置控制方法、装置、电子设备及存储介质 |
-
2021
- 2021-12-16 CN CN202111544843.4A patent/CN114415664A/zh active Pending
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20180297207A1 (en) * | 2017-04-14 | 2018-10-18 | TwoAntz, Inc. | Visual positioning and navigation device and method thereof |
CN106970629A (zh) * | 2017-05-22 | 2017-07-21 | 北京京东尚科信息技术有限公司 | 无人搬运车的控制方法和装置 |
CN110319834A (zh) * | 2018-03-30 | 2019-10-11 | 深圳市神州云海智能科技有限公司 | 一种室内机器人定位的方法及机器人 |
WO2019237775A1 (zh) * | 2018-06-15 | 2019-12-19 | 华为技术有限公司 | 一种图像信息采集方法和装置 |
CN110347160A (zh) * | 2019-07-17 | 2019-10-18 | 武汉工程大学 | 一种基于双摄像头扫码的自动引导车及其导航方法 |
CN110260867A (zh) * | 2019-07-29 | 2019-09-20 | 浙江大华技术股份有限公司 | 一种机器人导航中位姿确定、纠正的方法、设备及装置 |
CN113589821A (zh) * | 2020-08-20 | 2021-11-02 | 深圳市海柔创新科技有限公司 | 仓库机器人导航路线预约 |
CN113296118A (zh) * | 2021-05-24 | 2021-08-24 | 福建盛海智能科技有限公司 | 一种基于激光雷达与gps的无人驾驶绕障方法与终端 |
CN113664838A (zh) * | 2021-10-21 | 2021-11-19 | 季华实验室 | 机器人定位放置控制方法、装置、电子设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11422261B2 (en) | Robot relocalization method and apparatus and robot using the same | |
CN112964196B (zh) | 三维扫描方法、系统、电子装置和计算机设备 | |
CN110850872A (zh) | 机器人巡检方法、装置、计算机可读存储介质及机器人 | |
CN110561423B (zh) | 位姿变换的方法、机器人及存储介质 | |
CN108235736B (zh) | 一种定位方法、云端服务器、终端、系统、电子设备及计算机程序产品 | |
CN110749901B (zh) | 自主移动机器人及其地图拼接方法、装置和可读存储介质 | |
CN112595323A (zh) | 机器人及其建图方法和装置 | |
CN112082554A (zh) | 机器人导航方法、装置、终端设备及存储介质 | |
US20210255638A1 (en) | Area Division and Path Forming Method and Apparatus for Self-Moving Device and Automatic Working System | |
CN110858075A (zh) | 一种移动机器人跨区域方法、装置、调度系统 | |
CN112147994B (zh) | 一种机器人及其回充控制方法和装置 | |
CN113095227B (zh) | 一种机器人定位方法、装置、电子设备及存储介质 | |
CN112558611B (zh) | 一种路径规划方法、装置、计算机设备及存储介质 | |
US20240009841A1 (en) | Dynamic target tracking method, robot and computer-readable storage medium | |
CN113776520B (zh) | 地图构建、使用方法、装置、机器人和介质 | |
CN115609594A (zh) | 机械臂路径的规划方法、装置、上位控制端及存储介质 | |
CN112956961B (zh) | 扫地机器人及其重新定位方法、装置和存储介质 | |
CN114415664A (zh) | 一种机器人导航方法及装置 | |
CN109685851B (zh) | 行走机器人的手眼标定方法、系统、设备及存储介质 | |
CN109238286B (zh) | 智能导航方法、装置、计算机设备及存储介质 | |
CN115290066A (zh) | 一种误差校正方法、装置及移动设备 | |
CN115063461A (zh) | 一种误差消除方法、装置及电子设备 | |
CN115855026A (zh) | 一种大型场景图元地图切换方法、系统、装置及存储介质 | |
CN115454073A (zh) | 打孔控制方法、系统、装置和计算机设备 | |
CN113297259A (zh) | 机器人及其环境地图构建方法和装置 |
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 |