[发明专利]一种基于耦合干扰观测器的级联电液伺服系统控制方法及系统

说明书

技术领域

本发明涉及一种可用于级联电液伺服系统的控制方法，特别是级联电液伺服驱动多自由度机械臂、起重装置等机电对象。

背景技术

目前应用在多自由度机械臂、多关节机器人等机电对象上的控制执行机构一般为电液伺服执行器，由于其能输出有很高的控制力和力矩。机电对象最常见的驱动模式是全驱动模式。而在全驱动模式中，一般将考虑关节负载作为干扰量处理，不需要对其进行测量或估计，关节跟踪控制算法也不包含关节负载的估计值，这样将导致大动态负载干扰对关节运动跟踪的动态响应性能的影响很大，控制精度降低。因此，本专利设计一种耦合干扰观测器，估计多自由度机械臂各关节负载，并将估计值应用于级联电液伺服控制算法中，从而抑制控制变量剧烈恶化，提高大动态负载干扰情况下级联电液伺服控制系统的输出响应性能，并保证系统具有全局稳定性和有界收敛性。

发明内容

本发明的目的是克服目前级联电液伺服全驱动控制方法的不足，同时适用于高动态负载干扰的在线估计，可以防止控制变量剧烈恶化，提高级联电液伺服控制系统的跟踪动态性能。

本发明的技术方案是一种基于耦合干扰观测器的级联电液伺服系统控制方法，该方法包括：

步骤1：建立级联电液伺服执行器模型；

建立的级联电液伺服执行器模型为：

y_i＝x_i1

i＝1,...n

其中为第i个级联电液伺服执行器的4阶模型状态变量，y_i为第i个液压缸输出位移，为第i个输出位移变化率，p_Li为第i个液压缸输出的液压压力，x_vi为第i个伺服阀阀芯位移，m_i为第i个负载质量，p_s为供油压力，A_p为对称缸横截面积，C_tl为液压缸总泄漏系数，V_t为液压缸容积，β_e为液压油有效体积弹性模量，C_d为伺服阀流量系数，w为伺服阀面积梯度，ρ为液压油密度，K为负载刚度系数，b为液压油阻尼系数，F_Li为第i个外负载压力，K_sv为伺服阀放大系数，T_sv为伺服阀一阶响应时间常数,k为反正切函数tanh(·)中指数项系数，u_i为第i个伺服阀控制电压，T_svi为第i个伺服阀一阶响应时间常数，K_svi为第i个伺服阀放大系数；

步骤2：驱动电液伺服，实时获取电液伺服的反馈数据，包括：第i个液压缸输出位移、第i个液压缸输出位移变化率、第i个液压缸负载压力、第i个伺服阀阀芯位移，i＝1,...n；

步骤3：利用反馈数据结合系统的状态误差计算控制变量；

步骤4：采用耦合干扰观测器对机械臂各关节负载进行在线估计；

步骤5：结合反馈数据、系统误差和负载干扰估计量计算反步控制律；

步骤6：根据反步控制律对级联电液伺服机构实时进行驱动。

进一步的，所述步骤3中系统误差z_ij(i＝1,…,n,j＝1,…,4)表示为

其中y_id表示第i个液压缸期望位移指令,α_ij为反步控制律设计中虚拟控制变量，表示为：

其中

i＝1,...,n

k_ij表示反步控制律中的控制参数，表示第i个伺服阀的耦合干扰观测器。

进一步的，所述步骤4中耦合干扰观测器表示如下：

其中状态变化率表示为

耦合干扰观测器参数为K_dij＝-K_dji≠0,(i≠j)，即第i个关节负载干扰估计值不仅与本执行器的状态变量估计误差x_i2有关，而且也与其他n-1个执行器的状态变量估计误差x_j2(j＝1,..,n,j≠i)有关。

进一步的，所述步骤5中反步控制律为：

其中