一种仿人机器人摆动腿迈步的能效优化控制方法技术

本发明专利技术提供了一种仿人机器人摆动腿迈步的能效优化控制方法，其基于给定的初始、末位时刻的状态和单脚支撑起时间获得对应于评价函数的运动轨迹；通过建立仿人机器人摆动腿的模型的动力学方程，建立非线性状态方程，建立评价函数，运用遗传算法获得对应于评价函数的运动轨迹；通过设置所述评价函数中的权重系数，获得具有不同运动效果的运动轨迹。通过自主选择使评价函数最小化，获得最优运动轨迹，实现对仿人机器人行走时摆动腿的运动优化，减少能耗，提高仿人机器人的续航能力。

【技术实现步骤摘要】

本专利技术涉及一种仿人机器人，具体涉及一种仿人机器人摆动腿迈步的能效优化控制方法。
技术介绍
仿人机器人是与人类最接近的一种机器人，和其他构形的机器人相比，仿人机器人在外形上更加友好，同时能方便地使用为人类专利技术设计的各种工具，更容易适应人类生活环境。随着科技的发展，人们对智能机器人的需求日益增长。仿人机器人具有广阔的发展前景。仿人机器人已经能够实现稳定的行走。然而，为了满足仿人机器人实用化需求，必须减小仿人机器人的能耗。一种有效可行的方法是通过调整仿人机器人的行走步态来减小行走过程中摆动腿的力矩和速度，达到减小能耗的目的。仿人机器人作为一个多自由度、非线性、强耦合的多刚体系统，其行走步态是腿部所有关节之间的耦合作用和身体结构比例关系的集中体现，步态优化需要综合考虑运动学参数、动力学参数、运动约束和初始条件。有必要寻求一种耗能小、拟人化程度高的运动轨迹以提高仿人机器人的实用性。在公开号为CN101847009A的中国专利中公开了一种双足机器人步态能效优化方法，该方法不仅需要建立一整套的能效评估模型，而且求解过程繁琐，收敛速度较慢。在论文《Sagittalgaitofabipedrobotduringthesinglesupportphase.Part2:optimalmotion》中提出了一种仿人机器人摆动腿运动的优化方法，但该方法只考虑了运动过程中关节力矩的最小化，并没有考虑到摆动腿在运动过程中的能量消耗。本专利针对上述现有技术的缺陷，提出一种高效便捷的能效评估方式，充分考虑了摆动腿运动过程中的力矩和能量消耗，并将其应用到仿人机器人摆动腿的步态规划中。该方法不仅能有效减小仿人机器人行走过程中的能耗，而且效率高、收敛速度快，并具有较好的精度。
技术实现思路
本专利技术提供了一种提出一种优化仿人机器人摆动腿运动轨迹的方案，通过优化算法得到满足评价函数的摆动腿运动轨迹。通过自主选择改变评价函数的权重系数可实现不同的优化目标。本专利技术的仿人机器人摆动腿迈步的能效优化控制方法，基于给定的初始、末位时刻的状态和单脚支撑起时间获得对应于评价函数的运动轨迹；其包括如下步骤：(1)建立仿人机器人摆动腿的模型的动力学方程；(2)依据所述动力学方程建立非线性状态方程；(3)建立评价函数；(4)运用遗传算法获得对应于评价函数的运动轨迹；其特征在于：通过设置所述步骤(3)中的评价函数中的权重系数，获得具有不同运动效果的运动轨迹。根据上述的能效优化控制方法，其中，所述动力学方程为：M(θ)θ··+C(θ,θ·)=u]]>其中M(θ)∈R6×6是关节空间的惯性矩阵，是科氏力、离心力与重力的合力矢量，θ=θ1θ2θ3θ4θ5θ6,u=u1u2u3u4u5u6,]]>u1～u6为摆动腿关节1～6的驱动力矩，M(θ)是关节角度的函数，只与关节角度相关；是关节角度、角速度的函数，坐标系建立法则如下:平行于旋转轴的方向为杆件坐标系的Z轴。根据Z轴方向确定杆件坐标系的X轴的方向：若Zi-1轴的方向不平行于Zi轴的方向，则X轴的方向将垂直于Zi-1轴和Zi轴；若Zi-1轴的方向平行于Zi轴的方向，则Xi-1轴的方向为Zi-1轴与Zi轴的公垂线方向。由右手定则决定Y轴正方向。各角度的定义如说明书附图2所示：θ1：表示髋关节绕Z轴正方向所旋转的角度；θ2：表示髋关节绕Y轴正方向所旋转的角度；θ3：表示髋关节绕X轴正方向所旋转的角度；θ4：表示膝关节绕X轴正方向所旋转的角度；θ5：表示踝关节绕X轴正方向所旋转的角度；θ6：表示踝关节绕Y轴正方向所旋转的角度。根据上述的任一能效优化控制方法，其中，所述非线性状态方程为：x·=f(x,u)=θ·M-1(u-C)]]>其中u为该系统的控制量，x=θθ·,x·=θ·θ··;]]>所述评价函数为：J=xeTSxe+∫0t(xTQx+uTRu)dt]]>其中，xe是末位时刻的状态，S、Q、R为12*12的权重矩阵；τ∈[t0，tf]，t0为开始时间，tf为结束时间。根据上述的任一能效优化控制方法，其中，所述步骤(3)中还包括如下步骤：把所述动力学方程在高斯点上进行离散，将时间区间τ∈[t0，tf]转换到τ∈[-1，1]，这个转化可以通过下式完成：t=(tf-t0)τ+(tf+t0)2]]>转换后的τ取代t成为独立变量，τ＝-1时对应t0，τ＝1时对应tf；t0为开始时间，tf为结束时间；用N个高斯点τ1，τ2…，τN和初始端点t0＝-1上的离散状态构造Lagrange插值多项式去近似状态的时间历程：x(τ)≈X(τ)=Σi=0NX(τi)Li(τ)]]>式中：x(τ)为真实的状态时间历程，X(τ)为由Lagrange插值多项式近似得到的状态时间历程；Li(τ)为Lagrange插值基函数，i＝0,1,...，NLi(τ)=Πj=0,j≠iNτ-τiτi-τj]]>对时间求导，得x·(τ)≈X·(τ)=Σi=0NX(τi)L·i(τ)]]>由此对仿人机器人的脚部末位时刻的位置进行约束的微分方程动态转化为一系列代数约束：Σi=0NL·iXi-tf-t02f(Xk,Uk,τk;t0,tf)=0]]>式中：Xk＝X(τk),Uk＝U(τk),k＝1,2，…N；性能指标、边界条件和不等式约束分别转化为：J=φ(X0,t0,Xf,tf)+tf-t02Σk=1Nwkg(Xk,Uk,τk;t0,tf)]]>Φ(X0，t0，Xf，tf)＝0C(Xk，Uk，τk；t0，tf)≤0。式中Wk为高斯积分权重。根据上述的任一能效优化控制方法，其中，所述遗传算法用于优化求解评价函数的非线性规划问题，所述步骤(4)又包括如下步骤：(4.1)令j＝0，随机产生N个初始个体构成初始种群P(0)；(4.2)评价P(j)中各个体的适应值；(4.3)判断是否满足算法收敛准则，若满足，则输出搜索结果，否则执行下一步骤；(4.4)令m＝0；(4.5)根据适应本文档来自技高网...

