CN111914416A - 一种高能效轻量化结构双足机器人的逆运动学求解方法 - Google Patents

Abstract

本发明公开了一种高能效轻量化结构双足机器人的逆运动学求解方法，该方法采用旋量法建立机器人坐标系，并通过构造可表征姿态信息的矢量，构建出了可用于逆运动学求解的表达式方程，进而采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解；该方法还进一步考虑了驱动连杆的存在，并采用解析方法计算出驱动电机实际需要转动的角度。本发明可用于机器人髋关节电机轴不相交的情形下进行逆运动学求解。

Description

一种高能效轻量化结构双足机器人的逆运动学求解方法

技术领域

本发明属于机器人技术领域，尤其涉及一种具有高能效轻量化腿足结构双足机器人的逆运动学求解方法。

背景技术

双足机器人是具有多个自由度的高维非线性系统，对其进行步态规划与控制是一项非常具有挑战性的工作。如何实现快速的步态规划一直是国内外研究人员重点关注的问题，它关系到双足机器人的实时性与鲁棒性能。为实现高实时性的步态规划，国内外研究人员目前一般先基于简化模型规划出机器人的质心(或躯干)以及落脚点轨迹，然后再利用逆运动学求解出机器人腿足各驱动关节的轨迹。

目前，国内外研究人员在进行双足机器人结构设计时常使其髋关节的三个电机轴交于一点，包括硕士论文《仿人机器人结构设计与分析》所述的浙江大学的ZJUKong，以及最近的期刊论文《Contact Force/Torque Control Based on Viscoelastic Model forStable Bipedal Walking on Indefinite Uneven Terrain》所述的北京理工大学的BHR-6P。当双足机器人髋关节的电机轴交于一点时，其逆运动学可采用解析方法进行几何求解，如最近的硕士论文《GTX-Ⅲ型双足机器人样机研制与行走实验研究》以及专利《基于闭环控制的仿人机器人全向行走方法》(专利号CN201310060399.8)所述。随着双足机器人技术的发展，国内外研究人员从追求走稳向追求走好发展。为实现高效步行，提高续航能力，国内外研究人员开始考虑高能效轻量化腿足结构布局。在此类布局设计中，一般以减轻机器人腿足结构的转动惯量作为主要优化目标，机器人驱动电机会往躯干方向布置以尽量减轻腿足结构的质量，并采用平行连杆进行驱动。在此情形下，机器人髋关节的电机轴不一定交于一点，从而难以采用几何解析方法进行逆运动学求解。此外，由于加入了连杆，如何从机器人的关节角度计算出驱动电机实际需要转动的角度，也需要进一步考虑。

发明内容

本发明的目的在于针对现有技术的不足，提供一种高能效轻量化结构双足机器人的逆运动学求解方法。

本发明的目的是通过以下技术方案来实现的：一种高能效轻量化结构双足机器人的逆运动学求解方法，包括以下步骤：

步骤一，采用旋量法建立机器人坐标系，并构造表征姿态信息的矢量，进而构建出用于逆运动学求解的表达式方程，根据期望的末端位置采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解获得机器人各关节角度；

步骤二，基于步骤一得到的关节角度，采用几何方法计算出各关节驱动电机需要转动的角度。

进一步地，所述步骤一具体为：

首先，利用旋量法建立机器人坐标系并获得机器人位姿的表达式；在初始状态下，各关节角度为0，各关节的局部坐标系与世界坐标系平行；机器人第i个关节角度q_i相对第i-1个关节角度q_i-1的齐次变换矩阵

为：

其中，a_i为关节角度q_i的单位转轴向量，

表示由a_i生成的斜对称矩阵，b_i表示关节角度q_i-1局部坐标系下q_i局部坐标系原点的位置矢量，

的表达如下：

其中，E为单位矩阵；基于齐次转换矩阵

机器人关节角度q_i的位姿矩阵为T_i：

其中，R_i为关节角度q_i的姿态矩阵，p_i为关节角度q_i的绝对位置矢量，R₀和p₀分别为机器人起始杆件的位姿矩阵和绝对位置矢量；基于位姿矩阵T_i，令第j个关节角度q_j为机器人的末端关节角度，则机器人末端的位姿矩阵T_j为：

然后，基于机器人末端的位姿矩阵T_j，构建机器人逆运动学求解的表达式方程：

f(q)＝f_ref

其中，

q＝[q₁,…,q_j]^T为机器人关节角度组成的向量，p_ref为末端位置矢量的期望值，向量v_or构造如下：

v_or＝[M(1,1) M(2,2) M(3,3)]^T

其中，矩阵

为机器人末端期望姿态矩阵R_ref的转置；

接着，利用牛顿拉夫逊算法对方程f(q)＝f_ref进行求解，方程求解的迭代方程如下：

X_k＝X_k-1-J^-1(f(X_k-1)-f_ref)

其中，X_k为向量q在第k次的迭代值；

J^-1为J的逆，X₀为关节角度向量q的初始估计值；当向量f(X_k)-f_ref的欧几里得范数小于阈值λ时，迭代终止，最终得到关节角度向量q＝X_k。

