CN108873875B - 机器人转向运动控制方法和装置、机器人、存储介质 - Google Patents

机器人转向运动控制方法和装置、机器人、存储介质 Download PDF

Info

Publication number
CN108873875B
CN108873875B CN201710319253.9A CN201710319253A CN108873875B CN 108873875 B CN108873875 B CN 108873875B CN 201710319253 A CN201710319253 A CN 201710319253A CN 108873875 B CN108873875 B CN 108873875B
Authority
CN
China
Prior art keywords
robot
virtual
rotation angle
obstacle
speed
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
Application number
CN201710319253.9A
Other languages
English (en)
Other versions
CN108873875A (zh
Inventor
请求不公布姓名
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Huadian Group Co ltd Qinghai Branch
Original Assignee
China Huadian Group Co ltd Qinghai Branch
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by China Huadian Group Co ltd Qinghai Branch filed Critical China Huadian Group Co ltd Qinghai Branch
Priority to CN201710319253.9A priority Critical patent/CN108873875B/zh
Priority to PCT/CN2018/079845 priority patent/WO2018205751A1/zh
Publication of CN108873875A publication Critical patent/CN108873875A/zh
Application granted granted Critical
Publication of CN108873875B publication Critical patent/CN108873875B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • 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/12—Target-seeking control

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)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种机器人转向运动控制方法和装置、机器人、存储介质。其中，该方法包括：根据机器人的位置信息和外部环境信息计算目标物对机器人产生的虚拟引力和障碍物对机器人产生的虚拟斥力；获取与虚拟合力相关联的第一角度变化，其中，虚拟合力由虚拟引力和虚拟斥力确定；计算与虚拟合力相关联的速度变化；获取与速度变化相关联的第二角度变化；根据第一角度变化和第二角度变化计算目标转角；控制机器人按照目标转角进行转向。本发明解决了现有技术基于人工势场法避障技术中障碍物处于机器人和目标之间且障碍物和目标都在机器人正前方时无法避障的技术问题。

Description

