一种动态双足步行机器人鲁棒控制方法技术

本发明专利技术涉及一种针对动态动态双足步行机器人步态优化控制的鲁棒控制方法，具体涉及动态双足步行机器人鲁棒控制方法。针对动态双足步行机器人最优鲁棒控制问题,结合快速指数稳定控制Lyapunov函数和混合零动态，充分考虑控制扭矩饱和条件，提出一类具有充分下降特性的投影Dai‑Yuan等式约束优化算法。本发明专利技术通过对具有非线性、欠驱动、脉冲混杂特性的3连杆动态双足步行机器人模型进行数值模拟实验，数值结果表明虽然动态双足步行机器人动力学模型的参数摄动3倍，但是投影Dai‑Yuan等式约束优化算法求解的最优鲁棒控制器仍然可以实现动态双足步行机器人高效、稳定行走步态。本发明专利技术提高了动态双足机器人动态步行的稳定性和鲁棒性。

A Robust Control Method for Dynamic Biped Walking Robot

The invention relates to a robust control method for gait optimization control of dynamic biped walking robot, in particular to a robust control method of dynamic biped walking robot. Aiming at the optimal robust control problem of dynamic biped walking robot, a projection Dai_Yuan equality constrained optimization algorithm with sufficient descent characteristics is proposed, which combines fast exponential stability control Lyapunov function and hybrid zero dynamics, and fully considers the saturation condition of control torque. The present invention simulates a three-link dynamic biped walking robot model with non-linear, underactuated and impulse hybrid characteristics. The numerical results show that although the parameter perturbation of the dynamic biped walking robot model is three times, the optimal robust controller solved by the projection Dai Yuan equality constrained optimization algorithm can still achieve high dynamic biped walking robot. Effective and stable walking gait. The invention improves the stability and robustness of dynamic walking of a dynamic biped robot.