进一步地，所述阈值λ＝10^-7。

进一步地，所述步骤二中，机器人踝关节驱动电机的输出曲柄、连杆以及起始杆件构成空间四边形，计算采用踝关节驱动电机需要转动的角度具体为：首先，找到该空间四边形中可基于局部坐标系表示的三个顶点，即连杆与脚掌的连接点、电机输出曲柄与电机的连接点以及机器人起始杆件上的一个固定点；该固定点位于电机输出曲柄的运动平面内，以便基于该固定点表达电机的转动角度；并在局部坐标系下对三个顶点进行表达；然后，将电机输出曲柄末端的位置表示为电机转动角度的函数，进而表示出连杆在局部坐标系下的位置向量；最后，根据连杆的长度为定值，计算出踝关节驱动电机实际需要转动的角度。

本发明的有益效果在于：本发明可用于机器人髋关节电机轴不相交的情形，通过构造可表征姿态信息的矢量，构建出了可用于逆运动学求解的表达式方程，并进一步采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解；还进一步考虑了驱动连杆的存在，并采用几何方法计算出驱动电机实际需要转动的角度。

附图说明

图1为具有高能效轻量化腿足结构的双足机器人示意图；其中，a为机器人结构示意图，b为机器人左腿关节角度与尺寸示意图。

具体实施方式

以下结合附图和实施例对本发明作进一步说明。

本发明所提供的一种高能效轻量化结构双足机器人的逆运动学求解方法，包含如下步骤：

步骤一，采用旋量法建立机器人坐标系，并构造出可表征姿态信息的矢量，进而构建出可用于逆运动学求解的表达式方程，并进一步采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解，以获得机器人各关节角度：

首先，利用旋量法建立具有高能效轻量化腿足结构双足机器人的坐标系，并获得机器人位姿的表达式。机器人各关节局部坐标系如图1所示，机器人起始杆件(即脚掌)绝对位置矢量为p₀，其姿态矩阵为R₀；q₁为踝关节俯仰角度，q₁对应的转动轴矢量a₁＝[1,0,0]^T、相对位置矢量b₁＝[0,0,0]^T；q₂为踝关节滚动角度，q₂对应的转动轴矢量a₂＝[0,1,0]^T、相对位置矢量b₂＝[0,0,0]^T；q₃为膝关节俯仰角度，q₃对应的转动轴矢量a₃＝[1,0,0]^T、相对位置矢量b₃＝[0,0,l₁]^T；q₄为髋关节俯仰角度，q₄对应的转动轴矢量a₄＝[1,0,0]^T、相对位置矢量b₄＝[0,0,l₂]^T；q₅为髋关节旋转角度，q₅对应的转动轴矢量a₅＝[0,0,1]^T、相对位置矢量b₅＝[0,0,0]^T；q₆为髋关节滚动角度，q₆对应的转动轴矢量a₆＝[0,1,0]^T、相对位置矢量b₆＝[0,0,l₃]^T；髋关节绝对位置矢量为p₆，其姿态矩阵为R₆；其中，l₁为小腿的长度，l₂为大腿的长度，l₃为髋关节到躯干的距离；本实施例中l₁＝0.275m，l₂＝0.275m，l₃＝0.05m。

在初始状态下，各关节角度为0，此时选取各关节的局部坐标系与世界坐标系W平行。在此局部坐标系下，机器人关节角度q_i(i＝1～6)相对关节角度q_i-1的齐次变换矩阵

为：

其中，a_i为关节角度q_i的单位转轴向量，

表示由a_i生成的斜对称矩阵，b_i表示关节角度q_i-₁局部坐标系下q_i局部坐标系原点的位置矢量，

表达如下：

其中，E为单位矩阵。基于齐次转换矩阵

机器人关节角度q_i的位姿矩阵T_i为：

其中，R_i(i＝0,6)为关节角度q_i的姿态矩阵，p_i(i＝0,6)为关节q_i的绝对位置矢量，R₀和p₀分别为机器人起始杆件的位姿矩阵和绝对位置矢量。基于上述位姿矩阵表达式，设q₆为机器人的末端关节，则机器人末端的位姿矩阵可表示为：

然后，基于机器人末端的位姿矩阵，构建机器人逆运动学求解的表达式方程：

f(q)＝f_ref

其中，

q＝[q₁,q₂,q₃,q₄,q₅,q₆]^T为机器人关节角度所组成的向量，p_ref为末端位置矢量的期望值；向量v_or构造如下：

v_or＝[M(1,1) M(2,2) M(3,3)]^T

其中，矩阵

为机器人末端期望姿态矩阵R_ref的转置。构造vo_r的原理在于，当末端姿态矩阵R_j＝R_ref时，

为单位矩阵E，从而取M的对角线元素构造目标向量v_or。本实施例取p_ref＝[0 -0.1234 0.5841]^T，

接着，利用牛顿拉夫逊算法对方程f(q)＝f_ref进行求解，方程求解的迭代方程如下所示：