机器人转向运动控制方法和装置、机器人、存储介质
技术领域
本发明涉及控制领域，具体而言，涉及一种机器人转向运动控制方法和装置、机器人、存储介质。
背景技术
随着机器人技术的进步，移动机器人与人的互动已经成为了机器人技术发展的一个方向。当人和机器人出现在同一个环境中时，避免人机碰撞是需要首先解决的一个问题。由于人会移动，所以无法通过事先对环境的建模来避开。为了避开像人这样的无法事先预测的障碍物，需要为机器人设计一个实时的避障算法。
目前，对于一些基于人工智能的避障算法，如遗传算法和神经网络算法等，由于计算相对复杂，不易实现实时控制。在未知环境中解决避障问题时，人工势场法由于其数学上的简洁性，成为了移动机器人实时避障的首选方法。人工势场法是由Khatbi提出的一种机器人路径规划方法(Oussama Khatib，Real-Time obstacle Avoidance for Manipulatorsand Mobile Robots.Proc of The 1994 IEEE.)。该算法将机器人在环境中的运动看成是在人造的引力场中的运动。在这个引力场中，目标物对机器人产生引力，障碍物对机器人产生斥力，通过计算机器人在这个引力场中所受到的合力来改变机器人的运动。
人工势场法避障有一个缺陷就是当机器人所受的合力方向与机器人运动方向相反(即目标物与障碍物都处于机器人运动方向上，且障碍物在机器人与目标物之间)时，这个合力只会令机器人减速停下，不会导致机器人的转向，所以机器人无法绕过这个障碍，只会在这条线上来回运动。
针对上述的问题，目前尚未提出有效的解决方案。
发明内容
本发明实施例提供了一种机器人转向运动控制方法和装置、机器人、存储介质，以至少解决现有技术基于人工势场法避障技术中障碍物处于机器人和目标之间且障碍物和目标都在机器人正前方时无法避障的技术问题。
根据本发明实施例的一个方面，提供了一种机器人转向运动控制方法，包括：根据机器人的位置信息和外部环境信息计算目标物对所述机器人产生的虚拟引力和障碍物对所述机器人产生的虚拟斥力；获取与虚拟合力相关联的第一角度变化，其中，所述虚拟合力由所述虚拟引力和所述虚拟斥力确定；计算与所述虚拟合力相关联的速度变化；获取与所述速度变化相关联的第二角度变化；根据所述第一角度变化和所述第二角度变化计算目标转角；控制所述机器人按照所述目标转角进行转向。
进一步地，获取与所述速度变化关联的第二角度变化包括：将所述速度变化与预设系数相乘，得到所述第二角度变化。
进一步地，控制所述机器人按照所述目标转角进行转向，包括：判断所述目标转角是否大于第一预设转角；如果所述目标转角大于所述第一预设转角，控制所述机器人按照所述目标转角进行转向，并控制所述机器人以第一速度向前运动。
进一步地，如果所述目标转角小于等于所述第一预设转角，控制所述机器人按照所述目标转角进行转向，并控制所述机器人以第二速度向前运动，其中，所述第二速度大于所述第一速度。
进一步地，控制所述机器人以第二速度向前运动，包括：根据以下公式计算所述第二速度：其中，v表示所述第二速度，vmax表示所述第二速度所能取到的最大值，ωmax表示所述第一预设转角，ω表示所述目标转角，ω∈[0,ωmax]。
进一步地，获取与虚拟合力相关联的第一角度变化，包括：根据矢量合成法对所述虚拟引力和所述虚拟斥力进行合成，得到所述虚拟合力，并根据所述虚拟合力得到所述第一角度变化。
进一步地，根据所述第一角度变化和所述第二角度变化计算目标转角，包括：将所述第一角度变化和所述第二角度变化按照预设权重进行加权，得到所述目标转角。
进一步地，根据机器人的位置信息计算目标物对所述机器人产生的虚拟引力和障碍物对所述机器人产生的虚拟斥力，包括：根据以下公式计算所述虚拟引力和所述虚拟斥力：其中，Fatt表示所述目标物对所述机器人产生的虚拟引力，Frep(i)表示第i个方向上所述障碍物对所述机器人产生的虚拟斥力(i＝1,2,3；分别表示前方、左方和右方)，k1和k2分别表示虚拟引力和虚拟斥力的系数，dgoal表示所述目标物与所述机器人之间的距离，drep(i)表示第i个方向上所述障碍物与所述机器人之间的距离。
根据本发明实施例的另一方面，还提供了一种机器人转向运动控制装置，包括：第一计算单元，用于根据机器人的位置信息和外部环境信息计算目标物对所述机器人产生的虚拟引力和障碍物对所述机器人产生的虚拟斥力；第一获取单元，用于获取与虚拟合力相关联的第一角度变化，其中，所述虚拟合力由所述虚拟引力和所述虚拟斥力确定；第二计算单元，用于计算与所述虚拟合力相关联的速度变化；第二获取单元，用于获取所述速度变化相关联的第二角度变化；第三计算单元，用于根据所述第一角度变化和所述第二角度变化计算目标转角；控制单元，用于控制所述机器人按照所述目标转角进行转向。
进一步地，所述第二获取单元用于：将所述速度变化与预设系数相乘，得到所述第二角度变化。
进一步地，所述控制单元包括：判断子单元，用于判断所述目标转角是否大于第一预设转角；第一控制子单元，用于在所述目标转角大于所述第一预设转角的情况下，控制所述机器人按照所述目标转角进行转向，并控制所述机器人以第一速度向前运动。
进一步地，所述控制单元还包括：第二控制子单元，用于在所述目标转角小于等于所述第一预设转角的情况下，控制所述机器人按照所述目标转角进行转向，并控制所述机器人以第二速度向前运动，其中，所述第二速度大于所述第一速度。
进一步地，所述第二控制子单元用于：根据以下公式计算所述第二速度：其中，v表示所述第二速度，vmax表示所述第二速度所能取到的最大值，ωmax表示所述第一预设转角，ω表示所述目标转角，ω∈[0,ωmax]。
进一步地，第一获取单元用于：根据矢量合成法对所述虚拟引力和所述虚拟斥力进行合成，得到所述虚拟合力，并根据所述虚拟合力得到所述第一角度变化。
进一步地，所述第三计算单元用于：将所述第一角度变化和所述第二角度变化按照预设权重进行加权，得到所述目标转角。
进一步地，所述第一计算单元根据以下公式计算所述虚拟引力和所述虚拟斥力：其中，Fatt表示所述目标物对所述机器人产生的虚拟引力，Frep(i)表示第i个方向上所述障碍物对所述机器人产生的虚拟斥力(i＝1,2,3；分别表示前方、左方和右方)，k1和k2分别表示虚拟引力和虚拟斥力的系数，dgoal表示所述目标物与所述机器人之间的距离，drep(i)表示第i个方向上所述障碍物与所述机器人之间的距离。
根据本发明实施例的另一方面，还提供了一种机器人，包括：探测器，用于探测机器人的位置信息和外部环境信息，以及上述的机器人转向运动控制装置。
在本发明实施例中，通过虚拟引力和虚拟斥力的向量加法，得到机器人所需的虚拟合力，为了便于控制，只计算由虚拟合力引起的角度变化，然而，在沿机器人运动方向上的力只会引起速度的变化，并不会改变机器人方向。因此，将机器人速度的变化也映射为转角，以便机器人能避开正前方的障碍物，将这个角度变化(第二角度变化)与由虚拟合力引起的角度变化(第一角度变化)相叠加作为机器人在当前位置应该执行的转角(目标转角)，由于机器人的减速也被映射为转角的变化，因此在机器人正前方有障碍物时，机器人也能产生转角变化，从而绕过这个障碍，达到了高效避障的技术效果，进而解决了现有技术基于人工势场法避障技术中障碍物处于机器人和目标之间且障碍物和目标都在机器人正前方时无法避障的技术问题。
附图说明
此处所说明的附图用来提供对本发明的进一步理解，构成本申请的一部分，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中：
图1是根据本发明实施例的一种可选的机器人转向运动控制方法的流程图；
图2是根据本发明实施例的另一种可选的机器人转向运动控制方法的流程图；
图3是根据本发明实施例的一种可选的机器人转向运动控制装置的示意图。
具体实施方式
为了使本技术领域的人员更好地理解本发明方案，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分的实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本发明保护的范围。
需要说明的是，本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换，以便这里描述的本发明的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，例如，包含了一系列步骤或单元的过程、方法、***、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
根据本发明实施例，提供了一种机器人转向运动控制方法的实施例，需要说明的是，在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机***中执行，并且，虽然在流程图中示出了逻辑顺序，但是在某些情况下，可以以不同于此处的顺序执行所示出或描述的步骤。
图1是根据本发明实施例的一种可选的机器人转向运动控制方法的流程图，如图1所示，该方法包括如下步骤：
步骤S102，根据机器人的位置信息和外部环境信息计算目标物对机器人产生的虚拟引力和障碍物对机器人产生的虚拟斥力。
步骤S104，获取与虚拟合力相关联的第一角度变化，其中，虚拟合力由虚拟引力和虚拟斥力确定。
步骤S106，计算与虚拟合力相关联的速度变化。
步骤S108，获取与速度变化相关联的第二角度变化。
步骤S110，根据第一角度变化和第二角度变化计算目标转角。
步骤S112，控制机器人按照目标转角进行转向。
机器人的位置信息和外部环境信息至少包括以下之一：机器人当前位置，机器人当前方向，目标位置，各个方向上障碍物的距离。
现有技术中，人工势场法避障有一个缺陷，当机器人所受的虚拟合力方向与机器人运动方向相反(即目标物与障碍物都处于机器人运动方向上，且障碍物在机器人与目标物之间)时，这个虚拟合力只会令机器人减速停下，不会导致机器人的转向，所以机器人无法绕过这个障碍，只会在这条线上来回运动。
在本发明实施例中，通过虚拟引力和虚拟斥力的向量加法，得到机器人所需的虚拟合力，为了便于控制，只计算由虚拟合力引起的角度变化，然而，在沿机器人运动方向上的力只会引起速度的变化，并不会改变机器人方向。因此，将机器人速度的变化也映射为转角，以便机器人能避开正前方的障碍物，将这个角度变化(第二角度变化)与由虚拟合力引起的角度变化(第一角度变化)相叠加作为机器人在当前位置应该执行的转角(目标转角)，由于机器人的减速也被映射为转角的变化，因此在机器人正前方有障碍物时，机器人也能产生转角变化，从而绕过这个障碍，避免了现有技术中基于人工势场法避障技术中障碍物处于机器人和目标之间且障碍物和目标都在机器人正前方时无法避障的技术问题，达到了高效避障的技术效果。
可选地，获取与虚拟合力相关联的第一角度变化，包括：根据矢量合成法对虚拟引力和虚拟斥力进行合成，得到虚拟合力，并根据虚拟合力得到第一角度变化。可以利用平行四边形法则或者三角形定则对虚拟引力和虚拟斥力进行合成。
可选地，根据第一角度变化和第二角度变化计算目标转角，包括：将第一角度变化和第二角度变化按照预设权重进行加权，得到目标转角。目标转角＝第一角度变化×第一权重值+第一角度变化×第二权重值。第一权重值与第二权重值均不为零，二者可以相等，也可以不相等。
可选地，获取速度变化关联的第二角度变化包括：将速度变化与预设系数相乘，得到第二角度变化，以将机器人的减速映射为转角的变化。
可选地，控制机器人按照目标转角进行转向，包括：判断目标转角是否大于第一预设转角；如果目标转角大于第一预设转角，控制机器人按照目标转角进行转向的同时控制机器人以第一速度向前运动。如果目标转角小于等于第一预设转角，控制机器人按照目标转角进行转向的同时控制机器人以第二速度向前运动，其中，第二速度大于第一速度。
在机器人执行旋转命令时，将速度和角度做线性对应。当机器人检测到障碍物需要改变运动方向时，如果只从避障的角度来考虑，应该让机器人停下来旋转。然而，突然停止与突然的启动会使机器人的运动出现明显的卡顿，尤其是当机器人运动速度较大时，这种现象会更加明显，如果机器人保持一定速度进行旋转时，机器人的运动路径将会是一个圆弧，有可能会碰到附近的障碍物。为了解决这个问题，将旋转角度与旋转时的线速度做线性对应，当算法输出的旋转角度较小(目标转角小于等于第一预设转角)时，说明障碍物距离较远，没有碰撞危险，让机器人旋转的同时保持一个较大的速度(第二速度)，以保持运动平稳，而当算法输出的旋转角度较大(目标转角大于第一预设转角)时，说明机器人离障碍物较近，让机器人旋转的同时保持一个较小的速度(第一速度)或停止，以避免碰撞。
可选地，控制机器人按照目标转角进行转向,包括：判断目标转角是否大于等于第二预设转角；如果目标转角大于等于第二预设转角，控制机器人按照目标转角进行转向。
对障碍物距离以及机器人转角控制信号设定阈值。为了保证机器人运动顺畅，不会对噪音信号做过大反应，规定只有当障碍物与机器人的距离小于一个设定的阈值时才会对这个障碍物做处理。对于给机器人输出的转角控制信号，同样设定了一个阈值(第二预设转角)，规定当输出的转角信号大于这个阈值时，机器人才会执行。通过设定阈值，保证了机器人的平稳运行，不会一直转来转去。
可选地，控制机器人以第二速度向前运动，包括：根据以下公式计算第二速度：其中，v表示第二速度，vmax表示第二速度所能取到的最大值，ωmax表示第一预设转角，ω表示目标转角，ω∈[0,ωmax]。由公式可见，第二速度与目标转角呈负相关的关系。当目标转角增大时，第二速度减小。当目标转角等于第一预设转角时，第二速度为0；当目标转角为0时，第二速度为vmax。
可选地，根据机器人的位置信息计算目标物对机器人产生的虚拟引力和障碍物对机器人产生的虚拟斥力，包括：根据以下公式计算虚拟引力和虚拟斥力：其中，Fatt表示目标物对机器人产生的虚拟引力，Frep(i)表示第i个方向上障碍物对机器人产生的虚拟斥力(i＝1,2,3；分别表示前方、左方和右方)，k1和k2分别表示虚拟引力和虚拟斥力的系数，dgoal表示目标物与机器人之间的距离，drep(i)表示第i个方向上障碍物与机器人之间的距离。
由于机器人被设定为只向前运动，不会后退，所以只有前方，左方，右方装有探测器，例如超声探头，所以只有这三个方向上的距离。
k1和k2可根据具体应用作调整。虚拟斥力系数越大，则避障效果越好，但是会走弯路。虚拟引力系数越大，机器人更容易被拉回朝向目标物的轨迹，走的弯路少，但是避障效果会变差。为了机器人运动顺畅，在左右两边的障碍物距离在一定距离之内，例如一米之内时，才会被当做障碍物。
作为一种可选的实施例，本方案通过利用机器人的实时数据，并结合运动要求，对人工势场算法进行了改进。如图2所示，在避障流程中，首先接收机器人当前的数据，包括：机器人当前位置，机器人当前方向，目标位置，各个方向上障碍物的距离(由于机器人被设定为只向前运动，不会后退，所以只有前方，左方，右方装有超声探头，所以只有这三个方向上的距离)。读取到所需的数据后，下一步就是利用人工势能法计算机器人运动状态的改变。首先是计算机器人所受的力，虚拟引力和虚拟斥力计算如下：其中，Fatt表示目标物对机器人产生的虚拟引力，Frep(i)表示第i个方向上障碍物所产生的虚拟斥力(i＝1,2,3；分别代表前方左方和右方)，k1和k2分别代表虚拟引力和虚拟斥力的系数，可根据具体应用作调整。虚拟斥力系数越大，则避障效果越好，但是会走弯路。虚拟引力系数越大，机器人更容易被拉回朝向目标物的轨迹，走的弯路少，但是避障效果会变差。dgoal代表机器人到目标物的距离，drep(i)代表第i个方向上障碍物的距离，为了机器人运动顺畅，在左右两边的障碍物距离在一米之内时，才会被当做障碍物。通过虚拟引力和虚拟斥力的向量加法，就可以得到机器人所需的虚拟合力。为了便于控制，只计算由虚拟合力引起的角度变化(第一角度变化)。然而，在沿机器人运动方向上的力只会引起速度的变化，并不会改变机器人方向。因此，将机器人速度的变化也映射为转角，以便机器人能避开正前方的障碍物。将速度的变化乘以一个系数变为机器人的角度变化(第二角度变化)。将这个角度变化与由虚拟合力引起的角度变化相叠加作为机器人在当前位置应该执行的转角(目标转角)。计算出当前位置相应的转角(目标转角)后，便将这个转角命令发送给机器人，机器人会先判断这个转角信号是否为噪声(定义3度以内的转角信号为噪声，以便机器人运动顺畅)，如果转角信号为零，则机器人保持直行，否则执行旋转信号。为了保证机器人运动顺畅，在执行旋转信号时，将速度也和角度做了线性对应。如果旋转角度较小，说明机器人离障碍物较远，则以较大的速度运动的同时进行旋转，如果旋转角度较大，说明机器人离障碍物较近，有碰撞风险，则需要减速旋转。执行完命令之后，机器人会判断到目标物的距离，如果距离小于一定的阈值，则认为已经到达，任务结束，否则进入下一次循环。采样频率是5ms，所以每5ms会执行一次上述算法。
以下给出几个本发明实施例适用的场景。
场景一：在未知环境中进行避障。
当机器人的运动环境是未知的，上层控制程序只给定目标位置。机器人将在运动过程中实时检测障碍物并调整运动状态直至到达目标物。具体过程如下：
当机器人收到目标位置并开始运动后，机器人将开始检测周围障碍物，并结合自身位置以及目标位置算出当前运动方向应做的改变。如果机器人周围没有障碍物，机器人将只受目标物的虚拟引力作用，改变方向直到朝向目标物，再朝目标物直线运动。当运动过程中检测到了附近障碍物时，比起目标物，障碍物距离机器人较近，虚拟斥力会起主导作用，机器人会受到虚拟斥力作用而改变方向直到检测不到障碍物，当避开障碍物后，机器人又将受虚拟引力作用而转向目标物。整个运动过程中，机器人将重复上述步骤直到到达最终目标物。
场景二：在规定路径上前进时躲避突发障碍。
当上层控制程序需要机器人按特定路径行走，可先规划出一条路径。机器人可以在沿规划路径前进的过程中躲避路径附近突然出现的障碍物并到达目标物。具体过程如下：
机器人开始运动后，规定机器人当前位置前方一定距离的规划路径上的一点为目标物，对机器人产生虚拟引力，该局部目标物会随着机器人运动实时更新。当前进路径上没有突发的障碍时，机器人受局部目标物的虚拟引力而一直保持在所规划路径上运动，而在所规划路径附近出现障碍物时，机器人会受到障碍物虚拟斥力作用而偏离所规划路径，当避开障碍物后，机器人又将受局部目标物虚拟引力作用而回到所规划的路径上。整个运动过程中，机器人将重复上述步骤直到到达最终目标物。
场景三：利用该算法实现跟随运动。
当需要机器人实现跟随运动(例如跟随一个人或者另一个机器人)时，可以利用此算法进行实现。机器人可在跟随的同时避开障碍物。具体过程如下：
实现跟随运动可以通过将要跟随物体设置为目标物来实现。在运动过程中，可以让跟随目标物携带位置传感器，并实时将这个位置传给机器人，用这个位置来替代图一种的目标位置。同时还需要规定一个安全距离，当机器人和目标物距离到达这个范围之内的时候就令机器人停止运动以防止碰撞。其余步骤与场景一相同。
本发明实施例还提供了一种机器人转向运动控制装置，该机器人转向运动控制装置能够执行上述机器人转向运动控制方法，上述机器人转向运动控制方法也能够通过该机器人转向运动控制装置执行。
图3是根据本发明实施例的机器人转向运动控制装置的示意图，如图3所示，该装置包括：第一计算单元10、第一获取单元20、第二计算单元30、第二获取单元40、第三计算单元50、控制单元60。
第一计算单元10，用于根据机器人的位置信息和外部环境信息计算目标物对机器人产生的虚拟引力和障碍物对机器人产生的虚拟斥力。
第一获取单元20，用于获取虚拟合力关联的第一角度变化，其中，虚拟合力是根据虚拟引力和虚拟斥力计算出来的。
第二计算单元30，用于计算与虚拟合力关联的速度变化。
第二获取单元40，用于获取速度变化关联的第二角度变化。
第三计算单元50，用于根据第一角度变化和第二角度变化计算目标转角。
控制单元60，用于控制机器人按照目标转角进行转向。
可选地，第二获取单元40用于：将速度变化与预设系数相乘，得到第二角度变化。
可选地，控制单元60包括：判断子单元、第一控制子单元。判断子单元，用于判断目标转角是否大于第一预设转角。第一控制子单元，用于在目标转角大于第一预设转角的情况下，控制机器人按照目标转角进行转向的同时控制机器人以第一速度向前运动。
可选地，控制单元60还包括：第二控制子单元。第二控制子单元，用于在目标转角小于等于第一预设转角的情况下，控制机器人按照目标转角进行转向的同时控制机器人以第二速度向前运动，其中，第二速度大于第一速度。
可选地，第二控制子单元用于：根据以下公式计算第二速度：其中，v表示第二速度，vmax表示第二速度所能取到的最大值，ωmax表示第一预设转角，ω表示目标转角，ω∈[0,ωmax]。
可选地，第一获取单元20用于：根据矢量合成法对虚拟引力和虚拟斥力进行合成，得到虚拟合力，并根据虚拟合力得到第一角度变化。
可选地，第三计算单元50用于：将第一角度变化和第二角度变化按照预设权重进行加权，得到目标转角。
可选地，第一计算单元10根据以下公式计算虚拟引力和虚拟斥力：其中，Fatt表示目标物对机器人产生的虚拟引力，Frep(i)表示第i个方向上障碍物对机器人产生的虚拟斥力(i＝1,2,3；分别表示前方、左方和右方)，k1和k2分别表示虚拟引力和虚拟斥力的系数，dgoal表示目标物与机器人之间的距离，drep(i)表示第i个方向上障碍物与机器人之间的距离。
本发明实施例还提供了一种存储介质，存储介质包括存储的程序，其中，在程序运行时控制存储介质所在设备执行上述的机器人转向运动控制方法。
本发明实施例还提供了一种处理器，处理器用于运行程序，其中，程序运行时执行上述的机器人转向运动控制方法。
本发明实施例还提供了一种机器人，该机器人包括：探测器，用于探测机器人的位置信息，以及上述的机器人转向运动控制装置。
本发明实施例还提供了一种机器人，该机器人包括：机器人本体、探测器、处理器。探测器，用于探测机器人的位置信息。处理器，处理器运行程序，其中，程序运行时对于从探测器输出的数据执行如下处理步骤：根据机器人的位置信息计算目标物对机器人产生的虚拟引力和障碍物对机器人产生的虚拟斥力；获取虚拟合力关联的第一角度变化，其中，虚拟合力是根据虚拟引力和虚拟斥力计算出来的；计算与虚拟合力关联的速度变化；获取速度变化关联的第二角度变化；根据第一角度变化和第二角度变化计算目标转角；控制机器人按照目标转角进行转向。探测器可以是超声探头。
本发明实施例还提供了一种机器人，该机器人包括：机器人本体、探测器、存储介质。探测器，用于探测机器人的位置信息。存储介质，用于存储程序，其中，程序在运行时对于从探测器输出的数据执行如下处理步骤：根据机器人的位置信息计算目标物对机器人产生的虚拟引力和障碍物对机器人产生的虚拟斥力；获取虚拟合力关联的第一角度变化，其中，虚拟合力是根据虚拟引力和虚拟斥力计算出来的；计算与虚拟合力关联的速度变化；获取速度变化关联的第二角度变化；根据第一角度变化和第二角度变化计算目标转角；控制机器人按照目标转角进行转向。探测器可以是超声探头。
本专利属于移动机器避障领域，适用于未建模的障碍物。该避障算法利用超声探测器获取障碍物相对机器人的位置信息，再结合室内定位方法所得到的机器人的位置信息以及由陀螺仪得到的机器人姿态信息，来对机器人进行路径规划，可以避开在机器人前进路径上的障碍物并准确到达目标。
通过结合实际需求，本发明实施例对现有人工势场避障算法进行了改进，使得机器人能在保持平稳运动的同时实现较好的避障效果。
根据探测器的反馈数据再结合上层的控制命令，通过计算虚拟合力来改变机器人运动方向，算法运算简洁，实时性好，能高效的实现避障功能，节省成本并且运行高效。
该避障算法在已知机器人位置信息的情况下，可用于所有移动机器人的避障。也可用于无人机，潜水艇的避障。
在本发明的上述实施例中，对各个实施例的描述都各有侧重，某个实施例中没有详述的部分，可以参见其他实施例的相关描述。
在本申请所提供的几个实施例中，应该理解到，所揭露的技术内容，可通过其它的方式实现。其中，以上所描述的装置实施例仅仅是示意性的，例如所述单元的划分，可以为一种逻辑功能划分，实际实现时可以有另外的划分方式，例如多个单元或组件可以结合或者可以集成到另一个***，或一些特征可以忽略，或不执行。另一点，所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口，单元或模块的间接耦合或通信连接，可以是电性或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的，作为单元显示的部件可以是或者也可以不是物理单元，即可以位于一个地方，或者也可以分布到多个单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外，在本发明各个实施例中的各功能单元可以集成在一个处理单元中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现，也可以采用软件功能单元的形式实现。
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时，可以存储在一个计算机可读取存储介质中。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储介质中，包括若干指令用以使得一台计算机设备(可为个人计算机、服务器或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括：U盘、只读存储器(ROM，Read-Only Memory)、随机存取存储器(RAM，Random Access Memory)、移动硬盘、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。

Claims (13)

1.一种机器人转向运动控制方法，其特征在于，包括：
根据机器人的位置信息和外部环境信息计算目标物对所述机器人产生的虚拟引力和障碍物对所述机器人产生的虚拟斥力，其中，所述障碍物位于所述机器人与所述目标物之间，且所述障碍物和所述目标物都位于所述机器人的正前方；
获取与虚拟合力相关联的第一角度变化，其中，所述虚拟合力由所述虚拟引力和所述虚拟斥力确定；
计算与所述虚拟合力相关联的速度变化；
获取与所述速度变化相关联的第二角度变化，包括：将速度变化与预设系数相乘，得到第二角度变化，以将机器人的减速映射为转角的变化；
根据所述第一角度变化和所述第二角度变化计算目标转角；
控制所述机器人按照所述目标转角进行转向；
其中，所述控制所述机器人按照所述目标转角进行转向，包括：判断所述目标转角是否大于第一预设转角，其中，在所述目标转角大于所述第一预设转角的情况下所述机器人与所述障碍物之间的距离，小于在所述目标转角小于或等于所述第一预设转角的情况下所述机器人与所述障碍物之间的距离；
如果所述目标转角大于所述第一预设转角，控制所述机器人按照所述目标转角进行转向，并控制所述机器人以第一速度向前运动；
如果所述目标转角小于等于所述第一预设转角，控制所述机器人按照所述目标转角进行转向，并控制所述机器人以第二速度向前运动，其中，所述第二速度大于所述第一速度。
2.根据权利要求1所述的方法，其特征在于，控制所述机器人以第二速度向前运动，包括：
根据以下公式计算所述第二速度：
，
其中，表示所述第二速度，/>表示所述第二速度所能取到的最大值，/>表示所述第一预设转角，/>表示所述目标转角，/>。
3.根据权利要求1所述的方法，其特征在于，获取与虚拟合力相关联的第一角度变化，包括：
根据矢量合成法对所述虚拟引力和所述虚拟斥力进行合成，得到所述虚拟合力，并根据所述虚拟合力得到所述第一角度变化。
4.根据权利要求1所述的方法，其特征在于，根据所述第一角度变化和所述第二角度变化计算目标转角，包括：
将所述第一角度变化和所述第二角度变化按照预设权重进行加权，得到所述目标转角。
5.根据权利要求1至4中任一项所述的方法，其特征在于，根据机器人的位置信息计算目标物对所述机器人产生的虚拟引力和障碍物对所述机器人产生的虚拟斥力，包括：
根据以下公式计算所述虚拟引力和所述虚拟斥力：
，
，
其中，F att 表示所述目标物对所述机器人产生的虚拟引力，F rep (i) 表示第i个方向上所述障碍物对所述机器人产生的虚拟斥力（i=1, 2, 3; 分别表示前方、左方和右方），k 1 和k 2 分别表示虚拟引力和虚拟斥力的系数，d goal 表示所述目标物与所述机器人之间的距离，d rep (i) 表示第i个方向上所述障碍物与所述机器人之间的距离。
6.一种机器人转向运动控制装置，其特征在于，包括：
第一计算单元，用于根据机器人的位置信息和外部环境信息计算目标物对所述机器人产生的虚拟引力和障碍物对所述机器人产生的虚拟斥力，其中，所述障碍物位于所述机器人与所述目标物之间，且所述障碍物和所述目标物都位于所述机器人的正前方；
第一获取单元，用于获取与虚拟合力相关联的第一角度变化，其中，所述虚拟合力由所述虚拟引力和所述虚拟斥力确定；
第二计算单元，用于计算与所述虚拟合力相关联的速度变化；
第二获取单元，用于获取所述速度变化相关联的第二角度变化；
第三计算单元，用于根据所述第一角度变化和所述第二角度变化计算目标转角；
控制单元，用于控制所述机器人按照所述目标转角进行转向；
所述第二获取单元还用于，将速度变化与预设系数相乘，得到第二角度变化，以将机器人的减速映射为转角的变化；
所述控制单元包括：判断子单元，用于判断所述目标转角是否大于第一预设转角，其中，在所述目标转角大于所述第一预设转角的情况下所述机器人与所述障碍物之间的距离，小于在所述目标转角小于或等于所述第一预设转角的情况下所述机器人与所述障碍物之间的距离；
第一控制子单元，用于在所述目标转角大于所述第一预设转角的情况下，控制所述机器人按照所述目标转角进行转向，并控制所述机器人以第一速度向前运动；
第二控制子单元，用于在所述目标转角小于等于所述第一预设转角的情况下，控制所述机器人按照所述目标转角进行转向，并控制所述机器人以第二速度向前运动，其中，所述第二速度大于所述第一速度。
7.根据权利要求6所述的装置，其特征在于，所述第二控制子单元用于：
根据以下公式计算所述第二速度：
，
其中，表示所述第二速度，/>表示所述第二速度所能取到的最大值，/>表示所述第一预设转角，/>表示所述目标转角，/>。
8.根据权利要求6所述的装置，其特征在于，第一获取单元用于：根据矢量合成法对所述虚拟引力和所述虚拟斥力进行合成，得到所述虚拟合力，并根据所述虚拟合力得到所述第一角度变化。
9.根据权利要求6所述的装置，其特征在于，所述第三计算单元用于：将所述第一角度变化和所述第二角度变化按照预设权重进行加权，得到所述目标转角。
10. 根据权利要求6至9中任一项所述的装置，其特征在于，所述第一计算单元用于：根据以下公式计算所述虚拟引力和所述虚拟斥力：
，
，
其中，F att 表示所述目标物对所述机器人产生的虚拟引力，F rep (i) 表示第i个方向上所述障碍物对所述机器人产生的虚拟斥力（i=1, 2, 3; 分别表示前方、左方和右方），k 1 和k 2 分别表示虚拟引力和虚拟斥力的系数，d goal 表示所述目标物与所述机器人之间的距离，d rep (i) 表示第i个方向上所述障碍物与所述机器人之间的距离。
11.一种机器人，其特征在于，包括：探测器，用于探测机器人的位置信息和外部环境信息，以及权利要求6至10任一项所述的机器人转向运动控制装置。
12.一种存储介质，其特征在于，所述存储介质包括存储的程序，其中，在所述程序运行时控制所述存储介质所在设备执行权利要求1至5中任意一项所述的机器人转向运动控制方法。
13.一种处理器，其特征在于，所述处理器用于运行程序，其中，所述程序运行时执行权利要求1至5中任意一项所述的机器人转向运动控制方法。
CN201710319253.9A 2017-05-08 2017-05-08 机器人转向运动控制方法和装置、机器人、存储介质 Active CN108873875B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201710319253.9A CN108873875B (zh) 2017-05-08 2017-05-08 机器人转向运动控制方法和装置、机器人、存储介质
PCT/CN2018/079845 WO2018205751A1 (zh) 2017-05-08 2018-03-21 机器人转向运动控制方法和装置、机器人、存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710319253.9A CN108873875B (zh) 2017-05-08 2017-05-08 机器人转向运动控制方法和装置、机器人、存储介质

Publications (2)

Publication Number Publication Date
CN108873875A CN108873875A (zh) 2018-11-23
CN108873875B true CN108873875B (zh) 2023-11-14

Family

ID=64104292

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710319253.9A Active CN108873875B (zh) 2017-05-08 2017-05-08 机器人转向运动控制方法和装置、机器人、存储介质

Country Status (2)

Country Link
CN (1) CN108873875B (zh)
WO (1) WO2018205751A1 (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111338287A (zh) * 2020-03-13 2020-06-26 南方科技大学 机器人运动控制方法、装置、***、机器人及存储介质
CN111546343B (zh) * 2020-05-13 2021-08-03 浙江工业大学 一种基于改进人工势场法的消防移动机器人路径规划方法及***
CN112558610A (zh) * 2020-12-15 2021-03-26 上海有个机器人有限公司 机器人避开障碍的运动控制方法、***、机器人及计算机存储介质
CN112947417A (zh) * 2021-01-27 2021-06-11 厦门大学 一种用于智能运动体避障的控制方法
CN113190004A (zh) * 2021-05-07 2021-07-30 河南科技大学 一种基于算法融合的无人驾驶车辆避碰路径规划方法
CN115509217A (zh) * 2021-06-21 2022-12-23 广州视源电子科技股份有限公司 机器人的控制方法、装置、计算机存储介质以及机器人
CN113741424A (zh) * 2021-08-04 2021-12-03 深圳市普渡科技有限公司 机器人协同避障***、方法、机器人及存储介质
CN113829347B (zh) * 2021-09-30 2023-08-15 上海傅利叶智能科技有限公司 基于物理引擎的机器人控制方法、装置和康复机器人
CN114859945A (zh) * 2022-05-26 2022-08-05 厦门大学 一种基于人工势场法的水下编队控制方法、***及介质

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102053620A (zh) * 2009-11-06 2011-05-11 北京理工大学 一种地面移动机器人群摆脱多边形障碍物的方法
JP2012011498A (ja) * 2010-06-30 2012-01-19 Toshiba Corp ロボットアーム操作システムおよびその操作方法
CN102591332A (zh) * 2011-01-13 2012-07-18 同济大学 用于无人驾驶汽车局部路径规划的装置及方法
CN103092204A (zh) * 2013-01-18 2013-05-08 浙江大学 一种混合的机器人动态路径规划方法
CN104317292A (zh) * 2014-09-16 2015-01-28 哈尔滨恒誉名翔科技有限公司 一种复杂形状机器人避碰路径的方法
CN105223956A (zh) * 2015-11-09 2016-01-06 中山大学 一种全向移动机器人的动态避障方法
CN105717929A (zh) * 2016-04-29 2016-06-29 中国人民解放军国防科学技术大学 一种多分辨率障碍物环境下移动机器人混合路径规划方法

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101964372B1 (ko) * 2012-11-21 2019-04-01 한화디펜스 주식회사 도킹 모듈
CN103197684B (zh) * 2013-04-25 2016-09-21 清华大学 无人机群协同跟踪目标的方法及***
CN103365299B (zh) * 2013-08-02 2015-12-23 中国科学院自动化研究所 一种无人机的避障方法及其装置
US9360320B2 (en) * 2014-07-22 2016-06-07 Raytheon Company Autonomous coordination of agents via attraction and repulsion
CN104516356B (zh) * 2015-01-08 2017-07-14 西北工业大学 基于rrt的动态障碍规避算法
CN105974917B (zh) * 2016-05-11 2018-12-14 江苏大学 一种基于新型人工势场法的车辆避障路径规划研究方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102053620A (zh) * 2009-11-06 2011-05-11 北京理工大学 一种地面移动机器人群摆脱多边形障碍物的方法
JP2012011498A (ja) * 2010-06-30 2012-01-19 Toshiba Corp ロボットアーム操作システムおよびその操作方法
CN102591332A (zh) * 2011-01-13 2012-07-18 同济大学 用于无人驾驶汽车局部路径规划的装置及方法
CN103092204A (zh) * 2013-01-18 2013-05-08 浙江大学 一种混合的机器人动态路径规划方法
CN104317292A (zh) * 2014-09-16 2015-01-28 哈尔滨恒誉名翔科技有限公司 一种复杂形状机器人避碰路径的方法
CN105223956A (zh) * 2015-11-09 2016-01-06 中山大学 一种全向移动机器人的动态避障方法
CN105717929A (zh) * 2016-04-29 2016-06-29 中国人民解放军国防科学技术大学 一种多分辨率障碍物环境下移动机器人混合路径规划方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
基于改进人工势场法的动态环境运动规划;周可璞等;《计量与测试技术》;20170430;第44卷(第04期);第27-29页 *
温室移动机器人避障功能研究;阎勤劳等;《农业机械学报》;20060528;第37卷(第05期);第110-112+100页 *
非完整移动机器人的人工势场法路径规划;朱毅等;《控制理论与应用》;20100215;第27卷(第02期);第152-158页 *

Also Published As

Publication number Publication date
WO2018205751A1 (zh) 2018-11-15
CN108873875A (zh) 2018-11-23

Similar Documents

Publication Publication Date Title
CN108873875B (zh) 机器人转向运动控制方法和装置、机器人、存储介质
Belkhouche Reactive path planning in a dynamic environment
US8515612B2 (en) Route planning method, route planning device and autonomous mobile device
CN107562048B (zh) 一种基于激光雷达的动态避障控制方法
CN106573377B (zh) 具有冲突避免和轨迹恢复能力的类人机器人
KR101539270B1 (ko) 충돌회피 및 자율주행을 위한 센서융합 기반 하이브리드 반응 경로 계획 방법, 이를 수행하기 위한 기록 매체 및 이동로봇
Song et al. Navigation control design of a mobile robot by integrating obstacle avoidance and LiDAR SLAM
CN110262495A (zh) 可实现移动机器人自主导航与精确定位的控制***及方法
JP2006146491A (ja) 移動ロボットおよびその追従方法
JP2008065755A (ja) 移動装置
JP2003241836A (ja) 自走移動体の制御方法および装置
CN105867368A (zh) 一种信息处理方法和移动装置
JP2019113926A (ja) モデル予測制御装置
JP2008142841A (ja) 移動ロボット
WO2018077307A1 (zh) 一种运动控制方法、装置和计算机存储介质
WO2017166767A1 (zh) 一种信息处理方法和移动装置、计算机存储介质
JP2010061442A (ja) 自律移動装置
Tang et al. Multi-robot control for circumnavigation of particle distributions
Ryu et al. Development of an autonomous vehicle for high-speed navigation and obstacle avoidance
Frew et al. Adaptive receding horizon control for vision-based navigation of small unmanned aircraft
Kim et al. Single 2D lidar based follow-me of mobile robot on hilly terrains
Brooks et al. Humanoid robot navigation and obstacle avoidance in unknown environments
Al-Shanoon et al. Mobile robot regulation with position based visual servoing
Lee et al. Mobile robot navigation with reactive free space estimation
Al Arabi et al. 2D mapping and vertex finding method for path planning in autonomous obstacle avoidance robotic system

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
TA01 Transfer of patent application right

Effective date of registration: 20231019

Address after: 810000 No. 75 Haiyan Road, Chengxi District, Xining City, Qinghai Province

Applicant after: China Huadian Group Co.,Ltd. Qinghai Branch

Address before: 518000 Guangdong, Shenzhen, Nanshan District, Nanhai Road, West Guangxi Temple Road North Sunshine Huayi Building 1 15D-02F

Applicant before: SHEN ZHEN KUANG-CHI HEZHONG TECHNOLOGY Ltd.

Applicant before: KUANG-CHI INNOVATIVE TECHNOLOGY Ltd.

TA01 Transfer of patent application right
GR01 Patent grant
GR01 Patent grant