一种动态双足步行机器人鲁棒控制方法与流程

本发明涉及动态双足步行机器人技术领域，特别是一种动态双足步行机器人鲁棒控制方法。

背景技术：

伴随着人类对深海、深空、深地探测能力增强，单纯依赖人类本身是不可能实现深海、深空、深地探测，从而，人们研发了适应于各种功能的机器人辅助人类完成这些不可能完成的任务。由于外部工况信息复杂性或者内部参数摄动实时性将导致动态双足步行机器人产生不稳定行走步态，因此，人们希望致动态双足步行机器人可以更好的处理干扰，实现高效稳定工作状态。密歇根大学grizzle教授首次提出混合零动态思想初步解决了动态双足步行机器人稳定行走问题。通过选取输出函数，利用反馈线性化技术为动态双足步行机器人设计反馈控制器，实现了该类机器人的动态稳定行走。随后，加州理工学院ames团队结合快速指数稳定控制lyapunov函数和混合零动态，设计了一类快速指数稳定控制器，实现了动态双足步行机器人的高效稳定行走步态，然而，他们在控制器设计过程中，需要通过调整控制器参数，如果参数选取不当时，动态双足步行机器人将不能产生稳定的行走步态。为了实现动态双足步行机器人能够在更加复杂的工况下实现稳定的周期运动，galloway等人利用快速指数稳定性和控制扭矩饱和条件下构造了求解最优鲁棒控制器的二次规划模型，实现了动态双足步行机器人的动态稳定行走。但是，二次规划模型设计过程中，要求目标函数必须是二次型，并且约束条件只能是线性形式，限制了控制器设计要求。

本发明针对前述问题，提出了一种动态双足步行机器人鲁棒控制方法。

技术实现要素：

有鉴于现有技术的上述缺陷，本发明的目的就是提供一种动态双足步行机器人鲁棒控制方法，在于利用本发明投影dai-yuan线性等式约束优化算法实现了动态双足步行机器人的最优鲁棒控制；本发明基于处理非线性无约束优化问题中的dai-yuan思想，设计了动态双足步行机器人步态优化算法，从而，通过算法求解动态双足步行机器人的最优鲁棒控制器，提高了动态双足机器人动态步行的稳定性和鲁棒性。

本发明的目的是通过这样的技术方案实现的，一种动态双足步行机器人鲁棒控制方法，它包括有：

s1：建立动态双足步行机器人动力学模型；

s2：进行鲁棒控制器的设计；

s3：进行dai-yuan线性等式约束优化算法的设计。

进一步，所述步骤s1中动态双足步行机器人动力学模型如下：

其中，向量场为局部lipschit连续函数，为碰撞前的状态变量，为碰撞后的状态变量，s为摆动腿与地面接触时的碰撞切换曲面，δ为碰撞代数映射，q为机器人的状态变量，u∈r^m为控制信号输入；定义输出函数为y(q)＝h0(q)-yd(θ(q))；θ(q)是关于变量q严格单调函数，yd(θ(q))是机器人期望运动轨迹。

进一步，所述步骤s2中在对鲁棒控制器的设计前还包括有：

s21：构造快速指数稳定控制lyapunov函数如下：

其中，p为lyapunov方程a^tp+pa+q＝0的解，q为任意正定矩阵。

进一步，所述鲁棒控制器的设计具体过程如下：

s22：由快速指数稳定控制lyapunov函数定义，计算lyapunov函数关于η的导数，有：

其中，

为了满足lyapunov函数的下降条件，有：

s23：以低能耗作为性能指标，通过优化方法在线求解鲁棒控制器，实现动态双足步行机器人的动态稳定行走；求解优化模型如下：

其中，j(μ)是关于μ连续可微函数，umin和umax分别为机器人电机的最小、最大扭矩，

进一步，还包括有：

将式(6)转化为标准的等式约束优化问题：

其中，分别为变量和目标函数，为线性约束矩阵，为常数项。

进一步，还包括有：步骤s3中所述进行dai-yuan线性等式约束优化算法的设计具体过程如下：

s31：选择一个初始点x0∈rⁿ,ε＞0,令k:＝0；

s32：计算由下面计算公式得到：

其中，

p＝i-a^t(aa^t)^-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∈r^m为控制信号输入；定义输出函数为y(q)＝h0(q)-yd(θ(q))；θ(q)是关于变量q严格单调函数，yd(θ(q))是机器人期望运动轨迹。

所述步骤s2中在对鲁棒控制器的设计前还包括有：

s21：构造快速指数稳定控制lyapunov函数如下：

其中，p为lyapunov方程a^tp+pa+q＝0的解，q为任意正定矩阵。

所述鲁棒控制器的设计具体过程如下：

s22：由快速指数稳定控制lyapunov函数定义，计算lyapunov函数关于η的导数，有：

其中，

为了满足lyapunov函数的下降条件，有：

s23：以低能耗作为性能指标，通过优化方法在线求解鲁棒控制器，实现动态双足步行机器人的动态稳定行走；求解优化模型如下：

其中，j(μ)是关于μ连续可微函数，umin和umax分别为机器人电机的最小、最大扭矩，

还包括有：

将式(6)转化为标准的等式约束优化问题：

其中，别为变量和目标函数，为线性约束矩阵，为常数项。

还包括有：步骤s3中所述进行dai-yuan线性等式约束优化算法的设计具体过程如下：

s31：选择一个初始点x0∈rⁿ,ε＞0,令k:＝0；

s32：计算由下面计算公式得到：

其中，

p＝i-a^t(aa^t)^-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。

具体计算过程如下：本实验是以带上肢的3连杆双足机器人为实验对象，具体模型参数选取如下数值：

r＝1m，m＝5kg，mh＝15kg，mt＝10kg，l＝0.5m。

kp＝100i和kd＝15i，期望上肢关节角位移为地面角度为α＝0.05，期望轨迹为：和

grizzle等利用非线性优化算法求解的上述参数值到一组最优参数值，即

a^*＝[0.5120.0730.035-0.819-2.273.263.111.89]；

角位移θ1对应的初始角速度ω＝1.55rad/s以最小能耗为双足机器人动态行走的性能指标泛函，

算法终止条件为ε＜10^-6，求解如下lyapunov方程

a^tp+pa+q＝0；

其中a由上式计算，q为任意对称正定矩阵，取q＝100i4×4,利用matlab软件工具箱求解知，

本发明利用处理非线性无约束优化问题中的dai-yuan思想提出一类新的投影dai-yuan线性等式约束优化算法；对最优鲁棒控制器建立非线性等式约束优化模型，通过设计投影类dai-yuan优化算法实现动态双足步行机器人的步态优化控制；解决了动态双足步行机器人步态优化过程中存在的参数摄动问题，提高了动态双足机器人动态步行的稳定性和鲁棒性。

应当理解的是，本说明书未详细阐述的部分均属于现有技术。最后说明的是，以上实施例仅用以说明本发明的技术方案而非限制，尽管参照较佳实施例对本发明进行了详细说明，本领域的普通技术人员应当理解，可以对本发明的技术方案进行修改或者等同替换，而不脱离本技术方案的宗旨和范围，其均应涵盖在本发明的权利要求范围当中。