CN110637265A - 地面机器人控制方法及地面机器人 - Google Patents
地面机器人控制方法及地面机器人 Download PDFInfo
- Publication number
- CN110637265A CN110637265A CN201880031254.6A CN201880031254A CN110637265A CN 110637265 A CN110637265 A CN 110637265A CN 201880031254 A CN201880031254 A CN 201880031254A CN 110637265 A CN110637265 A CN 110637265A
- Authority
- CN
- China
- Prior art keywords
- information
- waypoints
- waypoint
- ground robot
- preset
- 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 85
- 238000005259 measurement Methods 0.000 claims description 29
- 238000004891 communication Methods 0.000 claims description 22
- 230000007613 environmental effect Effects 0.000 claims description 12
- 239000003550 marker Substances 0.000 claims description 8
- 238000004590 computer program Methods 0.000 claims 1
- 230000004927 fusion Effects 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 6
- 230000001960 triggered effect Effects 0.000 description 3
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006870 function Effects 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
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- 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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种地面机器人控制方法及地面机器人。该方法包括:接收控制终端发送的移动控制指令,并根据该移动控制指令移动;在移动的过程中,记录多个航点的航点信息,该航点信息包括地面机器人的位置信息;当满足预设返航条件时,根据多个航点的航点信息,确定返航轨迹,并根据所述返航轨迹返航。该控制方法提高了地面机器人的智能化程度。该地面机器人(70)包括:处理器(701)以及用于存储计算机指令的存储器(702),处理器(701)运行计算机指令,并按照相应的控制方法确定返航轨迹和返航。
Description
技术领域
本发明涉及机器人技术领域,尤其涉及一种地面机器人控制方法及地面机器人。
背景技术
随着地面机器人技术的不断发展,地面机器人的应用越来越广泛,地面机器人可以在控制终端的控制下执行各种工作任务。
地面机器人往往在复杂的环境中工作,例如地面机器人在较多的障碍物之间移动,由于障碍物的遮挡,控制终端和地面机器人之间的通信可能会丢失,这样地面机器人会失去控制;某些情况中,地面机器人运动至用户的视野之外,用户无法实现对地面机器人的精准控制。上述问题,降低了地面机器人的实用性。
发明内容
本发明提供一种地面机器人控制方法及地面机器人,用于提高地面机器人的智能化程度。
第一方面,本发明提供一种地面机器人控制方法,包括:
接收控制终端发送的移动控制指令,并根据所述移动控制指令移动;
在移动的过程中,记录多个航点的航点信息,所述航点信息包括所述地面机器人的位置信息;
当满足预设返航条件时,根据所述多个航点的航点信息,确定返航轨迹,并根据所述返航轨迹返航。
第二方面,本发明提供一种地面机器人,包括:处理器以及用于存储计算机指令的存储器;所述处理器运行所述计算机指令,用于:
接收控制终端发送的移动控制指令,并根据所述移动控制指令移动;
在移动的过程中,记录多个航点的航点信息,所述航点信息包括所述地面机器人的位置信息;
当满足预设返航条件时,根据所述多个航点的航点信息,确定返航轨迹,并根据所述返航轨迹返航。
本发明实施例提供的地面机器人控制方法及地面机器人,通过在根据控制终端发送的移动控制指令移动的过程中,记录多个航点的航点信息,所述航点信息包括所述地面机器人的位置信息,在满足预设返航条件时,根据所述多个航点的航点信息确定返航轨迹,并根据所述返航轨迹返航,实现了地面机器人的自动返航,提高了地面机器人的智能化程度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请实施例提供的地面机器人控制方法的应用场景示意图;
图2为本申请实施例提供的地面机器人控制方法实施例一的流程图;
图3A为本申请实施例提供的记录航点信息的航点的示意图;
图3B-图3D为本申请实施例提供的在图3A的基础上得到的返航轨迹的示意图;
图4为本申请实施例提供的地面机器人控制方法实施例二的流程图;
图5为本申请实施例提供的地面机器人控制方法的示意图;
图6A和图6B为本申请实施例提供的从多个航点中确定目标航点的示意图;
图7为本申请实施例提供的地面机器人的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明的是,当组件被称为“固定于”另一个组件,它可以直接在另一个组件上或者也可以存在居中的组件。当一个组件被认为是“连接”另一个组件,它可以是直接连接到另一个组件或者可能同时存在居中组件。
除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。本文所使用的术语“及/或”包括一个或多个相关的所列项目的任意的和所有的组合。
下面结合附图,对本发明的一些实施方式作详细说明。在不冲突的情况下,下述的实施例及实施例中的特征可以相互组合。
图1为本申请实施例提供的地面机器人控制方法的应用场景示意图。如图1所示,该应用场景可以包括:控制终端101和地面机器人102。其中,控制终端101可以与地面机器人102无线通讯连接,控制终端101可以对地面机器人102进行控制。其中地面机器人102上可以配置拍摄装置,其中,所述拍摄装置可以包括照相机或者摄影机等,另外,地面机器人102还可以包括云台,其中,拍摄装置可以通过云台连接到地面机器人102的机身上,地面机器人101通过控制云台就可以调整拍摄装置的拍摄姿态。控制终端101具体可以为任何能够用于对地面机器人进行控制的设备,例如遥控器、电脑、智能手机、穿戴式设备中的一种或多种。地面机器人102具体可以为任何能够在地面上移动的机器人,例如扫地机器人、战车机器人等。
图2为本申请实施例提供的地面机器人控制方法实施例一的流程图。本实施例的方法可以由地面机器人执行,具体地,所述方法可以由地面机器人的处理器执行,其中,所述处理器可以为一个或多个,一个或多个处理器单独或协同地工作以执行所述控制方法。如图2所示,本实施例的方法可以包括:
步骤201,接收控制终端发送的移动控制指令,并根据所述移动控制指令移动。
本步骤中,所述移动控制指令具体可以用于控制所述地面机器人移动,例如控制地面机器人前进1米、后退0.5米等。可选的,所述移动控制指令还可以控制所述地面机器人的机身的姿态,例如控制地面机器人左转、右转等;和/或,所述移动控制指令还可以控制所述地面机器人的云台的姿态,例如倾斜、旋转等;和/或,所述移动控制指令还可以控制所述地面机器人执行动作,例如拍照、摄像等。
步骤202,在移动的过程中,记录多个航点的航点信息。所述航点信息包括所述地面机器人的位置信息。
本步骤中,所述航点信息包括所述地面机器人的位置信息。可选的,所述位置信息可以绝对位置信息,或者也可以为相对于参考点的相对位置信息。当为绝对位置信息时,可以通过经纬度表示,可以通过卫星定位装置确定。其中,卫星定位装置例如可以为全球定位系统(Global Positioning System,GPS)装置、实时动态定位(Real Time Kinematic,RTK)装置等。在某些情况中,地面机器人没有配置卫星定位装置,所述位置信息可以为相对位置信息。其中,所述相对位置信息是在以参考点为原点的平面坐标系下的位置坐标,其中,所述参考点可以为地面机器人上电时所处的位置点。例如,现有技术中,地面机器人可以配置惯性测量单元(Inertial Measurement Unit,IMU),并根据惯性测量单元输出的测量数据来确认地面机器人的位置信息,即相对位置信息。
本发明实施例中,地面机器人的位置信息,可以根据地面机器人配置的惯性测量单元输出测量数据和地面机器人配置的编码器输出的测量数据融合确定。具体地,地面机器人可以配置有惯性测量单元和编码器,其中,地面机器人可以配置车轮,编码器可以测量车轮转动的角度。当地面机器人没有配置卫星定位装置时,可以将惯性测量单元输出的测量数据和编码器输出的测量数据融合以确定地面机器人的相对位置信息,例如,可以通过卡尔曼滤波算法将惯性测量单元输出的测量数据和编码器输出的测量数据融合以确定地面机器人的相对位置信息。当地面机器人配置卫星定位装置时,可以将卫星定位装置输出的测量数据、惯性测量单元输出的测量数据和编码器输出的测量数据融合以确定地面机器人的相对位置信息,例如,可以通过卡尔曼滤波算法将卫星定位装置输出的测量数据、惯性测量单元输出的测量数据和编码器输出的测量数据融合以确定地面机器人的绝对位置信息。
可选的,可以将多个航点的航点信息记录到存储器中。其中,所述存储器可以为外设存储器,例如U盘、存储卡;或者,所述存储器也可以为本地存储器,例如主存储器,缓存(buffer)。
在地面机器人移动的过程中,当满足预设触发条件时,记录多个航点的航点信息。当不满足预设触发条件时,不记录航点的航点信息。通过这种方式,可以有效地节省地面机器人的存储空间。可选的,所述预设触发条件可以为预设时间条件、预设距离条件、预设事件条件等。
例如,当检测到与控制终端之间的距离大于或等于预设距离阈值时,记录多个航点的航点信息。具体地,在移动的过程中,地面机器人检测与控制终端之间的距离,当地面机器人与控制终端之间的距离大于或等于预设距离阈值,说明控制终端与地面机器人之间可能存在通讯断开的可能性,或者地面机器人可能移动至用户的视野之外,地面机器人开始记录多个航点信息。
再例如,当检测到从控制终端接收到的移动控制指令的信号强度小于或等于预设信号强度阈值时,记录多个航点的航点信息。具体地,在移动的过程中,地面机器人检测从控制终端接收到的移动控制指令的信号强度,当检测到所述信号强度小于或等于预设信号强度阈值时,说明控制终端与地面机器人之间可能存在通讯断开的可能性,或者地面机器人可能移动至用户的视野之外,地面机器人开始记录多个航点信息。
需要说明的是,地面机器人持续移动的过程,以及地面机器人移动与静止交替的过程,均可以理解为移动机器人移动的过程。
步骤203,当满足预设返航条件时,根据所述多个航点的航点信息,确定返航轨迹,并根据所述返航轨迹返航。
本步骤中,所述预设返航条件可以理解为需要触发地面机器人自动返航的任意条件,例如可以为移动距离大于100米,或者移动时长大于2小时等。可选的,可以由控制终端触发地面机器人自动返航,或者,也可以由地面机器人触发自动返航;或者,还可以由除控制终端以及地面机器人之外的其他设备触发地面机器人自动返航。
可选的,可以根据所述多个航点中所有航点的航点信息,确定返航轨迹,此时所述返航航迹可以由所述多个航点的航点信息确定;或者,也可以根据所述多个航点中部分航点的航点信息,确定返航轨迹,此时所述返航轨迹可以由所述部分航点的航点信息确定。
例如,如图3A所示,假设地面机器人根据控制终端沿箭头方向所示的移动路径移动的过程中,记录了a1、a2、a3、a4和a5,5个航点的航点信息,则根据这5个航点的航点信息确定的返航轨迹可以如图3B-图3D所示。
其中,对于图3B所示的返航轨迹,所述返航轨迹可以根据所述多个航点的航线信息来拟合确定。地面机器人可以通过如下方式根据返航航迹返航:第一步,地面机器人由a5移动至a4;第二步,地面机器人由a4移动至a3;第三步,地面机器人由a3移动至a2;第四步,地面机器人由a2移动至a1。
对于图3C所示的返航轨迹,所述返航轨迹可以根据所述多个航点中部分航点(例如航点a1、a3和a5)的航线信息来拟合确定。地面机器人可以通过如下方式根据返航航迹返航:第一步,地面机器人由a5移动至a3;第二步,地面机器人由a3移动至a1。
对于图3D所示的返航轨迹,所述返航轨迹可以根据所述多个航点中部分航点(例如航点a2、a4和a5)的航线信息来拟合确定。地面机器人可以通过如下方式根据返航航迹返航:第一步,地面机器人由a5移动至a4;第二步,地面机器人由a4移动至a2。
可以看出,组成返航航线的航点数目越多,地面机器人根据返航轨迹返航时,移动的步数越多,返航过程越复杂。
需要说明的是,图3B和图3C中的a1以及图3D中的a2可以理解为返航的终点。
本实施例中,通过在根据控制终端发送的移动控制指令移动的过程中,记录多个航点的航点信息,所述航点信息包括所述地面机器人的位置信息,在满足预设返航条件时,根据所述多个航点的航点信息确定返航轨迹,并根据所述返航轨迹返航,实现了地面机器人的自动返航,提高了地面机器人的智能化程度。并且,本实施例提供的地面机器人控制方法并不限定地面机器人上必须安装卫星定位装置,从而避免了必须安装卫星定位装置才能实现自动返航时,成本较大或无法提供自动返航功能的问题。
图4为本申请实施例提供的地面机器人控制方法实施例二的流程图。本实施例在上述图2所示实施例的基础上,主要描述了一种具体实现方式。如图4所示,本实施例的方法可以包括:
步骤401,接收控制终端发送的移动控制指令,并根据所述移动控制指令移动。
需要说明的是,步骤401与步骤201类似,在此不再赘述。
步骤402,在移动的过程中,记录多个航点的航点信息。
本步骤中,可选的,步骤402具体可以包括:在移动的过程中,按照预设时间间隔,记录多个航点的航点信息。例如,在移动的过程中,每隔5秒,记录一次航点的航点信息。或者,步骤403具体可以包括:在移动的过程中,按照预设距离间隔,记录多个航点的航点信息。例如,在移动的过程中,每隔2米,记录一次航点的航点信息。需要说明的是,预设时间间隔、预设距离间隔越短,则记录的频率越高,记录的航点的数量越多,可提供的精度越高。
可选的,航点信息可以保存在存储器的存储区域中,在存储区域已满的情况下,新增的航点信息可以将最早记录的航点信息覆盖。
所述航点信息包括所述地面机器人的位置信息,所述返航轨迹可以根据所述多个航点的航点信息中的位置信息来拟合确定。由于所述移动控制指令还可以控制所述地面机器人机身的姿态、云台的姿态,执行动作等。可选的,所述航点信息还可以包括所述地面机器人机身的姿态信息、所述地面机器人云台的姿态信息、所述地面机器人执行动作的动作信息中的一种或多种。其中,航点信息包括地面机器人机身的姿态信息,使得地面机器人自动返航的过程中,可以根据航点信息控制地面机器人的机身的姿态。航点信息包括地面机器人云台的姿态信息,使得地面机器人返航的过程中,可以根据航点信息控制地面机器人的云台的姿态。航点信息包括所述地面机器人执行动作的动作信息,使得地面机器人自动返航的过程中,可以根据航点信息控制地面机器人执行动作。
如图5所示,在移动过程中,地面机器人可以通过惯性测量单元和编码器,分别获得A、B、C、D四个航点在以O为坐标原点的平面直角坐标系的坐标A(x1,y1,θ1),B(x2,y2,θ2),C(x3,y3,θ3),D(x4,y4,θ4),其中,所述x和y表示地面机器人的位置信息,所述θ可以为地面机器人的姿态,其中,所述θ可以为地面机器人的机头与坐标系Y轴之间的夹角。可以立即理解的是,所述θ也可以通过地面机器人的正前方与坐标系X轴之间的夹角。
可选的,在移动过程中,地面机器人还可以记录环境信息。可选的,所述环境信息可以包括障碍物信息和/或标记物信息。所述环境信息可以通过环境传感器获取,其中,环境传感器可以包括视觉传感器、激光雷达、超声波传感器、TOF传感器中的一种或多种。所述障碍物信息具体可以为障碍物在参考点为坐标原点的平面坐标系下的坐标、障碍物的图像和地面机器人与障碍物之间的距离中的一种或多种。所述标记物信息具体可以为标记物在参考点为坐标原点的平面坐标系下的坐标、标定物的数量、障碍物的图像和地面机器人与障碍物之间的距离中的一种或多种。其中,所述标记物例如可以为具有特定标识的物体,例如地砖,所述标记物信息例如可以为地砖宽度。
进一步可选的,本实施例的方法还可以包括:根据所述环境信息对所述多个航点的航点信息中的位置信息进行修正。相应的,所述根据所述多个航点的航点信息确定返航轨迹,具体可以包括:根据所述修正后的多个航点信息确定返航轨迹。例如,假设已知地砖宽度为70厘米,通过摄像头确定相邻的两个航点之间经过了一块地砖宽度的距离,然而根据相邻的两个航点的位置信息确定两个航点之间的距离为60厘米,因此,可以根据已知地砖宽度70厘米,以及两个航点之间的距离60厘米,对相邻两个航点中后一个航点的位置信息进行修正。
步骤403,当满足预设返航条件时,从所述多个航点中确定至少两个符合预设航点要求的目标航点。
本步骤中,可选的,所述预设返航条件包括:与所述控制终端通讯断开,和/或,接收到控制终端发送的自动返航指令。需要说明的是,地面机器人与控制终端通讯断开,与地面机器人与控制终端通讯连接相对。当地面机器人与控制终端通讯连接时,地面机器人与控制终端之间能够进行通信,例如,地面机器人可以接收控制终端发送的移动控制命令或自动返航指令。当地面机器人与控制终端通讯断开时,地面机器人与控制终端之间无法进行通信,例如,地面机器人接收不到控制终端发送的信号,例如所述移动控制指令。
其中,与控制终端通信断开的预设返航条件,例如可以应用于如下两种场景:场景1,在室内环境中,当地面机器人移动至拐角,并与控制终端之间相隔多个墙体,由于墙体的遮挡,移动控制指令不能到达地面机器人,导致地面机器人与控制终端之间的通讯断开时,触发地面机器人自动返航。场景2,当地面机器人移动至距离控制终端太远,控制终端发送的移动控制指令到达地面机器人时信号强度太小而无法解析,导致地面机器人与控制终端通讯断开时,触发地面机器人自动返航。
如图5所示,假设控制终端S发送的信号(例如移动控制指令)覆盖范围为S1至S2区域,S3区域为无信号区域,则地面机器人在移动过程中,可以对控制终端的信号强度进行监控,当处于S3区域时,地面机器人确定搜索不到控制终端发送的信号,即确定与控制终端之间的通讯断开时,触发返航。
可以看出,通过与所述控制终端通讯断开作为预设返航条件,可以解决在复杂环境中地面机器人丢失控制终端的信号但操作员不便接近已通信断开机器人时易丢失或损坏对面机器人的问题,提升了地面机器人在复杂环境下的灵活性与安全性。
可选的,所述自动返航指令为控制终端检测用户的返航指示操作确定的,控制终端将所述自动返航指令发送给地面机器人,地面机器人在收到所述指令时,根据所述返航轨迹返航。
可以看出,通过接收到自动返航指令作为预设返航条件,可以提升地面机器人的操作灵活性。
可选的,所述符合预设航点要求包括:与相邻的上一个航点之间的距离大于或等于预设距离;和/或,与相邻的上一个航点之间的连线和与相邻的下一个航点之间的连线之间的夹角大于或等于第一预设角度;和/或,与相邻的上一个航点之间的连线和与相邻的下一个航点之间的连线之间的夹角小于或等于第二预设角度。
例如,如图6A所示,假设多个航点包括航点a1、航点b1、航点c1和航点d1,航点b1与相邻的上一个航点a1之间的距离L1小于预设距离,航点c1与相邻的上一个航点b1之间的距离L2,以及航点d1与相邻的上一个航点c1之间的距离L3均大于预设距离,则从航点a1-航点d1中确定的目标航点可以至少包括航点c1和航点d1,在某些情况中,目标航点还包括航点a1。
又例如,如图6B所示,假设多个航点包括航点a2、航点b2、航点c2、航点d2和航点e2。航点b2与相邻的上一个航点a2之间的连线Z1,航点b2和相邻的下一个航点c2之间的连线Z2,Z1和Z2之间的夹角θabc小于第一预设角度;航点c2与相邻的上一个航点b2之间的连线Z2,航点c2和相邻的下一个航点d2之间的连线Z3,Z2和Z3之间的夹角θbcd大于第一预设角度;航点d2与相邻的上一个航点c2之间的连线Z3,航点d2和航点e2之间的连线Z3,3和Z4之间的夹角θcde大于第一预设角度,则从航点a2-航点e2中确定的目标航点可以至少包括航点c2和航点d2,在某些实施例中,所述目标航点还包括航点a2和/或航点e2。
又例如,如图6B所示,假设多个航点包括航点a2、航点b2、航点c2、航点d2和航点e2。航点b2与相邻的上一个航点a2之间的连线Z1,航点b2和相邻的下一个航点c2之间的连线Z2,Z1和Z2之间的夹角θabc小于第二预设角度;航点c2与相邻的上一个航点b2之间的连线Z2,航点c2和相邻的下一个航点d2之间的连线Z3,Z2和Z3之间的夹角θbcd小于第二预设角度;航点d2与相邻的上一个航点c2之间的连线Z3,航点d2和航点e2之间的连线Z3,3和Z4之间的夹角θcde大于第二预设角度,则从航点a2-航点e2中确定的目标航点可以至少包括航点b2和航点c2,在某些实施例中,所述目标航点还包括航点a2和/或航点e2。
需要说明的是,如图6A和图6B所示,本实施例中两个连线之间的夹角仅是指两个有限长度的连线所形成的夹角,并不是指两个连线中一个连线与另一个连线的延长线所形成的夹角。其中,所述夹角可以大于或等于0°,且小于或等于180°。
步骤404,根据所述至少两个目标航点的航点信息确定返航轨迹,并根据所述返航轨迹返航。
本步骤中,可选的,当地面机器人与所述控制终端通讯断开时,本实施例的方法还可以包括:在返航的过程中,搜索所述控制终端发送的信号,例如,在返航的过程中,地面机器人会搜索控制终端发送的移动控制指令,重新建立与控制终端之间的通讯。在某些情况中,地面机器人会返航至与所述控制终端通讯连接的位置。这里,通过返航至与所述控制终端通讯连接的位置,使得地面机器人可以接收控制终端的移动控制指令。
可选的,在所述地面机器人根据所述返航轨迹返航的过程中,本实施例的方法还可以包括:接收所述控制终端发送的暂停返航指令,并根据所述暂停返航指令暂停返航;或者,接收所述控制终端发送的取消返航指令,并根据所述取消返航指令取消返航。这里,通过地面机器人根据控制终端发送的暂停返航指令暂停返航,或者取消返航指令取消返航,提高了地面机器人返航控制的灵活性。
本实施例中,通过在根据控制终端发送的移动控制指令移动的过程中,记录多个航点的航点信息,所述航点信息包括所述地面机器人的位置信息,在满足预设返航条件时,从所述多个航点中确定至少两个符合预设航点要求的目标航点,根据所述至少两个目标航点的航点信息确定返航轨迹,并根据所述返航轨迹返航,实现了基于记录的所有航点中满足预设航点要求的部分航点确定返航轨迹并返航,从而能够确保返航轨迹与航行轨迹基本一致的前提下,减少返航的步数,简化地面机器人的返航过程。
图7为本申请实施例提供的地面机器人的结构示意图。如图7所示,本实施例提供的地面机器人70可以包括处理器701以及用于存储计算机指令的存储器702,处理器701运行所述计算机指令;
其中,处理器701,用于:
接收控制终端发送的移动控制指令,并根据所述移动控制指令移动;
在移动的过程中,记录多个航点的航点信息,所述航点信息包括所述地面机器人的位置信息;
当满足预设返航条件时,根据所述多个航点的航点信息,确定返航轨迹,并根据所述返航轨迹返航。
可选的,处理器701根据所述多个航点的航点信息,确定返航轨迹时,具体用于:
从所述多个航点中确定至少两个符合预设航点要求的目标航点;
根据所述至少两个目标航点的航点信息确定返航轨迹。
可选的,所述符合预设航点要求包括:
与相邻的上一个航点之间的距离大于或等于预设距离;和/或,与相邻的上一个航点之间的连线和与相邻的下一个航点之间的连线之间的夹角大于或等于第一预设角度;和/或,与相邻的上一个航点之间的连线和与相邻的下一个航点之间的连线之间的夹角小于或等于第二预设角度。
可选的,所述预设返航条件包括:与所述控制终端通讯断开;或者,接收控制终端发送的自动返航指令。
可选的,当与所述控制终端通讯断开时,处理器701,还用于在返航的过程中,搜索所述控制终端发送的信号。
可选的,处理器701在移动的过程中,记录多个航点的航点信息时,具体用于:
在移动的过程中,按照预设时间间隔或预设距离间隔记录多个航点的航点信息。
或者,处理器701在移动的过程中,记录多个航点的航点信息时,具体用于:
在移动的过程中,当满足预设触发条件时,记录多个航点的航点信息。
可选的,处理器701当满足预设触发条件时,记录多个航点的航点信息时,具体用于:
当检测到与所述控制终端之间的距离大于或等于预设距离阈值时,记录多个航点的航点信息。
可选的,处理器701当满足预设触发条件时,记录多个航点的航点信息时,具体用于:
当检测到从所述控制终端接收到的所述移动控制指令的信号强度小于或等于预设信号强度阈值时,记录多个航点的航点信息。
可选的,处理器701,还用于:在移动的过程中,记录环境信息,所述环境信息包括障碍物信息和/或标记物信息。
可选的,处理器701,还用于根据所述环境信息对所述多个航点的航点信息中的位置信息进行修正;
处理器701根据所述多个航点的航点信息确定返航轨迹时,具体用于:
根据所述修正后的多个航点信息确定返航轨迹。
可选的,所述位置信息是根据所述地面机器人上配置的惯性测量单元输出测量数据和所述地面机器人上配置的编码器输出的测量数据融合确定的。
可选的,所述航点信息还包括所述地面机器人机身的姿态信息、所述地面机器人云台的姿态信息、所述地面机器人执行动作的动作信息中的一种或多种。
可选的,本实施例提供的地面机器人还可以包括:传感器,所述传感器用于获取所述航点信息。
处理器701记录多个航点的航点信息时,具体用于:从所述传感器获取多个航点的航点信息,并记录到存储器702。
本实施例提供的地面机器人,可以用于执行前述方法实施例的技术方案,其实现原理和技术效果与方法实施例类似,在此不再赘述。
本领域普通技术人员可以理解:实现上述各方法实施例的全部或部分步骤可以通过程序指令相关的硬件来完成。前述的程序可以存储于一计算机可读取存储介质中。该程序在执行时,执行包括上述各方法实施例的步骤;而前述的存储介质包括:ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (27)
1.一种地面机器人控制方法,其特征在于,包括:
接收控制终端发送的移动控制指令,并根据所述移动控制指令移动;
在移动的过程中,记录多个航点的航点信息,所述航点信息包括所述地面机器人的位置信息;
当满足预设返航条件时,根据所述多个航点的航点信息,确定返航轨迹,并根据所述返航轨迹返航。
2.根据权利要求1所述的方法,其特征在于,所述根据所述多个航点的航点信息,确定返航轨迹,包括:
从所述多个航点中确定至少两个符合预设航点要求的目标航点;
根据所述至少两个目标航点的航点信息确定返航轨迹。
3.根据权利要求2所述的方法,其特征在于,所述符合预设航点要求包括:
与相邻的上一个航点之间的距离大于或等于预设距离;和/或,与相邻的上一个航点之间的连线和与相邻的下一个航点之间的连线之间的夹角大于或等于第一预设角度;和/或,与相邻的上一个航点之间的连线和与相邻的下一个航点之间的连线之间的夹角小于或等于第二预设角度。
4.根据权利要求1-3任一项所述的方法,其特征在于,所述满足预设返航条件包括:与所述控制终端通讯断开;或者,接收到所述控制终端发送的自动返航指令。
5.根据权利要求4所述的方法,其特征在于,当与所述控制终端通讯断开时,所述方法还包括:
在返航的过程中,搜索所述控制终端发送的信号。
6.根据权利要求1-5任一项所述的方法,其特征在于,所述在移动的过程中,记录多个航点的航点信息,包括:
在移动的过程中,按照预设时间间隔或预设距离间隔记录多个航点的航点信息。
7.根据权利要求1-5任一项所述的方法,其特征在于,所述在移动的过程中,记录多个航点的航点信息,包括:
在移动的过程中,当满足预设触发条件时,记录多个航点的航点信息。
8.根据权利要求7所述的方法,其特征在于,所述当满足预设触发条件时,记录多个航点的航点信息,包括:
当检测到与所述控制终端之间的距离大于或等于预设距离阈值时,记录多个航点的航点信息。
9.根据权利要求7所述的方法,其特征在于,所述当满足预设触发条件时,记录多个航点的航点信息,包括:
当检测到从所述控制终端接收到的所述移动控制指令的信号强度小于或等于预设信号强度阈值时,记录多个航点的航点信息。
10.根据权利要求1-9任一项所述的方法,其特征在于,所述方法还包括:
在移动的过程中,记录环境信息,所述环境信息包括障碍物信息和/或标记物信息。
11.根据权利要求10所述的方法,其特征在于,所述方法还包括:
根据所述环境信息对所述多个航点的航点信息中的位置信息进行修正;
所述根据所述多个航点的航点信息确定返航轨迹,包括:
根据所述修正后的多个航点信息确定返航轨迹。
12.根据权利要求1-11任一项所述的方法,其特征在于,所述位置信息是根据所述地面机器人上配置的惯性测量单元输出测量数据和所述地面机器人上配置的编码器输出的测量数据融合确定的。
13.根据权利要求1-12任一项所述的方法,其特征在于,所述航点信息还包括所述地面机器人机身的姿态信息、所述地面机器人云台的姿态信息、所述地面机器人执行动作的动作信息中的一种或多种。
14.一种地面机器人,其特征在于,包括:
存储器,用于存储计算机指令;
处理器,运行所述计算机指令,用于:
接收控制终端发送的移动控制指令,并根据所述移动控制指令移动;
在移动的过程中,记录多个航点的航点信息,所述航点信息包括所述地面机器人的位置信息;
当满足预设返航条件时,根据所述多个航点的航点信息,确定返航轨迹,并根据所述返航轨迹返航。
15.根据权利要求14所述的地面机器人,其特征在于,所述处理器根据所述多个航点的航点信息,确定返航轨迹时,具体用于:
从所述多个航点中确定至少两个符合预设航点要求的目标航点;
根据所述至少两个目标航点的航点信息确定返航轨迹。
16.根据权利要求15所述的地面机器人,其特征在于,所述符合预设航点要求包括:
与相邻的上一个航点之间的距离大于或等于预设距离;和/或,与相邻的上一个航点之间的连线和与相邻的下一个航点之间的连线之间的夹角大于或等于第一预设角度;和/或,与相邻的上一个航点之间的连线和与相邻的下一个航点之间的连线之间的夹角小于或等于第二预设角度。
17.根据权利要求14-16任一项所述的地面机器人,其特征在于,所述预设返航条件包括:与所述控制终端通讯断开;或者,接收到所述控制终端发送的自动返航指令。
18.根据权利要求17所述的地面机器人,其特征在于,当与所述控制终端通讯断开时,所述处理器,还用于在返航的过程中,搜索所述控制终端发送的信号。
19.根据权利要求14-18任一项所述的地面机器人,其特征在于,所述处理器在移动的过程中,记录多个航点的航点信息时,具体用于:
在移动的过程中,按照预设时间间隔或预设距离间隔记录多个航点的航点信息。
20.根据权利要求14-18任一项所述的地面机器人,其特征在于,所述处理器在移动的过程中,记录多个航点的航点信息时,具体用于:
在移动的过程中,当满足预设触发条件时,记录多个航点的航点信息。
21.根据权利要求20所述的地面机器人,其特征在于,所述处理器当满足预设触发条件时,记录多个航点的航点信息时,具体用于:
当检测到与所述控制终端之间的距离大于或等于预设距离阈值时,记录多个航点的航点信息。
22.根据权利要求20所述的地面机器人,其特征在于,所述处理器当满足预设触发条件时,记录多个航点的航点信息时,具体用于:
当检测到从所述控制终端接收到的所述移动控制指令的信号强度小于或等于预设信号强度阈值时,记录多个航点的航点信息。
23.根据权利要求14-22任一项所述的地面机器人,其特征在于,所述处理器,还用于:在移动的过程中,记录环境信息,所述环境信息包括障碍物信息和/或标记物信息。
24.根据权利要求23所述的地面机器人,其特征在于,所述处理器,还用于根据所述环境信息对所述多个航点的航点信息中的位置信息进行修正;
所述处理器根据所述多个航点的航点信息确定返航轨迹时,具体用于:
根据所述修正后的多个航点信息确定返航轨迹。
25.根据权利要求14-24任一项所述的地面机器人,其特征在于,所述位置信息是根据所述地面机器人上配置的惯性测量单元输出测量数据和所述地面机器人上配置的编码器输出的测量数据融合确定的。
26.根据权利要求14-25任一项所述的地面机器人,其特征在于,所述航点信息还包括所述地面机器人机身的姿态信息、所述地面机器人云台的姿态信息、所述地面机器人执行动作的动作信息中的一种或多种。
27.一种可读存储介质,其特征在于,所述可读存储介质中存储有计算机程序,当可移动平台的至少一个处理器执行所述计算机程序时,可移动平台执行权利要求1-13任一项所述的方法。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2018/088851 WO2019227307A1 (zh) | 2018-05-29 | 2018-05-29 | 地面机器人控制方法及地面机器人 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110637265A true CN110637265A (zh) | 2019-12-31 |
Family
ID=68697724
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201880031254.6A Pending CN110637265A (zh) | 2018-05-29 | 2018-05-29 | 地面机器人控制方法及地面机器人 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN110637265A (zh) |
WO (1) | WO2019227307A1 (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113614670A (zh) * | 2020-02-28 | 2021-11-05 | 深圳市大疆创新科技有限公司 | 无人机的返航控制方法和设备 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040210346A1 (en) * | 2003-04-15 | 2004-10-21 | Samsung Electronics Co., Ltd. | Method and apparatus for allowing mobile robot to return to docking station |
CN202471085U (zh) * | 2011-07-17 | 2012-10-03 | 张杰夫 | 一种导航装置 |
CN106976099A (zh) * | 2017-06-07 | 2017-07-25 | 杭州派尼澳电子科技有限公司 | 一种电磁循迹的智能机器人送餐系统 |
CN107030695A (zh) * | 2017-04-19 | 2017-08-11 | 广州视源电子科技股份有限公司 | 机器人返回原点运动控制方法和系统 |
CN107414837A (zh) * | 2017-09-13 | 2017-12-01 | 上海伟世通汽车电子系统有限公司 | 工业机器人非正常停机后安全自动回原位的方法及其系统 |
CN107783550A (zh) * | 2016-08-26 | 2018-03-09 | 北京臻迪机器人有限公司 | 控制无人机返航的方法及装置 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11320467A (ja) * | 1998-05-08 | 1999-11-24 | Marusan Seiyaku Kk | 遠隔操作型作業用ロボット |
CN103507067B (zh) * | 2012-06-15 | 2016-01-20 | 华硕电脑股份有限公司 | 机器人装置以及导引机器人返回基站的方法 |
US9283674B2 (en) * | 2014-01-07 | 2016-03-15 | Irobot Corporation | Remotely operating a mobile robot |
CN205608520U (zh) * | 2016-04-27 | 2016-09-28 | 河北德普电器有限公司 | 一种机器人电量检测自动返航系统 |
CN106826821A (zh) * | 2017-01-16 | 2017-06-13 | 深圳前海勇艺达机器人有限公司 | 基于图像视觉引导的机器人自动返回充电的方法和系统 |
-
2018
- 2018-05-29 CN CN201880031254.6A patent/CN110637265A/zh active Pending
- 2018-05-29 WO PCT/CN2018/088851 patent/WO2019227307A1/zh active Application Filing
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040210346A1 (en) * | 2003-04-15 | 2004-10-21 | Samsung Electronics Co., Ltd. | Method and apparatus for allowing mobile robot to return to docking station |
CN202471085U (zh) * | 2011-07-17 | 2012-10-03 | 张杰夫 | 一种导航装置 |
CN107783550A (zh) * | 2016-08-26 | 2018-03-09 | 北京臻迪机器人有限公司 | 控制无人机返航的方法及装置 |
CN107030695A (zh) * | 2017-04-19 | 2017-08-11 | 广州视源电子科技股份有限公司 | 机器人返回原点运动控制方法和系统 |
CN106976099A (zh) * | 2017-06-07 | 2017-07-25 | 杭州派尼澳电子科技有限公司 | 一种电磁循迹的智能机器人送餐系统 |
CN107414837A (zh) * | 2017-09-13 | 2017-12-01 | 上海伟世通汽车电子系统有限公司 | 工业机器人非正常停机后安全自动回原位的方法及其系统 |
Non-Patent Citations (1)
Title |
---|
高波 等: "基于SLAM的移动机器人自主返航控制系统设计", 《机器人技术与应用》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113614670A (zh) * | 2020-02-28 | 2021-11-05 | 深圳市大疆创新科技有限公司 | 无人机的返航控制方法和设备 |
Also Published As
Publication number | Publication date |
---|---|
WO2019227307A1 (zh) | 2019-12-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1926007B1 (en) | Method and system for navigation of an unmanned aerial vehicle in an urban environment | |
US10165233B2 (en) | Information processing method, electronic device and computer storage medium | |
CN107992052B (zh) | 目标跟踪方法及装置、移动设备及存储介质 | |
US8315794B1 (en) | Method and system for GPS-denied navigation of unmanned aerial vehicles | |
CN107328418B (zh) | 移动机器人在陌生室内场景下的核辐射探测路径自主规划方法 | |
US11906983B2 (en) | System and method for tracking targets | |
CN108885470B (zh) | 一种任务执行方法、移动装置、系统及存储介质 | |
KR102219843B1 (ko) | 자율주행을 위한 위치 추정 장치 및 방법 | |
CN110687928A (zh) | 降落控制方法,系统,无人机及存储介质 | |
Kandath et al. | Autonomous navigation and sensorless obstacle avoidance for UGV with environment information from UAV | |
CA2569209A1 (en) | Image-augmented inertial navigation system (iains) and method | |
Dang et al. | Field-hardened robotic autonomy for subterranean exploration | |
CN109974713B (zh) | 一种基于地表特征群的导航方法及系统 | |
US9246749B1 (en) | Method for automatic recovery of lost communications for unmanned ground robots | |
CN115454077A (zh) | 自动割草机及其控制方法和计算机可读存储介质 | |
Watanabe et al. | Simultaneous visual target tracking and navigation in a GPS-denied environment | |
KR20150041898A (ko) | Gps/ins 위치 정보 보정 장치 및 방법 | |
JP2005262378A (ja) | 自律ロボットおよびその制御方法 | |
CN110637265A (zh) | 地面机器人控制方法及地面机器人 | |
CN113014658B (zh) | 设备控制及装置、电子设备、存储介质 | |
Fusic et al. | A review of perception-based navigation system for autonomous mobile robots | |
CN111580530B (zh) | 一种定位方法、装置、自主移动设备及介质 | |
EP3757617A1 (en) | Wearable dead reckoning system for gps-denied navigation | |
JP7138041B2 (ja) | 移動体 | |
US11926038B2 (en) | Information processing apparatus and information processing method |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20191231 |
|
WD01 | Invention patent application deemed withdrawn after publication |