[发明专利]基于双参数奇异摄动的液压刚柔机械臂控制方法

权利要求书

1.基于双参数奇异摄动的液压刚柔机械臂控制方法，其特征在于，该方法包括如下步骤：

第一步、模型分解：

三自由度液压刚柔机械臂动力学方程如式(13)所示：

M(θ,q)θ··q··+Kθq+G(θ,θ·,q,q·)=τ0τ·+Aτ+Bθ·=CI---(13)]]>

其中，M(θ,q)∈R^5×5为对称、正定的惯性矩阵；θ=[θ₁ θ₂ θ₃]^T为关节角；q=[q₁ q₂]^T为模态坐标；为包含哥氏力、离心力、重力的非线性项；柔性臂的刚度矩阵为K=diag(0,0,0,k₁,k₂)；作用在关节上的广义力矩为τ=[τ₁ τ₂ τ₃]^T；I=[i₁ i₂ i₃]^T为伺服阀控制电流；A=diag(a₁,a₂,a₃)，a₁=4β_e(C_tm1+K_c1)V_t1，B=diag(b₁,b₂,b₃)，b₁=4β_eD²V_t1，C=diag(c₁,c₂,c₃)，c₁=4β_eDK_q1K_i1V_t1,c_i=4β_eA_piDK_qiK_iJ_iV_ti,i=2,3；

采用双参数奇异摄动技术将式(13)分解，取第一个小参数并且满足0<ε₁<<1，并在边界层上引入第一级快变时标得到液压刚柔机械臂的第一级快变子系统动力学方程如式(20)

dτf1dσ1=-A~τf1+C~If1---(20)]]>

其中，I_f1为第一级快变时标σ₁下的控制电流，下标f1表示系统处在第一级快变时标下；

下面取第二个小参数其中k=min(k₁,k₂)，且两个小参数满足0<ε₁<<ε₂<<1，得到系统的第二级慢变流形表达式为

M1,s2(θ,0)θ··+G1,s2(θ,θ·,0,0)=-A~-1B~θ·+A~-1C~Is2---(28)]]>

其中，I_s2为第二级慢变时标t下的控制电流，下标s2表示系统处在第二级慢变时标下；

在边界层上引入第二级快变时标得液压刚柔机械臂系统第二级快变子系统的动力学方程为

d2yf2dσ22=-D4,s2(θ,ϵ2y)K~yf2+D3,s2(θ,ϵ2y)A~-1C~If2---(31)]]>

其中，I_f2为第二级快变时标σ₂下的控制电流，下标f2表示系统处在第二级快变时标下；

第二步、根据第一步得到的第二级慢变子系统、第二级快变子系统以及第一级快变子系统动力学方程，设计相应的子系统控制模块：

针对第二级慢变子系统，取一阶滑动模态面及二阶滑动模态面设计二阶滑模控制律如式(37)

Is2=C~-1A~[M1,s(θ··d+αe+βe·+u)+A~-1B~θ·+G1,s]---(37)]]>

针对第二级快变子系统，取二次型性能指标函数及Ricatti方程AkTP+PAk-PBkR-1BkTP+Q=0,]]>设计最优控制律如式(41)

If2=-KfXk=-R-1BkTPXk---(41)]]>

针对第一级快变子系统，取滑模面s_f=e_f及自适应更新律设计自适应滑模控制律如式(50)

If1=C~-1[τ·f1d+A~0τf1+F^+D0E+ξsgn(sf)]---(50)]]>

第三步、根据多重时间尺度理论，将第二步得到的各子系统控制器组合得到液压刚柔机械臂组合控制器如式(52)

I=I_f1+I_s1=I_f1+I_f2+I_s2 (52)

进而完成基于双参数奇异摄动的液压刚柔机械臂的控制方法。