CN106814610A - 基于非线性模型预测控制的双足机器人步态优化的信赖域‑sqp方法 - Google Patents
基于非线性模型预测控制的双足机器人步态优化的信赖域‑sqp方法 Download PDFInfo
- Publication number
- CN106814610A CN106814610A CN201710057967.7A CN201710057967A CN106814610A CN 106814610 A CN106814610 A CN 106814610A CN 201710057967 A CN201710057967 A CN 201710057967A CN 106814610 A CN106814610 A CN 106814610A
- Authority
- CN
- China
- Prior art keywords
- biped
- biped robot
- sqp
- model predictive
- trusted zones
- 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.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种双足机器人领域的步态优化控制方法,具体涉及一种基于模型预测控制的双足机器人步态优化的信赖域‑SQP方法。基于非线性模型预测控制技术,利用信赖域‑SQP方法具有的超线性收敛速率和全局收敛性快速求解最优控制,实现双足机器人的最优运动步态。由于目标函数的性质很差,需要耗费大量时间确定搜索步长,从而,实时性失效。本发明利用非线性模型预测控制技术把机器人动力学模型转化为非线性优化模型,提出具有快速收敛特性的信赖域‑SQP算法,求解满足实时性的最优控制。该发明解决了传统控制器求解过程中实时性难实现的缺陷,该发明还可以推广到多自由度双足机器人,为多自由度双足机器人的实时控制求解提供参考。
Description
技术领域
本发明涉及一种双足机器人领域的步态优化控制方法,具体涉及一种基于非线性模型预测控制的双足机器人步态优化的信赖域-SQP方法。
技术背景
近年来,越来越多的国家将机器人研究纳入国家发展计划,美国《先进制造业国家战略计划》、欧盟SPARC民用机器人研发计划、《中国制造2025》、日本《机器人新战略》、韩国《机器人未来战略2022》等纷纷将机器人发展纳入国家科技创新和产业发展的重点研究领域。机器人已然成为新一轮科技革命与产业变革背景下世界各国产业竞争的焦点。在新科技革命和产业革命的交汇点上,以机器人科技为代表的一类智能产业蓬勃兴起,成为当今时代科技创新的一个重要标志。在分析和借鉴人类行走特性基础上,研究者们已经研制并开发出多款更趋合理完善的双足机器人。随着原型机结构与运行环境工况的复杂性不断提高,给***控制结构与算法综合提出了更高的要求,特别是有关步态优化控制问题给研究者们提出了新的挑战。
目前用于步态优化控制的方法主要包括如下几类。例如,动态平衡控制理论、基于SLIP(Spring load inverted pendulum)模型的步态优化控制理论、基于仿生学的优化控制理论、时间放缩控制理论、几何规约控制理论、混合零动态控制理论以及离散力学与优化控制理论等等。上述步态优化控制理论有其各自的优缺点。例如,基于仿生学的优化控制理论不仅需要进行大量的实验研究,从仿生学角度设计的控制方法还要用到现实中人的动作数据或者生物学结构,但是,被测试者的身体质量分布和几何尺寸与双足机器人略有差别,从而,导致人与机器人的动力学-运动学数学模型存在很大的差别,把该方法直接应用到实际机器人***控制过程中,可导致***存在偏差,因此,破坏了机器人的动态稳定行走。基于混合零动态思想设计的控制器虽然实现了双足机器人的动态稳定行走,但是该方法需要预先已知双足机器人精确的动力学数学模型,否则,该方法便会失效,从而,导致机器人不可能实现稳定的周期运动。利用离散力学与优化控制理论可以实现双足机器人的动态稳定行走,但是,对于变化工况条件下,该方法不能够对机器人***进行实时控制。然而,非线性模型预测控制技术作为一种用于实时预测与控制方法,具有较强的鲁棒性和 适应性,其能够解决现有控制方法不具备实时性的问题。但是,采用非线性模型预测控制技术离散非线性动力学模型时,时常把动力学模型转化为非凸优化问题,提高了算法的计算复杂度,因此,给***的实时控制带来了巨大的挑战。
综上所述,现有的步态优化控制方法难以保证控制器对双足机器人***的实时控制,因而无法实现高效的、稳定的类人行走步态。
发明内容
本发明针对现有技术存在的上述不足,提出一类具有快速收敛特性的信赖域-SQP算法求解双足机器人步态优化问题,算法的设计满足了实际被控***对控制器的实时性要求,提高了双足机器人步态优化效率。
在此基础上,本发明提出一类具有快速收敛特性的信赖域-SQP算法,利用计算机的编写程序控制整个动态行走过程,具体步骤描述如下:
步骤一,建立一类Compass-like双足机器人动力学数学模型,并且分析双足机器人的运动步态;
步骤二,利用非线性模型预测控制技术,把Compass-like双足机器人的动力学数学模型转化为带有约束条件的非线性优化数学模型;
步骤三,建立一类具有超线性收敛特性的信赖域-SQP算法,求解Compass-like双足机器人的最优控制;
步骤四,利用Compass-like双足机器人进行数值模拟,检验提出算法的可行性和有效性。
建立Compass-like双足机器人动力学数学模型:
步骤一,Compass-Like双足机器人摆动阶段的Lagrangian数学模型
其中,q=(θns(t),θs(t)),θns(t)和θs(t)分别代表摆动腿和支撑腿与竖直方向的角位移,代表摆动腿和支撑腿的角速度,代表***动能,V(q)代表***势能。同时对(1)求导
因此,摆动阶段的动力学方程为
其中,u=[uns,us]T为控制力矩。如果双足机器人为完全被动行走机器人,那么控制力矩为u=[0,0]T。M(q)∈R2×2为***的惯性矩阵,为离心力和哥氏力矩阵,G(q)∈R2×1为重力矩阵。
步骤二,利用角动量守恒定理,Compass-Like双足机器人碰撞切换阶段的代数映射方程
上角标“-”与“+”分别代表碰撞前、后时刻,其中
步骤三,结合摆动阶段和碰撞阶段的数学模型,把它们转化为如下状态空间模型。
定义状态变量为得到如下脉冲混合动力***:
其中,摆动阶段状态空间,S是碰撞曲面,Δ为碰撞映射。
为方便,(5)写成如下脉冲混合动力***
其中,和
分析步骤一所述的Compass-like双足机器人的运动步态:
阶段I,支撑腿触地,摆动腿向前摆动。
阶段II,摆动腿摆动至前方最大位置处。
阶段III,由于重力作用,摆动腿向回摆动。
阶段IV,摆动腿与地面碰撞,机器人双腿速度发生突变,并进行状态切换(碰撞前的摆动腿变为支撑腿,碰撞前的支撑腿变成摆动腿)。
利用非线性模型预测控制技术,把Compass-like双足机器人的动力学数学模型转化为带有约束条件的非线性优化数学模型:
步骤一,利用非线性模型预测控制技术,结合四阶龙格-库塔方法把双足机器人的动力学数学模型转化为如下形式的非线性优化模型。
其中,ak≤bk∈Rm,Q,P,R是正定矩阵。
步骤二,为方便把(7)转化为如下非线性优化数学模型。
s.t.q=Φ(q,u)
其中u∈[a,b]
u=[u0;u1;…,uN-1],a=[a0;a1;…,aN-1],b=[b0;b1;…,bN-1]
和
也即是,(8)转化为如下标准的非线性约束优化数学模型。
s.t.gj(x)≤0,j∈Ω={1,2,…,M}
…………(9)
其中,M为约束条件数。
提出一类具有超线性收敛特性的信赖域-SQP算法:
步骤一,数据初始化。假定如下参量取值范围如下:
ρ>0,δ>2,θ∈(0,1),v∈(0,1)
和
x0∈X,H0=I∈Rn×n,η0=ρ,η1=0.1,η2=0.9,0<θ1<1<θ2
其中X为迭代点的可行集。
步骤二,计算基本搜索方向通过求解如下形式的QP子问题求解KKT点。
如果则算法停止;如果则算法转入步骤三,否则,进入步骤四。
步骤三,信赖域试探步搜索。计算实际下降量,预优下降量和比率,其中,
实际下降量:
预优下降量:
比率:
如果rk>η1,则令dk=0,转入步骤五,否则转入步骤四。
步骤四,按照如下步骤计算可行下降方向。
步骤A,利用如下线性等式***,计算可行方向
其中
和
步骤B,根据基本搜索方向和下降方向,结合凸组合性质,计算如下形式的可行下降方向dk,
其中
如果||dk||≤Δk,转入步骤五,否则,令转入步骤五。
步骤五,更新迭代点。按照如下计算公式更新迭代点。
再令k:=k+1,返回步骤二。
检验提出信赖域-SQP算法的可行性和有效性。
步骤一,选取如下Compass-like双足机器人的物理参数
m=2kg,M=10kg,a=b=0.5,L=1m,g=9.8N/kg,α=0.5rad,h=0.1。
步骤二,选取信赖域-SQP算法所需要的参数
ρ=1,v=0.5,δ=2.5,θ=0.5,η1=0.1,η2=0.9,θ1=0.5,θ2=2。
步骤三,利用非线性模型预测控制技术,令N=2,因此,算法所需要的初始点选取为
q0=[-0.3234 0.2186 -0.3379 -0.0922 -0.3401 0.1268 -0.0023 -0.7515 -0.3283 0.0647 0.2305 -0.4977]和
u0=[0.01 0.02]。
P、Q、R均取相应阶数的单位矩阵。
与现有技术相比,本发明的优点和效果在于利用非线性模型预测控制技术,提出了一类具有超线性收敛特性的信赖域-SQP算法,实时求解双足机器人的最优控制输入,实现双足机器人高效的、稳定的类人行走步态。
本发明所提供的技术方案的积极效果是:
利用非线性模型预测控制技术求解双足机器人的最优控制输入与目前通用的控制输
入求解方法相比,它满足了双足机器人***对控制器的实时性要求,而且计算简单,容易实现。
本发明提出的一类具有超线性收敛特性的信赖域-SQP算法包括三个循环体。它与传
统信赖域-SQP算法相比,扩大了下一次迭代点的接受范围,并且,当QP子问题不相容时,利用信赖域试探步搜索技术,无需重新求解QP子问题,提高了算法的计算效率。
利用凸组合技术,结合基本搜索方向和可行方向,设计可行下降方向。可行方向的
求解只需求解一个线性***,与目前通用的QP子问题求解相比,本发明提出 的可行方向求解方法简单易行。并且,搜索方向的可行下降性分析不依赖于任何线搜索准则条件,大大提高了算法的计算效率。
本发明的信赖域-SQP算法的时间复杂度要低于目前已有的算法。在求解可行方向、
下降方向、高阶校正方向的过程中,目前通用的方法一般都是采用求解相应方向的二次规划子问题,然而,本发明采用求解一个二次规划子问题和线性***以及凸组合的形式大大降低了算法的时间复杂度,从而,提高了算法的计算效率。
总而言之,本发明在保证了快速求解最优控制输入的情况下,有效提高了双足机器人系
统的实时性,实现了双足机器人的步态优化控制。
附图说明
图1为本发明的工作流程框图;
图2为Compass-like双足机器人;
图3为Compass-like双足机器人的行走周期步态;
图4为信赖域-SQP算法流程图;
图5为Compass-like双足机器人闭环控制***原理图;
图6为关节角与时间函数曲线关系图;
图7为Compass-like双足机器人的角位移与角速度形成的极限环;
图8为摆动腿与地面高度和时间的函数曲线关系图;
图9为Compass-like双足机器人的行走棍图;
具体实施方式
1.参阅图1、图2、图3、图4、图5、图6、图7、图8和图9,本具体实施方式提供一种基于非线性模型预测控制的双足机器人步态优化的信赖域-SQP方法,具体步骤描述如下:
1)建立Compass-like双足机器人动力学数学模型:
Compass-Like双足机器人摆动阶段的Lagrangian数学模型
其中,q=(θns(t),θs(t)),θns(t)和θs(t)分别代表摆动腿和支撑腿与竖直方向的角位移,代表摆动腿和支撑腿的角速度,代表***动能,V(q)代表***势能。同时对(1)求导
因此,摆动阶段的动力学方程为
其中,u=[uns,us]T为控制力矩。如果双足机器人为完全被动行走机器人,那么控制力矩为u=[0,0]T。M(q)∈R2×2为***的惯性矩阵,为离心力和哥氏力矩阵,G(q)∈R2×1为重力矩阵。
利用角动量守恒定理,Compass-Like双足机器人碰撞切换阶段的代数映射方程
上角标“-”与“+”分别代表碰撞前、后时刻,其中
结合摆动阶段和碰撞阶段的数学模型,把它们转化为如下状态空间模型。
定义可以得到如下脉冲混合动力***:
其中,摆动阶段状态空间,S是碰撞曲面,Δ为碰撞映射。
为方便,(5)写成如下脉冲混合动力***
其中,和
2)分析Compass-like双足机器人的运动步态:
阶段I,支撑腿触地,摆动腿向前摆动。
阶段II,摆动腿摆动至前方最大位置处。
阶段III,由于重力作用,摆动腿向回摆动。
阶段IV,摆动腿与地面碰撞,机器人双腿速度发生突变,并进行状态切换(碰撞前的摆动腿变为支撑腿,碰撞前的支撑腿变成摆动腿)。
3)利用非线性模型预测控制技术,结合四阶龙格-库塔方法把双足机器人的动力学数学模型转化为如下形式的非线性优化模型。
其中,ak≤bk∈Rm,Q,P,R是正定矩阵。
为方便把(7)通过等价转化的形式,转化为如下非线性优化数学模型。
s.t.q=Φ(q,u)
其中u∈[a,b]
u=[u0;u1;…,uN-1],a=[a0;a1;…,aN-1],b=[b0;b1;…,bN-1]
和
也即是,(8)转化为如下标准的非线性约束优化数学模型。
其中,M为约束条件数。
4)提出一类具有超线性收敛特性的信赖域-SQP算法:
步骤一,数据初始化。假定如下参量取值范围如下:
ρ>0,δ>2,θ∈(0,1),v∈(0,1)
和
x0∈X,H0=I∈Rn×n,η0=ρ,η1=0.1,η2=0.9,0<θ1<1<θ2
其中X为迭代点的可行集。
步骤二,计算基本搜索方向通过求解如下形式的QP子问题求解KKT点。
如果则算法停止;如果则算法转入步骤三,否则,进入步骤四。
步骤三,信赖域试探步搜索,计算实际下降量,预优下降量和比率,其中,实际下降量:
预优下降量:
比率:
如果rk>η1,则令dk=0,转入步骤五,否则转入步骤四。
步骤四,按照如下步骤计算可行下降方向。
步骤A,利用如下线性等式***,计算可行方向
其中
和
步骤B,根据基本搜索方向和下降方向,结合凸组合性质,计算如下形式的可行下降方向dk,
其中
如果||dk||≤Δk,转入步骤五,否则,令转入步骤五。
步骤五,更新迭代点。按照如下计算公式更新迭代点。
再令k:=k+1,返回步骤二。
5)检验提出信赖域-SQP算法的可行性和有效性。
选取如下Compass-like双足机器人的物理参数
m=2kg,M=10kg,a=b=0.5,L=1m,g=9.8N/kg,α=0.5rad,h=0.1。
选取信赖域-SQP算法所需要的参数
ρ=1,v=0.5,δ=2.5,θ=0.5,η1=0.1,η2=0.9,θ1=0.5,θ2=2。
利用非线性模型预测控制技术,令N=2,因此,算法所需要的初始点选取为
q0=[-0.3234 0.2186 -0.3379 -0.0922 -0.3401 0.1268 -0.0023 -0.7515 -0.3283 0.0647 0.2305 -0.4977]和
u0=[0.01 0.02]。
P、Q、R均取相应阶数的单位矩阵。
本发明是一种基于非线性模型预测控制技术的双足机器人步态优化控制方法,以一个Compass-like双足机器人实施例并结合附图说明及具体操作步骤如下:
1)在算法实施例中,我们选择较为简单的Compass-like双足机器人作为实施例对象,具体见图[2]。虽然结构简单,但是,可以充分说明我们提出算法的可行性和有效性,并且,可以通过对本发明做适当的修改,便可把本发明推广到多自由度的双足机器人,因此,不会影响本发明的适用范围。利用Lagrangian原理和角动量守恒条件,建立Compass-like双足机器人动力学模型,并且通过计算机符号计算表达该类模型,便于算法实现。Compass-Like双足机器人由两条腿构成,上身简化为髋关节点质量。两条腿的长度相同,质量为m,腿长为L=a+b,其中,a代表腿的质心到腿的末端的长度,b代表腿的质心到髋关节的距离。θns代表摆动腿与竖直方向的夹角,θs代表支撑腿与竖直方向的夹角,并且,记逆时针方向为正方向。当摆动腿与地面接触时,两条腿之间的夹角为α。我们选取如下形式的双足机器人的物理参数。
m=2kg,M=10kg,a=b=0.5,L=1m,α=0.5rad。
2)利用非线性模型预测控制技术,结合四阶龙格-库塔方法,以低能耗作为性能指标,把Compass-like双足机器人连续的动力学数学模型转化为离散的非线 性优化数学模型,为求解最优控制输入奠定基础。采用四阶龙格-库塔方法离散连续动力学模型过程中,离散步长选取为h=0.1,并且,模型预测控制中的预测步长选取为N=2。
3)为了能够很好的实施信赖域-SQP算法,具体见图[4]。我们选取如下参数
ρ=1,v=0.5,δ=2.5,θ=0.5,η1=0.1,η2=0.9,θ1=0.5,θ2=2。
实际上,这些参数不是固定不变的,只要符合本发明提出的信赖域-SQP算法参数选取范围,本算法均为可行的、有效的。只是在计算速度上,会有一定的影响,但是,一般不会出现特别差的情况。
4)为了求解双足机器人的最优控制输入,我们选取非线性优化模型的初始点和初始控制输入分别为
q0=[-0.3234 0.2186 -0.3379 -0.0922 -0.3401 0.1268 -0.0023 -0.7515 -0.3283 0.0647 0.2305 -0.4977]和
u0=[0.01 0.02]。
通过上面两个初始点的选取,本发明提出的信赖域-SQP算法便可以实时求解最优控制输入,再把控制输入带入双足机器人动力学模型中,结合Matlab软件库中的ODE命令,便可求解双足机器人的关节角最优运动轨迹、摆动腿与地面高度变化、极限环以及行走棍图,具体见图[6-9]。
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。例如,可以适当增加双足机器人的关节自由度,把本发明推广到多自由度的双足机器人等等。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。
Claims (6)
1.基于非线性模型预测控制的双足机器人步态优化的信赖域-SQP方法,其特征在于,包括如下步骤:
步骤一,建立一类Compass-like双足机器人动力学数学模型,并且分析双足机器人的运动步态;
步骤二,利用非线性模型预测控制技术,把Compass-like双足机器人的动力学数学模型转化为带有约束条件的非线性优化数学模型;
步骤三,建立一类具有超线性收敛特性的信赖域-SQP算法求解Compass-like双足机器人的最优控制;
步骤四,利用Compass-like双足机器人进行数值模拟,检验提出算法的可行性和有效性。
2.根据权利要求1所述的基于非线性模型预测控制的双足机器人步态优化的信赖域-SQP方法,其特征在于,步骤一所述的Compass-like双足机器人动力学数学模型建立步骤如下
步骤一,Compass-Like双足机器人摆动阶段的Lagrangian数学模型
其中,q=(θns(t),θs(t)),θns(t)和θs(t)分别代表摆动腿和支撑腿与竖直方向的角位移,代表摆动腿和支撑腿的角速度,代表***动能,V(q)代表***势能,同时对(1)求导
因此,摆动阶段的动力学方程为
其中,u=[uns,us]T为控制力矩。如果双足机器人为完全被动行走机器人,那么控制力矩为u=[0,0]T,M(q)∈R2×2为***的惯性矩阵,为离心力和哥氏力矩阵,G(q)∈R2×1为重力矩阵;
步骤二,利用角动量守恒定理,Compass-Like双足机器人碰撞切换阶段的代数映射方程
上角标“-”与“+”分别代表碰撞前、后时刻,其中
步骤三,结合摆动阶段和碰撞阶段的数学模型,把它们转化为如下状态空间模型;
定义状态变量为得到如下脉冲混合动力***:
其中,摆动阶段状态空间,S是碰撞曲面,Δ为碰撞映射;
为方便,(5)写成如下脉冲混合动力***
其中,和
3.根据权利要求1所述的基于非线性模型预测控制的双足机器人步态优化的信赖域-SQP方法,其特征在于,步骤一所述的Compass-like双足机器人运动步态如下:
阶段I,支撑腿触地,摆动腿向前摆动;
阶段II,摆动腿摆动至前方最大位置处;
阶段III,由于重力作用,摆动腿向回摆动;
阶段IV,摆动腿与地面碰撞,机器人双腿速度发生突变,并进行状态切换(碰撞前的摆动腿变为支撑腿,碰撞前的支撑腿变成摆动腿)。
4.根据权利要求1所述的基于非线性模型预测控制的双足机器人步态优化的信赖域-SQP方法,其特征在于,步骤二所述的利用非线性模型预测控制技术把Compass-like双足机器人的动力学数学模型转化为带有约束条件的非线性优化数学模型,具体步骤如下:
步骤一,利用非线性模型预测控制技术,结合四阶龙格-库塔方法把双足机器人的动力学数学模型转化为如下形式的非线性优化模型
其中,ak≤bk∈Rm,Q,P,R是正定矩阵;
步骤二,为方便把(7)转化为如下非线性优化数学模型
其中
u=[u0;u1;…,uN-1],a=[a0;a1;…,aN-1],b=[b0;b1;…,bN-1]
和
也即是,(8)转化为如下标准的非线性约束优化数学模型
其中,M为约束条件数。
5.根据权利要求1所述的基于非线性模型预测控制的双足机器人步态优化的信赖域-SQP方法,其特征在于,步骤三所述的一类具有超线性收敛特性的信赖域-SQP算法建立步骤如下:
步骤一,数据初始化,假定如下参量取值范围如下
ρ>0,δ>2,θ∈(0,1),v∈(0,1)
和
x0∈X,H0=I∈Rn×n,η0=ρ,η1=0.1,η2=0.9,0<θ1<1<θ2
其中X为迭代点的可行集;
步骤二,计算基本搜索方向通过求解如下形式的QP子问题求解KKT点
如果则算法停止;如果则算法转入步骤三,否则,进入步骤四;
步骤三,信赖域试探步搜索,计算实际下降量,预优下降量和比率,其中,实际下降量:
预优下降量:
比率:
如果rk>η1,则令dk=0,转入步骤五,否则转入步骤四;
步骤四,按照如下步骤计算可行下降方向;
步骤A,利用如下线性等式***,计算可行方向
其中
和
步骤B,根据基本搜索方向和下降方向,结合凸组合性质,计算如下形式的可行下降方向dk,
其中
如果||dk||≤Δk,转入步骤五,否则,令转入步骤五;
步骤五,更新迭代点,按照如下计算公式更新迭代点
再令k:=k+1,返回步骤二。
6.根据权利要求1所述的基于非线性模型预测控制的双足机器人步态优化的信赖域-SQP方法,其特征在于,步骤四所述的检验提出信赖域-SQP算法的可行性和有效性具体步骤如下
步骤一,选取如下Compass-like双足机器人的物理参数
m=2kg,M=10kg,a=b=0.5,L=1m,g=9.8N/kg,α=0.5rad,h=0.1;
步骤二,选取信赖域-SQP算法所需要的参数
ρ=1,ν=0.5,δ=2.5,θ=0.5,η1=0.1,η2=0.9,θ1=0.5,θ2=2;
步骤三,利用非线性模型预测控制技术,令N=2,因此,算法所需要的初
始点选取为
q0=[-0.32340.2186-0.3379-0.0922-0.34010.1268-0.0023-0.7515-0.32830.06470.2305-0.4977]和
u0=[0.010.02]
P、Q、R均取相应阶数的单位矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710057967.7A CN106814610A (zh) | 2017-01-23 | 2017-01-23 | 基于非线性模型预测控制的双足机器人步态优化的信赖域‑sqp方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710057967.7A CN106814610A (zh) | 2017-01-23 | 2017-01-23 | 基于非线性模型预测控制的双足机器人步态优化的信赖域‑sqp方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106814610A true CN106814610A (zh) | 2017-06-09 |
Family
ID=59112212
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710057967.7A Pending CN106814610A (zh) | 2017-01-23 | 2017-01-23 | 基于非线性模型预测控制的双足机器人步态优化的信赖域‑sqp方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106814610A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108099877A (zh) * | 2017-12-18 | 2018-06-01 | 长春工业大学 | 一种紧急制动工况下滑移率跟踪控制方法 |
CN108099876A (zh) * | 2017-12-18 | 2018-06-01 | 长春工业大学 | 一种基于模型预测的电动汽车防抱死控制方法 |
CN109164705A (zh) * | 2018-08-15 | 2019-01-08 | 重庆大学 | 一种动态双足步行机器人鲁棒控制方法 |
CN109434835A (zh) * | 2018-11-23 | 2019-03-08 | 杭州电子科技大学 | 一种基于低延迟输出反馈模型的机器人预测控制方法 |
CN111198581A (zh) * | 2020-01-17 | 2020-05-26 | 同济大学 | 虚拟被动行走机器人速度调节方法及装置、存储介质终端 |
CN112743538A (zh) * | 2019-10-30 | 2021-05-04 | 皮尔茨公司 | 模型预测相互作用控制 |
CN113220004A (zh) * | 2021-04-15 | 2021-08-06 | 海南大熊软件科技有限公司 | 四足机器人步态控制方法、四足机器人以及计算机可读存储介质 |
CN114137840A (zh) * | 2021-11-29 | 2022-03-04 | 深圳市优必选科技股份有限公司 | 足式机器人全局平衡控制方法、装置和足式机器人 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05337849A (ja) * | 1992-05-29 | 1993-12-21 | Honda Motor Co Ltd | 脚式移動ロボットの姿勢安定化制御装置 |
US5371669A (en) * | 1992-06-18 | 1994-12-06 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Sliding mode control method having terminal convergence in finite time |
WO2003099525A2 (en) * | 2002-05-20 | 2003-12-04 | The Regents Of The University Of California | Design of robotic gait rehabilitation by optimal motion of the hip |
CN1758161A (zh) * | 2005-11-11 | 2006-04-12 | 燕山大学 | 基于非线性约束预测控制的最优化控制方法 |
CN101847009A (zh) * | 2010-05-28 | 2010-09-29 | 广东工业大学 | 两足机器人步态能效优化方法 |
CN102411305A (zh) * | 2011-11-11 | 2012-04-11 | 南京航空航天大学 | 单旋翼直升机/涡轴发动机综合抗扰控制***设计方法 |
CN102887188A (zh) * | 2012-10-17 | 2013-01-23 | 同济大学 | 基于能量最优的双足被动行走步态控制方法 |
CN103019096A (zh) * | 2012-11-23 | 2013-04-03 | 北京理工大学 | 一种基于加速度优化的仿人机器人逆动力学控制器 |
CN104460318A (zh) * | 2013-09-25 | 2015-03-25 | 北京化工大学 | 一种基于闭环过程信息约束的前向通道模型多目标优化辨识整定方法 |
CN105388755A (zh) * | 2015-05-12 | 2016-03-09 | 北京理工大学 | 一种仿人机器人摆动腿迈步的能效优化控制方法 |
CN105599816A (zh) * | 2015-10-20 | 2016-05-25 | 浙江大学 | 一种3d欠驱动双足机器人跳跃运动的步态规划方法 |
-
2017
- 2017-01-23 CN CN201710057967.7A patent/CN106814610A/zh active Pending
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05337849A (ja) * | 1992-05-29 | 1993-12-21 | Honda Motor Co Ltd | 脚式移動ロボットの姿勢安定化制御装置 |
US5371669A (en) * | 1992-06-18 | 1994-12-06 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Sliding mode control method having terminal convergence in finite time |
WO2003099525A2 (en) * | 2002-05-20 | 2003-12-04 | The Regents Of The University Of California | Design of robotic gait rehabilitation by optimal motion of the hip |
CN1758161A (zh) * | 2005-11-11 | 2006-04-12 | 燕山大学 | 基于非线性约束预测控制的最优化控制方法 |
CN101847009A (zh) * | 2010-05-28 | 2010-09-29 | 广东工业大学 | 两足机器人步态能效优化方法 |
CN102411305A (zh) * | 2011-11-11 | 2012-04-11 | 南京航空航天大学 | 单旋翼直升机/涡轴发动机综合抗扰控制***设计方法 |
CN102887188A (zh) * | 2012-10-17 | 2013-01-23 | 同济大学 | 基于能量最优的双足被动行走步态控制方法 |
CN103019096A (zh) * | 2012-11-23 | 2013-04-03 | 北京理工大学 | 一种基于加速度优化的仿人机器人逆动力学控制器 |
CN104460318A (zh) * | 2013-09-25 | 2015-03-25 | 北京化工大学 | 一种基于闭环过程信息约束的前向通道模型多目标优化辨识整定方法 |
CN105388755A (zh) * | 2015-05-12 | 2016-03-09 | 北京理工大学 | 一种仿人机器人摆动腿迈步的能效优化控制方法 |
CN105599816A (zh) * | 2015-10-20 | 2016-05-25 | 浙江大学 | 一种3d欠驱动双足机器人跳跃运动的步态规划方法 |
Non-Patent Citations (2)
Title |
---|
孙中波: "动态双足机器人有限时间稳定性分析与步态优化控制研究", 《中国博士学位论文全文数据库 信息科技辑》 * |
孙中波等: "不等式约束优化超线性收敛的信赖域-SQP算法", 《应用数学学报》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108099877A (zh) * | 2017-12-18 | 2018-06-01 | 长春工业大学 | 一种紧急制动工况下滑移率跟踪控制方法 |
CN108099876A (zh) * | 2017-12-18 | 2018-06-01 | 长春工业大学 | 一种基于模型预测的电动汽车防抱死控制方法 |
CN108099876B (zh) * | 2017-12-18 | 2020-05-22 | 长春工业大学 | 一种基于模型预测的电动汽车防抱死控制方法 |
CN109164705A (zh) * | 2018-08-15 | 2019-01-08 | 重庆大学 | 一种动态双足步行机器人鲁棒控制方法 |
CN109434835A (zh) * | 2018-11-23 | 2019-03-08 | 杭州电子科技大学 | 一种基于低延迟输出反馈模型的机器人预测控制方法 |
CN109434835B (zh) * | 2018-11-23 | 2020-10-09 | 杭州电子科技大学 | 一种基于低延迟输出反馈模型的机器人预测控制方法 |
CN112743538A (zh) * | 2019-10-30 | 2021-05-04 | 皮尔茨公司 | 模型预测相互作用控制 |
CN111198581A (zh) * | 2020-01-17 | 2020-05-26 | 同济大学 | 虚拟被动行走机器人速度调节方法及装置、存储介质终端 |
CN111198581B (zh) * | 2020-01-17 | 2021-02-12 | 同济大学 | 虚拟被动行走机器人速度调节方法及装置、存储介质终端 |
CN113220004A (zh) * | 2021-04-15 | 2021-08-06 | 海南大熊软件科技有限公司 | 四足机器人步态控制方法、四足机器人以及计算机可读存储介质 |
CN114137840A (zh) * | 2021-11-29 | 2022-03-04 | 深圳市优必选科技股份有限公司 | 足式机器人全局平衡控制方法、装置和足式机器人 |
CN114137840B (zh) * | 2021-11-29 | 2024-02-27 | 深圳市优必选科技股份有限公司 | 足式机器人全局平衡控制方法、装置和足式机器人 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106814610A (zh) | 基于非线性模型预测控制的双足机器人步态优化的信赖域‑sqp方法 | |
CN103970989B (zh) | 一种基于流固界面一致条件的浸入边界流场计算方法 | |
CN105093934B (zh) | 考虑干扰与模型不确定性的多机器人***分布式有限时间跟踪控制方法 | |
Gritli et al. | OGY-based control of chaos in semi-passive dynamic walking of a torso-driven biped robot | |
CN103538068A (zh) | Scara机器人模糊滑模轨迹跟踪控制方法 | |
CN111125963B (zh) | 基于拉格朗日积分点有限元的数值仿真***及方法 | |
CN103433924A (zh) | 串联机器人高精度位置控制方法 | |
CN103927451A (zh) | 一种空间机器人***参数在轨辨识方法 | |
Kim et al. | Eulerian shape design sensitivity analysis and optimization with a fixed grid | |
CN103869983A (zh) | 一种用于力触觉人机交互的柔性物体变形仿真方法 | |
CN104298857B (zh) | 一种多因素耦合作用下的机构可靠度计算方法 | |
CN107274490A (zh) | 一种考虑材料损伤和钢筋作用的自由曲面结构形态创建方法 | |
CN108205516A (zh) | 一种基于条件传递的海洋结构流固耦合动力响应算法 | |
CN107856035A (zh) | 一种基于强化学习和全身控制器的鲁棒性动态运动方法 | |
CN106019950A (zh) | 一种手机卫星自适应姿态控制方法 | |
CN105938364A (zh) | 一种3d欠驱动双足机器人的动力学模型计算方法 | |
CN106503305A (zh) | 一种考虑损伤的自由曲面形态创建方法 | |
CN105631136A (zh) | 一种考虑封闭框架剪切变形和刚性节点的内力计算方法 | |
CN106346480A (zh) | 一种基于ug和matlab的多自由度注塑机械臂建模方法 | |
CN105388755A (zh) | 一种仿人机器人摆动腿迈步的能效优化控制方法 | |
CN107688684A (zh) | 一种应用于柔性线线高副约束简化模型的实现方法 | |
Jha et al. | On-line stable gait generation of a two-legged robot using a genetic–fuzzy system | |
CN102023569B (zh) | 两轮轮式机器人点镇定增量式智能控制方法 | |
CN101635063A (zh) | 一种椭圆截面弹性柱体自由扭转/变形的模拟方法 | |
CN105224726B (zh) | 结构网格动网格技术用于非结构网格流场求解器的方法 |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170609 |
|
WD01 | Invention patent application deemed withdrawn after publication |