一种应用于双足机器人动态行走的平衡控制方法与流程

1.本发明涉及机器人领域，具体涉及一种应用于双足机器人动态行走的平衡控制方法。


背景技术：

2.双足机器人具有仿人的形态和类似人类行走的位移方式，相比于传统的轮式移动机器人，更能适应人类的工作和生活环境，是未来配合或者代替人类工作的终极机器人形态。双足机器人走向实际应用需要在行走稳定性、步态多样性、行走速度和能耗等方面均达到较高水平。尽管近年来世界范围内多款双足机器人样机展示了一些性能上的提升，但距离人类的行走性能仍有较大的差距。在上述四个主要行走性能中，行走稳定性是最重要的性能，也是其他性能进一步体现的前提条件，没有强稳定性的保障，双足行走的其他性能都无从谈起。
3.行走稳定性的主要体现形式是在机器人行走过程中受到外力扰动时，能否保持平衡而不摔倒，并逐渐恢复到原有的行走姿态中。由于双足行走是两只脚交替与地面接触并带动上肢进行位移的混杂过程，机器人的双足行走过程本身具有较高的不稳定性，行走平衡控制的复杂度和难度较高。目前已有一些平衡控制算法被提出并应用在双足机器人样机上，基于混杂零动态（hzd）的极限环控制方法被应用到双足机器人的平衡控制中，但受限于该方法的收敛域极小，只能抵抗较小的扰动；本田公司的仿人机器人asimo和韩国的仿人机器人hubo均采用零力矩点（zmp）的规划和平衡控制方式，机器人的零力矩点不能超出脚板构成的支撑多边形，步态的动态性能差，行走能效低且行走稳定性差；波士顿动力的atlas机器人基于捕获点的方法实现平衡控制，展示了较高的动态性能和爆发力，但在抗外部扰动时的平衡性能展示较少。总之，现有应用于双足机器人的平衡控制方案有的为了追求稳定性放弃了行走的动态性能，有的追求动态性能而降低了行走稳定性，如何实现兼具动态性能和平衡能力的行走是运动控制领域的核心问题。


技术实现要素：