【技术实现步骤摘要】
一种动态双足步行机器人鲁棒控制方法
本专利技术涉及动态双足步行机器人
，特别是一种动态双足步行机器人鲁棒控制方法。
技术介绍
伴随着人类对深海、深空、深地探测能力增强，单纯依赖人类本身是不可能实现深海、深空、深地探测，从而，人们研发了适应于各种功能的机器人辅助人类完成这些不可能完成的任务。由于外部工况信息复杂性或者内部参数摄动实时性将导致动态双足步行机器人产生不稳定行走步态，因此，人们希望致动态双足步行机器人可以更好的处理干扰，实现高效稳定工作状态。密歇根大学Grizzle教授首次提出混合零动态思想初步解决了动态双足步行机器人稳定行走问题。通过选取输出函数，利用反馈线性化技术为动态双足步行机器人设计反馈控制器，实现了该类机器人的动态稳定行走。随后，加州理工学院Ames团队结合快速指数稳定控制Lyapunov函数和混合零动态，设计了一类快速指数稳定控制器，实现了动态双足步行机器人的高效稳定行走步态，然而，他们在控制器设计过程中，需要通过调整控制器参数，如果参数选取不当时，动态双足步行机器人将不能产生稳定的行走步态。为了实现动态双足步行机器人能够在更加复杂的工况下实现稳定的周期运动，Galloway等人利用快速指数稳定性和控制扭矩饱和条件下构造了求解最优鲁棒控制器的二次规划模型，实现了动态双足步行机器人的动态稳定行走。但是，二次规划模型设计过程中，要求目标函数必须是二次型，并且约束条件只能是线性形式，限制了控制器设计要求。本专利技术针对前述问题，提出了一种动态双足步行机器人鲁棒控制方法。
技术实现思路
有鉴于现有技术的上述缺陷，本专利技术的目的就是提供一种动态双足步行机器人鲁棒控制方法，在于利用本专利技术投影Dai-Yuan线性等式约束优化算法实现了动态双足步行机器人的最优鲁棒控制；本专利技术基于处理非线性无约束优化问题中的Dai-Yuan思想，设计了动态双足步行机器人步态优化算法，从而，通过算法求解动态双足步行机器人的最优鲁棒控制器，提高了动态双足机器人动态步行的稳定性和鲁棒性。本专利技术的目的是通过这样的技术方案实现的，一种动态双足步行机器人鲁棒控制方法，它包括有：S1：建立动态双足步行机器人动力学模型；S2：进行鲁棒控制器的设计；S3：进行Dai-Yuan线性等式约束优化算法的设计。进一步，所述步骤S1中动态双足步行机器人动力学模型如下：其中，向量场为局部Lipschit连续函数，为碰撞前的状态变量，为碰撞后的状态变量，S为摆动腿与地面接触时的碰撞切换曲面，Δ为碰撞代数映射，q为机器人的状态变量，u∈Rm为控制信号输入；定义输出函数为y(q)＝H0(q)-yd(θ(q))；θ(q)是关于变量q严格单调函数，yd(θ(q))是机器人期望运动轨迹。进一步，所述步骤S2中在对鲁棒控制器的设计前还包括有：S21：构造快速指数稳定控制Lyapunov函数如下：其中，P为Lyapunov方程ATP+PA+Q＝0的解，Q为任意正定矩阵。进一步，所述鲁棒控制器的设计具体过程如下：S22：由快速指数稳定控制Lyapunov函数定义，计算Lyapunov函数关于η的导数，有：其中，为了满足Lyapunov函数的下降条件，有：S23：以低能耗作为性能指标，通过优化方法在线求解鲁棒控制器，实现动态双足步行机器人的动态稳定行走；求解优化模型如下：其中，J(μ)是关于μ连续可微函数，umin和umax分别为机器人电机的最小、最大扭矩，进一步，还包括有：将式(6)转化为标准的等式约束优化问题：其中，分别为变量和目标函数，为线性约束矩阵，为常数项。进一步，还包括有：步骤S3中所述进行Dai-Yuan线性等式约束优化算法的设计具体过程如下：S31：选择一个初始点x0∈Rn,ε＞0,令k:＝0；S32：计算由下面计算公式得到：其中，P＝I-AT(AAT)-1A，yk-1＝gk-gk-1；S33：确定终止停止迭代条件；如果||Pgk||＜ε停止；否则，执行S34；S34：给出一些常数δ∈(0,1/2),ρ∈(0,1),确定一个步长，αk＝max(ρj|j＝0,1,2,...)；满足Wofle线性搜索条件：S35：迭代k：＝k+1,返回S32。由于采用了上述技术方案，本专利技术具有如下的优点：(1)本专利技术通过设计投影Dai-Yuan线性等式优化算法求解动态双足步行机器人的最优鲁棒控制器，克服了传统控制器设计局限，为最优鲁棒控制器设计提供了一个新的解决方案。(2)本专利技术中非线性等式约束优化问题解决了已有方法中目标函数必须为二次型的缺陷问题。(3)本专利技术的投影Dai-Yuan线性等式优化算法是一类在线求解算法，可为动态双足步行机器人在线进行参数修正。(4)本专利技术的投影Dai-Yuan线性等式优化算法适用范围广，适用于各类动态双足步行机器人的步态优化控制，该方法还可以为机械臂路径规划提供理论参考和算法框架。(5)本专利技术在不增加任何硬件的前提下，有效的提高了动态双足步行机器人的稳定性和鲁棒性。(6)通过算法求解动态双足步行机器人的最优鲁棒控制器，提高了动态双足机器人动态步行的稳定性和鲁棒性。本专利技术的其他优点、目标和特征在某种程度上将在随后的说明书中进行阐述，并且在某种程度上，基于对下文的考察研究对本领域技术人员而言将是显而易见的，或者可以从本专利技术的实践中得到教导。附图说明本专利技术的附图说明如下：图1为动态双足步行机器人的控制框图。图2为带上肢的3连杆双足机器人示意图。图3为Dai-Yuan优化算法流程示意图。图4a和图4b为参数不摄动情况下控制输入与时间关系曲线图。图5a和图5b为参数不摄动情况下输出函数与时间关系曲线图。图6为参数不摄动情况下关节角位移1与角速度1的极限环。图7为参数不摄动情况下关节角位移2与角速度2的极限环。图8a和图8b为参数摄动3倍情况下控制输入与时间关系曲线图。图9a和图9b为参数摄动3倍情况下输出函数与时间关系曲线。图10为参数摄动3倍情况下关节角位移1与角速度1的极限环。图11为参数摄动3倍情况下关节角位移2与角速度2的极限环。具体实施方式下面结合附图和实施例对本专利技术作进一步说明。实施例：如图1至图11所示；一种动态双足步行机器人鲁棒控制方法，它包括有：S1：建立动态双足步行机器人动力学模型；S2：进行鲁棒控制器的设计；S3：进行Dai-Yuan线性等式约束优化算法的设计。所述步骤S1中动态双足步行机器人动力学模型如下：其中，向量场为局部Lipschit连续函数，为碰撞前的状态变量，为碰撞后的状态变量，S为摆动腿与地面接触时的碰撞切换曲面，Δ为碰撞代数映射，q为机器人的状态变量，u∈Rm为控制信号输入；定义输出函数为y(q)＝H0(q)-yd(θ(q))；θ(q)是关于变量q严格单调函数，yd(θ(q))是机器人期望运动轨迹。所述步骤S2中在对鲁棒控制器的设计前还包括有：S21：构造快速指数稳定控制Lyapunov函数如下：其中，P为Lyapunov方程ATP+PA+Q＝0的解，Q为任意正定矩阵。所述鲁棒控制器的设计具体过程如下：S22：由快速指数稳定控制Lyapunov函数定义，计算Lyapunov函数关于η的导数，有：其中，为了满足Lyapunov函数的下降条件，有：S23：以低能耗作为性能指标，通过优化方法在线求解鲁棒控制器本文档来自技高网...

