[发明专利]腿足式机器人液压系统汽油发动机转速伺服控制方法

摘要

一种腿足式机器人液压系统汽油发动机转速伺服控制方法，(1)计算出发动机转速误差e和转速误差的变化率ec；(2)e和ec经过模糊逻辑计算之后，输出比例系数增量△k_p和积分系数增量△k_i；(3)比例系数k_p＝k_p0+△k_p，积分系数k_i＝k_i0+△k_i；(4)计算出油门开度S₁＝S_{1_old}+k_p*ec+k_i*e；(5)由液压油流量变化引起的油门开度变化为S₂＝k_Q*△Q；(6)最终油门开度S_f＝S₁+S₂，油门开度以PWM的形式控制舵机旋转，通过油门线控制发动机节气门的开度来控制进气量，最终控制发动机转速。本发明采用前馈控制，在流量突变的情况下能很好的保证转速稳定；采用模糊自整定对参数进行在线修改，满足不同控制要求，使系统具有良好的动态和静态性能。

主权项

1.一种腿足式机器人液压系统汽油发动机转速伺服控制方法，其特征是，包括如下步骤：(1)根据发动机设定转速v_ref和发动机实际转速v_fed，计算出转速误差e和转速误差的变化率ec,其中e＝v_fed‑v_ref，ec＝(v_fed‑v_ref)/T，T为控制周期0.02秒；(2)上述转速误差e和转速误差的变化率ec经过模糊逻辑计算之后，输出比例系数增量△k_p和积分系数增量△k_i；(3)最终，比例系数k_p＝k_p0+△k_p，积分系数k_i＝k_i0+△k_i；(4)采用增量式PI算法计算出油门开度S₁，S₁＝S_{1_old}+k_p*ec+k_i*e，其中S_{1_old}为上一执行周期中的油门开度；(5)机器人运动过程中的液压油流量变化△Q由前馈控制进行补偿，由液压油流量变化引起的油门开度变化为S₂＝k_Q*△Q，其中k_Q＝27.7min/L；(6)最终油门开度S_f＝S₁+S₂，油门开度以PWM的形式控制舵机旋转，通过控制进气量，最终控制发动机转速；所述模糊逻辑计算采用模糊监督控制器，具体过程如下：模糊监督控制器由模糊器、模糊推理机、模糊规则表和解模糊器组成，其输入为转速误差e和转速误差的变化率ec，模糊器利用隶属度函数将e和ec转化成模糊变量NB、NS、ZO、PS和PB，e和ec的隶属度函数表达式如下，其中x为e或ec，e的隶属度函数中n＝150，ec的隶属度函数中n＝60：之后模糊推理机利用△k_p的模糊规则表和△k_i的模糊规则表将输入模糊集合映射到输出模糊集合；其中：△k_p的模糊规则表如下：△k_i的模糊规则表如下：最后解模糊器采用隶属度函数和中心平均解模糊的方法计算出输出比例系数增量△k_p和积分系数增量△k_i；△k_p和△k_i的隶属度函数表达式如下，其中y为△k_p或△k_i，△k_p的隶属度函数中n＝1，△k_i的隶属度函数中n＝0.1：