【技术保护点】
一种仿人机器人摆动腿迈步的能效优化控制方法，基于给定的初始、末位时刻的状态和单脚支撑起时间获得对应于评价函数的运动轨迹；其包括如下步骤：(1)建立仿人机器人摆动腿的模型的动力学方程；(2)依据所述动力学方程建立非线性状态方程；(3)建立评价函数；(4)运用遗传算法获得对应于评价函数的运动轨迹；其特征在于：通过设置所述步骤(3)中的评价函数中的权重系数，获得具有不同运动效果的运动轨迹。

【技术特征摘要】
1.一种仿人机器人摆动腿迈步的能效优化控制方法，基于给定的初始、末位时刻的状态和单脚支撑起时间获得对应于评价函数的运动轨迹；其包括如下步骤：
(1)建立仿人机器人摆动腿的模型的动力学方程；
(2)依据所述动力学方程建立非线性状态方程；
(3)建立评价函数；
(4)运用遗传算法获得对应于评价函数的运动轨迹；
其特征在于：通过设置所述步骤(3)中的评价函数中的权重系数，获得具有不同运动效果的运动轨迹。
2.根据权利要求1所述的能效优化控制方法，其中，所述动力学方程为：
其中M(θ)∈R6×6是关节空间的惯性矩阵，是科氏力、离心力与重力的合力矢量，
u1～u6为摆动腿关节1～6的驱动力矩，M(θ)是关节角度的函数，只与关节角度相关；是关节角度、角速度的函数，坐标系建立法则如下:
平行于旋转轴的方向为杆件坐标系的Z轴。
根据Z轴方向确定杆件坐标系的X轴的方向：若Zi-1轴的方向不平行于Zi轴的方向，则X轴的方向将垂直于Zi-1轴和Zi轴；若Zi-1轴的方向平行于Zi轴的方向，则Xi-1轴的方向为Zi-1轴与Zi轴的公垂线方向。
由右手定则决定Y轴正方向。
各角度的定义如下：
θ1：表示髋关节绕Z轴正方向所旋转的角度；
θ2：表示髋关节绕Y轴正方向所旋转的角度；
θ3：表示髋关节绕X轴正方向所旋转的角度；
θ4：表示膝关节绕X轴正方向所旋转的角度；
θ5：表示踝关节绕X轴正方向所旋转的角度；
θ6：表示踝关节绕Y轴正方向所旋转的角度。
3.根据权利要求2所述的能效优化控制方法，其中，所述非线性状态方程为：
其中u为该系统的控制量，所述评价函数为：
其中，xe是末位时刻的状态，S、Q、R为12*12的权重矩阵；
τ∈[t0，tf]，t0为开始时间，tf为结束时间。
4.根据权利要求3所述的能效优化控制方法，其中，所述步骤(3)中还包括如下步骤：
把所述动力学方程在高斯点上进行离散，将时间区间τ∈[t0，tf]转换到τ∈[-1，1]，这个转化可以通过下式完成：
转换后的τ取代t成为独立变量，τ＝-1时对应t0，τ＝1时对应tf；t0为开始时间，tf为结束时间；
用N个高斯点τ1，τ2…，τN和初始端点t0＝-1上的离散状态构造Lagrange插值多项式去近似状态的时间历程：
式中：x(τ)为真实的状态时间历程，X(τ)为由Lagrange插值多项式近似得...

【专利技术属性】
技术研发人员：陈学超，黄强，余张国，罗舟，张伟民，孟立波，孙文涛，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京;11