【技术保护点】
1.一种动态双足步行机器人鲁棒控制方法，其特征在于，所述方法步骤如下：S1：建立动态双足步行机器人动力学模型；S2：进行鲁棒控制器的设计；S3：进行Dai‑Yuan线性等式约束优化算法的设计。

【技术特征摘要】
1.一种动态双足步行机器人鲁棒控制方法，其特征在于，所述方法步骤如下：S1：建立动态双足步行机器人动力学模型；S2：进行鲁棒控制器的设计；S3：进行Dai-Yuan线性等式约束优化算法的设计。2.如权利要求1所述的动态双足步行机器人鲁棒控制方法，其特征在于，所述步骤S1中动态双足步行机器人动力学模型如下：其中，向量场为局部Lipschit连续函数，为碰撞前的状态变量，为碰撞后的状态变量，S为摆动腿与地面接触时的碰撞切换曲面，Δ为碰撞代数映射，q为机器人的状态变量，u∈Rm为控制信号输入；定义输出函数为y(q)＝H0(q)-yd(θ(q))；θ(q)是关于变量q严格单调函数，yd(θ(q))是机器人期望运动轨迹。3.如权利要求1所述的动态双足步行机器人鲁棒控制方法，其特征在于，所述步骤S2中在对鲁棒控制器的设计前还包括有：S21：构造快速指数稳定控制Lyapunov函数如下：其中，P为Lyapunov方程ATP+PA+Q＝0的解，Q为任意正定矩阵。4.如权利要求3所述的动态双足步行机器人鲁棒控制方法，其特征在于，所述鲁棒控制器的设计具体过程如下：S22：由快速指数稳定控制Lyapunov函数定义，计算L...

【专利技术属性】
技术研发人员：张可，韩载道，
申请(专利权)人：重庆大学，
类型：发明
国别省市：重庆,50