4.本发明的目的是为了解决上述问题，提出一种应用于双足机器人动态行走的平衡控制方法。
5.本发明的目的通过以下技术方案实现：一种双足机器人动态行走的平衡控制方法，包括以下步骤：步骤一，获取双足机器人行走速度指令，并统一为二维的行走速度向量形式；步骤二，对双足机器人规划理想步态，并根据步骤一获得的行走速度向量及机器人相关信息计算获得双足机器人在完成当前步，并向下一步切换时的理想质心状态，分别表示机器人在完成当前步，并向下一步切换时质心在x方向和y方向的理想位置，分别表示机器人在完成当前步，并向下一步切换时质心在x方向和y方
向的理想速度；步骤三，实时获取双足机器人的当前质心状态，其中， 分别表示当前时刻机器人质心在x方向和y方向的位置， 分别表示当前时刻机器人质心在x方向和y方向的速度；结合步骤二获取的双足机器人在完成当前步，并向下一步切换时的理想质心状态依次计算前向平面内机器人的落脚时间和侧向平面内机器人的落脚时间并确定优先平面；步骤四，以优先平面的落脚时间作为本次落脚控制的剩余摆动时间，计算优先平面的zmp点和落脚点、非优先平面的zmp点和落脚点，从而实现存在外部扰动的情况下对落脚点的规划和平衡控制。
6.进一步地，所述步骤二中，利用简化的三维倒立摆模型作为对象对双足机器人规划理想步态，根据步骤一获得的行走速度向量及机器人相关信息计算获得双足机器人在完成当前步，并向下一步切换时的理想质心状态具体如下：其中，v
x
为机器人向正前方的行走速度，v
y 为向正左方的行走速度；v
xmax
为机器人前向行走速度最大值；为在侧向速度指令为v
y
时，双足切换状态下的质心侧向位置；为机器人质心在行走过程中距离支撑脚中心点最近点至双足切换状态的时间；α为机器人质心在行走过程中距离支撑脚中心点最近时沿y轴方向的距离；δ为机器人质心在双足切换状态时距离支撑脚中心点沿y轴方向的距离；σ为机器人质心距离支撑脚中心点距离最近时沿x方向的行走速度；ω为机器人侧向行走速度为最大值v
ymax
时，质心在双足切换状态时距离支撑脚中心点沿y方向的距离；λ
ϵ
{
‑
1,1}用于说明当前的双足支撑状态；c为双足机器人的行走高度参数。
7.进一步地，所述步骤三中，实时获取双足机器人的当前质心状态，结合步骤二获取的双足机器人在完成当前步，并向下一步切换时的理想质心状态依次计算前向平面内机器人的落脚时间和侧向平面内机器人的落脚时间，具体为：规划zmp偏移量：其中，侧向平面内对应的zmp偏移量计算如下，前向平面内对应的zmp偏移量如下，
式中，c为双足机器人的行走高度参数；根据zmp偏移量计算落脚时间如下：根据zmp偏移量计算落脚时间如下：其中t
l
为侧向平面的落脚时间，t
f
为前向平面的落脚时间；，，，；、为考虑侧向zmp偏移量情况下的质心位置和速度；、为考虑前向zmp偏移量情况下的质心位置和速度。
8.进一步地，所述步骤三中，确定优先平面具体为：选择落脚时间小对应的平面为优先平面。
9.进一步地，所述步骤四具体为：以优先平面的落脚时间作为本次落脚控制的剩余摆动时间t
t0
，同时结合平面的zmp偏移量，分别计算前向平面和侧向平面的落脚位置，结合机器人本体的结构布局，选取通用的逆运动学解算方法，完成对机器人各个关节角度的实时规划计算；其中，侧向平面的落脚位置计算方法如下：先计算双足机器人到达双足切换位置时的侧向平面内的速度如下：c为双足机器人的行走高度参数；进一步计算落脚点优先平面对应的坐标如下：α为机器人质心在行走过程中距离支撑脚中心点最近时的沿y轴方向的距离；λ
ϵ
{
‑
1,1}用于说明当前的双足支撑状态；前向平面的落脚位置计算方法如下：以优先平面的落脚时间作为本次落脚控制的
剩余摆动时间重新计算前向平面的zmp偏移量如下：其中，为考虑前向zmp偏移量情况下的质心速度；；进一步计算双足机器人到达双足切换位置时的前向速度如下，最后计算落脚点非优先平面对应的坐标如下：最后计算落脚点非优先平面对应的坐标如下：为距离支撑脚最近点至双足切换点的时间。
10.本发明的有益效果是：本发明方法根据机器人当前状态计算落脚时间并确定优先平面，基于优先平面落脚点时间作为本次落脚控制的剩余摆动时间计算落脚点位置，实现在存在外部扰动的情况下对落脚点的规划控制。本发明方法无需对扰动的大小和方向进行测量，仅通过观测扰动施加后机器人的状态变化，实现机器人的平衡控制，可用于双足机器人全向行走过程中受到各个方向扰动的情形。
附图说明
11.图1为三维倒立摆模型及其坐标系定义说明示意图；图2为一步行走过程中质心投影轨迹与支撑脚相对位置关系参数的说明示意图；图3为一步行走过程中质心投影轨迹与支撑脚、落脚点之间的位置关系说明示意图。
具体实施方式
12.以下结合附图和实施例对本发明作进一步说明。
13.本发明的一种双足机器人动态行走的平衡控制方法，包含以下步骤：步骤一：处理输入的双足机器人行走速度指令信息如图1所示，为处在三维空间的机器人定义坐标系，以支撑脚中心点1
‑
1作为坐标原点，以机器人前向行走方向为x轴正方向，以机器人左侧方向为y轴正方向，以竖直向上方向为z轴正方向。本发明的运动控制方法输入形式为二维的行走速度向量(v
x
, v
y
)，其中v
x
为机器人向正前方的行走速度，v
y 为向正左方的行走速度。当输入为其他形式时，可通过步幅（步长）和行走频率等步态信息进行转换，统一为上述行走速度向量形式。
14.步骤二：规划理想步态为保证系统的动态性能，步态规划算法需要具备高实时性，为了简化运算复杂度，在综合分析算法有效性的前提下，本发明选用简化的三维倒立摆模型作为对象实现步态规
划，三维倒立摆模型质心1
‑
2如图所示，规划机器人行走过程中的质心高度为h
com
，定义机器人行走高度参数为，其中g为重力加速度常量，则三维倒立摆在前向和侧向的运动可以进行解耦，以机器人质心在水平面上的投影坐标(x, y)作为状态变量，则系统的动态方程如下，其中，、分别表示机器人质心在x方向、y方向移动的加速度。
15.如图2所示，α为机器人质心在行走过程中距离支撑脚中心点最近时沿y轴方向的距离；δ为机器人质心在双足切换状态时距离支撑脚中心点沿y轴方向的距离；σ为机器人质心距离支撑脚中心点最近时沿x方向的行走速度（图中未示出）；ω为机器人侧向行走速度为最大值v
ymax
时，质心在双足切换状态时距离支撑脚中心点沿y方向的距离。
16.在侧向速度指令为v
y 时，双足切换状态的质心侧向位置计算如下，进一步计算由质心距离支撑脚最近点至双足切换状态的时间τ如下，如图3所示，3
‑
1为支撑脚位置，3
‑
2为摆动脚落地位置，3
‑
3为机器人在完成当前步，并向下一步切换时的质心状态可计算如下，其中分别表示机器人在完成当前步，并向下一步切换时质心在x方向和y方向的理想位置，分别表示机器人在完成当前步，并向下一步切换时质心在x方向和y方向的理想速度，v
xmax
为机器人前向行走速度最大值；λ
ϵ
{
‑
1,1}用来说明当前的双足支撑状态，当右脚为支撑脚时λ=1，当左脚为支撑脚时，λ=
‑
1。
17.步骤三：计算落脚时间并确定优先平面机器人行走的动态平衡需要同时考虑来自机器人各个方向的扰动，本发明无需对扰动的大小和方向进行测量，仅通过观测扰动施加后机器人的状态变化，并基于机器人的实时状态即可实现平衡控制。
18.如图3中3
‑
4所示，机器人当前时刻的质心状态为，分别表示当前时刻机器人质心在x方向和y方向的位置，分别表示当前时刻机器人质心在x方向和y方向的速度。采用前向平面与侧向平面解耦的方式，依次计算前向平面内机器人的落脚时间t
f
和侧向平面内机器人的落脚时间t
l
，比较两个落脚时间的大小，较小的落脚时间表示在不进行额外干预的情况下，机器人在该平面内会率先着地，即在该平面内的步态可以优先进行规划与控制，因此以较小落脚时间所在的平面作为优先平面并进一步进行平衡控制策略的实施。
19.对于侧向平面，计算落脚时间t
l
的方法如下。
20.首先规划侧向的zmp偏移量。为了让机器人到达目标切换状态，需要对zmp点进行规划，在计算落脚时间时也要考虑这一因素，因此需要提前规划好zmp偏移量之后才能进一步计算得到该平面的落脚时间。
21.侧向的zmp偏移量计算如下，在此基础上计算侧向的落脚时间如下，其中，，、为考虑侧向zmp偏移量情况下的质心状态（即原质心状态减去zmp偏移量）。
22.同理，计算前向的zmp偏移量如下，在此基础上计算前向的落脚时间如下，其中，，、为考虑前向zmp偏移量情况下的质心状态。
23.如果t
f
≥t
l
，则选择侧向平面为优先平面，如果t
f
<t
l
，则选择前向平面为优先平面。
24.步骤四：计算落脚位置以侧向平面作为优先平面为例进行平衡控制策略说明，当前向平面为优先平面时同理。以侧向平面的落脚时间作为本次落脚控制的剩余摆动时间t
t0
= t
l
，同时考虑侧向的zmp偏移量z
y
，计算在上述条件下机器人到达双足切换位置时的侧向速度如下：并进一步计算落脚点侧向坐标如下，进一步，计算非优先平面也就是前向平面的zmp偏移量如下，在此基础上，计算机器人到达双足切换位置时的前向速度如下，最后计算落脚点的前向坐标如下，当前向平面为优先平面时，同上述方法计算即可。
25.至此完成了以前向平面为优先平面的前向平面与侧向平面的zmp规划与下一步的落脚点规划。基于上述结论，结合机器人本体的结构布局，选取通用的逆运动学解算方法，即可完成对机器人各个关节角度的实时规划计算，后续步骤在本发明中不进行详细说明。
26.以上实施例仅用于说明本发明的设计思想和特点，其目的在于使本领域内的技术人员能够了解本发明的内容并据以实施，本发明的保护范围不限于上述实施例。所以，凡依据本发明所揭示的原理、设计思路所作的等同变化或修饰，均在本发明的保护范围之内。