一种基于衰减记忆滤波的电液伺服控制方法及2-dof机械臂的制作方法
【技术领域】
[0001 ]本发明涉及电液伺服的控制方法，特别是电液伺服的修正反步控制方法。
【背景技术】
[0002] 目前应用在电液伺服控制系统中的先进控制方法有很多种，包括鲁棒控制、参数 自适应控制，反步控制，精确反馈线性化方法等。传统的参数自适应控制方法只能估计未知 的不确定参数常量，不能估计时变参数如系统的外界干扰等。电液伺服控制系统由于是严 格反馈模型，经常采用反步控制方法设计控制律，但是控制律中需要对虚拟控制变量进行 求导，直接求导会带来微分爆炸，因此，本专利采用衰减记忆滤波器与参数自适应估计律相 结合的方法，不仅可以对液压6个不确定参数进行估计，同时也可以对时变的外负载干扰进 行滤波，而且对反步控制律中的虚拟控制量进行滤波处理，避免微分爆炸，防止电液伺服执 行器的控制饱和的产生。电液伺服执行器将驱动2自由度机械臂的运动。
【发明内容】
[0003] 本发明的目的是克服目前电液伺服参数自适应估计和反步控制方法的不足，同时 适用于时变和非时变参数的估计，而且可以防止出现微分爆炸现象，提高电液伺服控制系 统的跟踪动态性能。
[0004] 本发明的技术方案是一种基于衰减记忆滤波和参数自适应的电液伺服控制方法， 该方法包括：
[0005] 步骤1:建立电液伺服执行器模型；
[0006] 步骤2:驱动电液伺服，实时获取电液伺服的反馈数据；
[0007]步骤3:利用反馈数据结合系统的状态误差计算控制变量；
[0008] 步骤4:采用衰减记忆滤波器对控制变量进行滤波；
[0009] 步骤5:结合反馈数据、系统误差和滤波后的控制变量计算参数自适应估计律；
[0010] 步骤6:结合参数自适应估计律和滤波后控制变量计算修正反步控制律；
[0011] 步骤7:根据修正反步控制律对电液伺服实时进行驱动。
[0012] 进一步的，所述步骤1中建立的伺服执行器模型为：
[0013]
[0014] 其中Xi(i = 1，…，4)为模型状态变量，丨ΛΡΛ-:,u4f = [_v, .i', ρ,,Λ'J'，y液压缸输出位 移，夕为输出位移变化率，PL为负载压力，Xv为伺服阀阀芯位移，4(/=Κ···，6)为不确定参数，m 为负载质量，ps为供油压力，AP为对称缸横截面积，Ctl为液压缸总泄漏系数，V t为液压缸容 积，&为液压油有效体积弹性模量，Cd为伺服阀流量系数，w为伺服阀面积梯度，P为液压油密 度，K为负载刚度系数，b为液压油阻尼系数，R为外负载压力，K sv为伺服阀放大系数，Tsv为伺 服阀一阶响应时间常数，k为反正切函数tanh( ·)中指数项系数，u为伺服阀控制电压。
[0015] 进一步的，步骤2中获取的反馈数据包括:液压缸输出位移、液压缸输出位移变化 率、液压缸负载压力、伺服阀阀芯位移、液压缸外负载压力。
[0016] 进一步的，所述步骤3中系统误差Zi(i = l，…，4)表示为
[0017] I? (5)
[0018] 其中xid表示液压缸期望位移指令，ai( i = 1，2，3)为反步控制律设计中虚拟控制变 量，表示为：
[0019]
[0020]
[0021] 其中C1C2C3表示反步控制律中的控制参数。
[0022] 进一步的，所述步骤4中采用衰减记忆滤波器对虚拟控制变量和液压缸外负载压 力进行滤波；
[0023]
[0024] 其中Φ (k)为第k步计算值，为第k_l步估计值，为第k_l步变化率 的估计值，为k步估计值，为第k步变化率的估计值，T。表示控制步长，滤波参数G =1-λ2，H= (l-λ)2，滤波参数〇〈λ〈1。
[0025] 进一步的，所述步骤5中自适应律为：
[0026]
[0027]其中为经过衰减记忆滤波器之后得到虚拟控制量的变化律估计值，h(i = 1、2、 3、4、5、6)表示参数自适应估计律中的放大系数。
[0028]进一步的，所述步骤6中修正反步控制律为：
[0029]
[0030]
[0031 ]其中|Δ鳥[_、卜砵匕为滤波器误差的有界约束值。
[0032]进一步的，采用拉格朗日方法建立液压缸外负载力模型。
[0033] 一种采用基于衰减记忆滤波的电液伺服控制方法的2-D0F机械臂，该机械臂包括： 3个机械连杆，包括:第一连杆、第二连杆、第三连杆，2个电液伺服阀，2个双作用液压缸，1个 伺服电机，1个定量柱塞栗，1个油箱;其中第一连杆与第二连杆之间铰接，称该处为肩关节， 第二连杆与第三连杆铰接，称该处为肘关节；肩关节与肘关节处分别设置一个电液伺服阀 与双作用液压缸;整个机械臂设置1个伺服电机、1个定量柱塞栗和1个油箱;第二连杆与第 三连杆上分别设置一光电编码器，用于测量两个关节的运动角度和角速度;在两个液压缸 进油口和出油口各设置1个压力传感器，测量液压缸的负载力，在定量柱塞栗出口安装1个 压力表，监测系统的供油压力。
[0034]本发明的目的之三是提出参数自适应估计与衰减记忆滤波器相结合的修正反步 控制设计方法，既能对对液压6个不确定参数进行估计，同时也可以对时变的外负载干扰进 行滤波，得到其估计值及其变化率，而且对反步控制律中的虚拟控制量进行滤波得到虚拟 控制量的变化率，防止出现微分爆炸现象，提高电液伺服控制系统的跟踪动态性能。
【附图说明】
[0035]图1为本发明的采用基于衰减记忆滤波的电液伺服控制方法的2-D0F机械臂；
[0036] 图2为本发明虚拟变量计算顺序示意图；
[0037] 图3为本发明一种基于衰减记忆滤波的电液伺服控制方法流程图。
【具体实施方式】
[0038]以下提供本发明一种基于衰减记忆滤波器和参数自适应估计方法的2-D0F机械臂 运动控制装置的具体实时方式。
[0039]整个系统的模型分为2部分，包括电液伺服执行器的模型和2-D0F机械臂负载力模 型。分别简述如下：
[0040] 1)电液伺服执行器建模
[0041 ]采用四阶模型描述伺服阀驱动液压缸回路的电液伺服执行器模型如下：
[0042] (1)
[0043] 其中Xi(i = l，···，4)为模型状态变量，液压缸输出 位移，义为输出位移变化率，PL为负载压力，Xv为伺服阀阀芯位移，州/=1，….6)为不确定参 数，m为负载质量，ps为供油压力，AP为对称缸横截面积，(^为液压缸总泄漏系数，V t为液压缸 容积，&为液压油有效体积弹性模量，Cd为伺服阀流量系数，w为伺服阀面积梯度，P为液压油 密度，K为负载刚度系数，b为液压油阻尼系数，R为外负载压力，K sv为伺服阀放大系数，Tsv为 伺服阀一阶响应时间常数，k为反正切函数tanh( ·)中指数项系数，u为伺服阀控制电压。 [0044] 2)负载力建模
[0045] 2-D0F机械臂的2个关节运动由2个电液伺服执行器驱动，因此2个液压缸末端存在 外负载力，负载力建模米用拉格朗日方法建立如下：
[0046] Η .! +C .1 +G= " (2) W Ια」 λ」
[0047] 其中θ:、θ2为肩关节和肘关节角度，Η为惯性矩阵，C为Coriolis矩阵，G为重力项，Tu 为肩关节负载扭矩，Tf为肘关节负载扭矩。
[0048]两个关节的负载力FLu、FLf表示为 F Ω、-ΤΜ及J C〇〇49] T.(0r0