[发明专利]一种仿人机器人稳定行走的控制方法

权利要求书

1.一种仿人机器人稳定行走的控制方法，其特征在于，方法包括以下步骤： 

步骡S1：获得机器人系统为补偿ZMP跟踪误差所需要产生的动量和角动量； 

步骤S2：基于微分运动学的方式，利用动量雅可比矩阵得到从机器人配置空间到机器人动量和角动量的映射； 

步骤S3：通过对动量雅可比矩阵进行阻尼伪逆计算，得到步骤S2中映射的反映射，进而获取机器人配置空间命令，其对应机器人行走中的动量补偿控制任务； 

步骤S4：采用动态优先级切换方式，将动量补偿控制任务分配，并产生机器人的各关节运动命令，进而控制机器人行走。 

2.根据权利要求1所述的一种仿人机器人稳定行走的控制方法，其特征在于，所述的步骤S1具体包括： 

101：基于坐标系构建机器人的ZMP计算式，给定测量ZMP和期望ZMP的水平位置分别为和令期望ZMP与测量ZMP的水平高度相同； 

102：为补偿ZMP跟踪误差，计算期望机器人系统的总动量和角动量为： 

其中，为当前测量的总动量，为当前测量的角动量，g为重力加速度向量，M为机器人总质量，p_z为ZMP的高度位置，为Z轴的动量； 

103：令采样周期为Δt，给定机器人系统在k时刻的动量为角动量为 则系统下一时刻所需的动量和角动量分别为： 

3.根据权利要求1所述的一种仿人机器人稳定行走的控制方法，其特征在于，所述的步骤S2具体包括： 

201：采用递归方法计算机器人各连杆的局部惯性张量，令与第j个关节相邻的第j-1个关节所驱动部分的总质量为质心为惯性张量为则由第j个关节所驱动部分的总质量质心和惯性张量计算公式如下： 

其中，R_j为第j个关节自身连杆旋转矩阵，c_j为其质心，m_j为其质量，I_j为其绕关节转轴惯性张量，且

202：计算第j个关节以角速度ω_j旋转时所产生的动量P_j、角动量L_j，公式如下： 

其中，p_j为第j个关节的位置； 

203：由步骤S1得到系统总动量以及总角动量，由配置空间到动量向量的线性映射可表示为： 

其中，为系统总质量，为总质心位置，E为3×3单位矩阵，为3×3系统绕质心的总惯性张量矩阵，为身体原点到质心的向量，为与另一向量叉乘的3×3反对称矩阵，为机器人关节角速度向量，υ_b为身体原点的线速度矢量，ω_b为身体原点的角速度矢量，J_M为动量雅可比矩阵，M_R和H_R为各个关节转动对系统总动量和角动量的贡献，且为3×n惯性矩阵，表示为： 

其中，M_j和H_j为分别与第j个关节动量和角动量对应的3×1向量，动量雅可比矩阵中与第j个关节对应的列向量满足下式： 

为第j个关节角速度向量，结合式(6)，则： 

其中，a_j为第j个关节转轴矢量。