X_k＝X_k-1-J^-1(f(X_k-1)-f_ref)

其中，X_k为向量q在第k次的迭代值；

J^-1为J的逆；X₀为关节角度向量q的初始估计值。当向量f(X_k)-f_ref的欧几里得范数小于某一足够小的阈值λ＝10^-7时，迭代终止，最终获得q＝[0.1 0 0.2 0 0.5235 0.6283]^T。

步骤二，基于步骤一所求解的关节角度q，采用几何方法计算出驱动电机实际需要转动的角度。本实施例以踝关节右侧驱动电机的转动值q_m为例进行计算，其余关节的驱动电机可类似处理：

首先，如图1b所示，基于驱动电机曲柄p_a1-p_a2与连杆p_a2-p_a3构建空间四边形p_a1p_a2p_a3p_a4，其中p_a4为机器人小腿杆件上选择的一个任意已知点，满足p_a1p_a4与p_a1p_a2间的夹角即为电机实际需要的转动角度；然后，在局部坐标系下，对三个顶点p_a1、p_a3、p_a4进行表达，并将p_a2的位置表示为q_m的函数，再进一步在局部坐标系下表示向量p_a3p_a2；最后，根据连杆p_a2-p_a3长度为一定值，即可求解出电机的实际转动角度q_m＝-0.1。

以上实施例仅用于说明本发明的设计思想和特点，其目的在于使本领域内的技术人员能够了解本发明的内容并据以实施，本发明的保护范围不限于上述实施例。所以，凡依据本发明所揭示的原理、设计思路所作的等同变化或修饰，均在本发明的保护范围之内。

Claims (4)

1.一种高能效轻量化结构双足机器人的逆运动学求解方法，其特征在于，包括以下步骤：

步骤一，可以采用旋量法建立机器人坐标系，并构造表征姿态信息的矢量，进而构建出用于逆运动学求解的表达式方程，根据期望的末端位置采用牛顿拉夫逊算法对机器人的逆运动学进行数值求解获得机器人各关节角度。

步骤二，基于步骤一得到的关节角度，可以采用几何方法计算出各关节驱动电机需要转动的角度。

2.如权利要求1所述高能效轻量化结构双足机器人的逆运动学求解方法，其特征在于，所述步骤一具体为：

首先，利用旋量法建立机器人坐标系并获得机器人位姿的表达式；在初始状态下，各关节角度为0，各关节的局部坐标系与世界坐标系平行；机器人第i个关节角度q_i相对第i-1个关节角度q_i-1的齐次变换矩阵

为：

其中，a_i为关节角度q_i的单位转轴向量，

表示由a_i生成的斜对称矩阵，b_i表示关节角度q_i-1局部坐标系下q_i局部坐标系原点的位置矢量，

的表达如下：

其中，E为单位矩阵；基于齐次转换矩阵

机器人关节角度q_i的位姿矩阵为T_i：

其中，R_i为关节角度q_i的姿态矩阵，p_i为关节角度q_i的绝对位置矢量，R₀和p₀分别为机器人起始杆件的位姿矩阵和绝对位置矢量；基于位姿矩阵T_i，令第j个关节角度q_j为机器人的末端关节角度，则机器人末端的位姿矩阵T_j为：

然后，基于机器人末端的位姿矩阵T_j，构建机器人逆运动学求解的表达式方程：

f(q)＝f_ref

其中，

q＝[q₁,…,q_j]^T为机器人关节角度组成的向量，p_ref为末端位置矢量的期望值，向量v_or构造如下：

v_or＝[M(1,1) M(2,2) M(3,3)]^T

其中，矩阵

为机器人末端期望姿态矩阵R_ref的转置。

接着，利用牛顿拉夫逊算法对方程f(q)＝f_ref进行求解，方程求解的迭代方程如下：

X_k＝X_k-1-J^-1(f(X_k-1)-f_ref)

其中，X_k为向量q在第k次的迭代值；

J^-1为J的逆，X₀为关节角度向量q的初始估计值；当向量f(X_k)-f_ref的欧几里得范数小于阈值λ时，迭代终止，最终得到关节角度向量q＝X_k。

3.如权利要求1所述高能效轻量化结构双足机器人的逆运动学求解方法，其特征在于，所述阈值λ＝10^-7。

4.如权利要求1所述高能效轻量化结构双足机器人的逆运动学求解方法，其特征在于，所述步骤二中，机器人踝关节驱动电机的输出曲柄、连杆以及起始杆件构成空间四边形，计算采用踝关节驱动电机需要转动的角度具体为：首先，找到该空间四边形中可基于局部坐标系表示的三个顶点，即连杆与起始杆件的连接点、电机输出曲柄与电机的连接点以及机器人起始杆件上的一个固定点，所述固定点位于电机输出曲柄的运动平面内，并在局部坐标系下对三个顶点进行表达；然后，将电机输出曲柄末端的位置表示为电机转动角度的函数，进而表示出连杆在局部坐标系下的位置向量；最后，根据连杆的长度，计算出踝关节驱动电机实际需要转动的角度。

Images