一种基于摩擦补偿的伺服系统控制方法
【专利摘要】本发明提供一种基于摩擦补偿的伺服系统控制方法，包括：伺服系统的控制机构发出电流信号，驱动伺服电机，伺服电机输出转矩信号控制伺服系统所带负载从初始位置转向目标位置；伺服系统的编码器实时检测伺服系统所带负载的转动角度；判断伺服系统所带负载是否偏离目标位置，如偏离，则对伺服系统进行基于摩擦补偿的控制，否则伺服系统的编码器实时检测伺服系统所带负载的转动角度；根据得到的伺服电机的电流信号驱动伺服电机，伺服电机输出转矩信号，从而控制伺服系统所带负载回到目标位置，并保持在目标位置。本发明针对伺服系统的摩擦，对表征伺服系统摩擦的未建模动态进行补偿，有效抑制了摩擦对伺服系统控制性能的影响，降低了动态跟踪误差。
【专利说明】一种基于摩擦补偿的伺服系统控制方法
【技术领域】
[0001]本发明属于自动控制领域，主要涉及一种基于摩擦补偿的伺服系统控制方法。
【背景技术】
[0002]伺服系统能够精确跟踪参考信号过程，广泛存在于数控机床、风力发电、工业机械手等领域。伺服系统的执行结构是伺服电机，由增量式光电轴角编码器检测系统的角位移和角速度并反馈给控制器，通过控制器将反馈信号和给定信号进行比较和运算，产生控制信号，实现伺服控制。
[0003]但是摩擦严重影响伺服系统性能，是高速高精度伺服控制的关键问题。由于摩擦具有动态、非线性等特点，一般的线性反馈控制方法难以取得理想的控制效果。此外，摩擦机理至今尚未完全明确，无法建立准确的数学模型，这使得伺服系统的高性能伺服控制成为难点。虽然大量先进智能控制方法被相继提出，但与实际工业应用仍存在距离。
[0004]PD控制是工业伺服系统中最广泛使用的一种控制器，其算法简单，具有良好的可靠性和鲁棒性。对于模型精确的线性被控系统，ro控制效果理想，但伺服系统具有未建模的摩擦非线性项，严重影响了ro控制器的性能。为了在ro控制的基础上对摩擦进行补偿，工业上一般根据经验制定摩擦补偿数据表，但该方法受限于工程师经验，数据表的细化度和精度难以保证，而学术上一般根据近似摩擦模型设计补偿器，但是已有模型无法体现摩擦的全部特性，此外模型参数辨识复杂且不同工况下的结果不同，通用性差。以上方法没有充分利用系统的历史输入输出数据。
【发明内容】
[0005]针对现有技术存在的不足，本发明提供一种基于摩擦补偿的伺服系统控制方法。
[0006]本发明的技术方案是这样实现的:
[0007]—种基于摩擦补偿的伺服系统控制方法，包括以下步骤:
[0008]步骤1:伺服系统的控制机构发出电流信号，驱动伺服电机，伺服电机输出转矩信号控制伺服系统所带负载从初始位置转向目标位置；
[0009]步骤2:伺服系统的编码器实时检测伺服系统所带负载的转动角度；
[0010]步骤3:判断伺服系统所带负载是否偏离目标位置，如偏离，则执行步骤4，否则返回步骤2 ；
[0011]步骤4:对伺服系统进行基于摩擦补偿的控制；
[0012]步骤4.1:根据伺服系统的动力学机理，以伺服电机的电流信号为输入信号，以伺服系统所带负载的转动角度为输出信号，建立伺服系统的离散线性模型:
[0013]A (z_1) y (k+1) = B (z_1) u (k)
[0014]其中，伺服系统的离散线性模型参数A(z<) = l+a^+af2，B(z_1) = b0+blZ_1,a” a2, b0, bi是未知参数；
[0015]步骤4.2:根据建立的伺服系统的离散线性模型确定伺服系统所带负载的理想转动角度；
[0016]y*(k+l) = -Sl1J (k) -a2y (k~l) +b0u (k) +b^ (k~l)
[0017]其中:/(k+l)离散线性模型在第k+1时刻的输出信号，即在第k+Ι时刻伺服系统所带负载的理想转动角度；y(k)是第k时刻伺服系统所带负载的实际转动角度；u(k)为第k时刻伺服电机的电流信号；
[0018]步骤4.3:确定第k+Ι时刻伺服系统所带负载的实际转动角度y (k+1)与第k+Ι时刻伺服系统所带负载的理想转动角度/(k+Ι)之间的偏差信号v(k+l)，即表征伺服系统摩擦的未建模动态；
[0019]V (k+1) = y (k+1) -y*(k+l)
[0020]步骤4.4:根据表征伺服系统摩擦的未建模动态V (k+Ι)和伺服系统的离散线性模型，建立包含伺服系统摩擦的伺服系统离散线性模型:
[0021 ] A (z-1) y (k+Ι) = B (z_1) u (k) +v (k+1)
[0022]其中，V (k+1) = v(k) + Av(k),v(k)为第k时刻表征伺服系统摩擦的未建模动态；Av(k)为未建模动态在第k+Ι时刻的增量；
[0023]步骤4.5:确定未建模动态在第k时刻的增量，该增量与未建模动态在第k+Ι时刻的增量近似相等；
[0024]Δ V (k-1) =v(k)-v(k_l)
[0025]其中，v(k)为第k时刻表征伺服系统摩擦的未建模动态，V (k-1)为第k+Ι时刻表征伺服系统摩擦的未建模动态；
[0026]步骤4.6:利用H)控制模型和表征伺服系统摩擦的未建模动态，建立基于摩擦补偿的伺服系统控制模型:
[0027]H (z-1) u (k) =R (z—1) w (k) -G (z—1) y (k) -K (z_1) [v (k) + Δ v (k_l)]
[0028]式中，H(z^)，R(z^)，G(z^)为PD 控制模型参数:H(z^) = (1+V-1)，Ii1 是待定系数 ^(z—1) = G(z_0 = go+giZ-1, g0 = Kp+Kd, gi = -Ki, Kp 和 Kd 是比例和微分系数 ^(z—1)是未建模动态补偿增益多项式，K(P) = Hk1Z^k1为未建模动态补偿增益多项式系数，z—1为时间后移算子；
[0029]步骤4.7:将基于摩擦补偿的伺服系统控制模型代入包含伺服系统摩擦的伺服系统离散线性模型，得到伺服系统的闭环方程:
[0030][A (z—1) H (z—1) +zl (z—1) G (z—1) ] y (k+1) = B (z—1) G (z—1) w (k) + [H (z—1) -B (z—1) K (z—1)][v (k) + Δ V (k-1) ] +H (z_1) [ Δ V (k) - Δ V (k_l)]
[0031]式中:Av(k)-Av(k-l)是未建模动态在第k+1时刻的增量与未建模动态在第k时刻的增量的偏差；
[0032]步骤4.8:采用极点配置方法确定hp Kp和Kd ；
[0033]步骤4.9:在稳态时对表征伺服系统摩擦的未建模动态进行全补偿:令H(z-1)-B(z^1)K(z-1) = 0，令K(I) = H(I)B(I),确定未建模动态补偿增益多项式系数匕；
[0034]步骤4.10:将确定的HKpk1代入基于摩擦补偿的伺服系统控制模型，得到基于摩擦补偿的伺服系统控制模型的控制输出，即得到u(k)，即第k时刻的伺服系统的电流信号;
[0035]步骤5:根据得到的伺服电机的电流信号驱动伺服电机，伺服电机输出转矩信号，从而控制伺服系统所带负载回到目标位置，并保持在目标位置。
[0036]有益效果:本发明在ro控制的基础上，引入摩擦补偿，在传统ro控制器设计简单、鲁棒性好的优点上，针对伺服系统的摩擦，通过充分利用历史输入输出数据，对表征伺服系统摩擦的未建模动态进行补偿，有效抑制了摩擦对伺服系统控制性能的影响，降低了动态跟踪误差，提高了稳态定位精度，而且本发明不需要建立内部机理尚不明确的复杂的摩擦模型，在实际工业中易于实现，解决现有摩擦经验补偿方法精度较低，以及摩擦模型补偿方法设计过程复杂、通用性差、难于应用于实际工业过程的不足。
【专利附图】
【附图说明】
[0037]图1为本发明【具体实施方式】的基于摩擦补偿的伺服系统控制模型示意图；
[0038]图2为ZEBRA ZERO六自由度机械手的结构示意图；
[0039]图3为ZEBRA ZERO六自由度机械手的控制系统实验平台示意图；
[0040]图4为本发明【具体实施方式】的基于摩擦补偿的伺服系统控制对比实验极点配置ro控制方法(PD)的实验曲线；
[0041]图5为本发明【具体实施方式】的基于摩擦补偿的伺服系统控制对比实验实际经验摩擦补偿数据表方法(PED)的实验曲线；
[0042]图6为本发明【具体实施方式】的基于摩擦补偿的伺服系统控制对比实验非线性摩擦自适应补偿方法(ANF)的实验曲线；
[0043]图7为本发明【具体实施方式】的基于摩擦补偿的伺服系统控制的实验曲线；
[0044]图8为本发明【具体实施方式】的基于摩擦补偿的伺服系统控制及其对比方法的误差曲线；
[0045]图9为本发明【具体实施方式】的基于摩擦补偿的伺服系统控制方法流程图；
[0046]图10为本发明【具体实施方式】的对伺服系统进行基于摩擦补偿的控制流程图。
【具体实施方式】
[0047]为了使本发明的技术方案和优点更加清楚，下面结合实施例，对本发明作进一步详细说明。值得注意的是，此处所描述的具体实施例仅用于解释本发明，但并不限定本发明。
[0048]本实施方式选用美国MI公司生产的ZEBRA ZERO六自由度机械手作为伺服系统的研究对象实施本发明，如图2所示。该机械手各关节的驱动电机采用美国PITTMAN公司生产的高精度直流电机GM14602和GM9634。其中图2的编号代表机械手的各个运动关节及其转动方向，其中各关节的转动都会受到实际摩擦的影响。ZEBRA ZERO六自由度机械手的控制器选择德国dSPACE公司生产的DS1103PPC单板控制系统，该控制系统ControlDesk与Matlab/Simulink无缝连接,可将Simulink程序编译成可执行的C代码,下载到控制器中运行。增量式光电轴角编码器采用FAULHABER公司生产的HEDS-5500系列。减速齿轮的减速比η = 400。ZEBRA ZERO六自由度机械手的控制系统实验平台见图3。
[0049]如图9所示，本发明的基于摩擦补偿的伺服系统控制方法，包括以下步骤:
[0050]步骤1:伺服系统的控制机构发出电流信号，驱动伺服电机，伺服电机输出转矩信号控制伺服系统所带负载从初始位置转向目标位置；
[0051]步骤2:伺服系统的编码器实时检测伺服系统所带负载的转动角度；
[0052]步骤3:判断伺服系统所带负载是否偏离目标位置，如偏离，则执行步骤4，否则返回步骤2 ；
[0053]步骤4:对伺服系统进行基于摩擦补偿的控制，其流程如图10所示；
[0054]步骤4.1:根据伺服系统的动力学机理，以伺服电机的电流信号为输入信号，以伺服系统所带负载的转动角度为输出信号，建立伺服系统的离散线性模型:
[0055]A (z_1) y (k+1) = B (z_1) u (k)
[0056]由于一般电机伺服系统为二阶系统且考虑到伺服系统在物理上的可实现性，伺服系统的离散线性模型参数A(z_0 = Ha1Z-^a2Z-2, B(Z_0 =W, a1; a2，bQ，Id1是未知参数；
[0057]本实施方式以肩关节为例，其他关节可以此为参照。选用伪随机信号激励，采样周期Ttl = 1ms，通过最小二乘法辨识参数:
[0058]A (z—1) = 1-1.9772z_1+0.9772z_2, B (z—1) = 1.1506 X 10_4+6.0873 X ΙΟ—Υ1
[0059]步骤4.2:根据建立的伺服系统的离散线性模型确定伺服系统所带负载的理想转动角度；
[0060]y*(k+l) = -Sl1J (k) -a2y (k~l) +b0u (k) +b^ (k~l)
[0061]其中:/(k+l)离散线性模型在第k+1时刻的输出信号，即在第k+Ι时刻伺服系统所带负载的理想转动角度；y(k)是第k时刻伺服系统所带负载的实际转动角度；u(k)为第k时刻伺服电机的电流信号；
[0062]y*(k+l) = 1.9772y(k) -0.9772y (k-1)+0.00011506u (k) +0.000060873u (k-1)
[0063]步骤4.3:确定第k+1时刻伺服系统所带负载的实际转动角度y (k+Ι)与第k+Ι时刻伺服系统所带负载的理想转动角度/(k+Ι)之间的偏差信号v(k+l)，即表征伺服系统摩擦的未建模动态；
[0064]V (k+1) = y (k+1) -y* (k+1)
[0065]由于伺服系统存在摩擦干扰，其产生的摩擦力矩会削弱实际作用在负载上的动力矩，使第k+Ι时刻伺服电机所带负载的实际转动角度y (k+1)不等于理想的伺服系统的离散线性模型的输出角度/(k+1)，两者之间存在偏差信号；
[0066]步骤4.4:根据表征伺服系统摩擦的未建模动态V (k+Ι)和伺服系统的离散线性模型，建立包含伺服系统摩擦的伺服系统离散非线性模型:
[0067]A (z_1) y (k+1) = B (z_1) u (k) +v (k+1)
[0068]其中,V (k+1) = V (k) + Δ V (k), V (k)为第k时刻表征伺服系统摩擦的未建模动态；Av(k)为未建模动态在第k+Ι时刻的增量；
[0069]步骤4.5:确定未建模动态在第k时刻的增量，该增量与未建模动态在第k+Ι时刻的增量近似相等；
[0070]Δ V (k-1) =v(k)-v(k_l)
[0071]其中，v(k)为第k时刻表征伺服系统摩擦的未建模动态，V (k-1)为第k+Ι时刻表征伺服系统摩擦的未建模动态；
[0072]为针对摩擦进行补偿，需要在第k时刻引入表征伺服系统摩擦的未建模动态
V(k+Ι)，以使得伺服电机所带负载在下一时刻采样时(第k+Ι时刻)获得良好的转角输出值。但是由步骤4.3中的公式可知表征伺服系统摩擦的未建模动态V (k+Ι)在第k时刻时是未知的，所以将其写成增量的形式:v(k+1) = v(k) + A v(k),其中v(k)占v(k+l)的主体部分，Δ v(k) = V (k+1)-v (k)只占v(k+l)的极小部分,所以可以用第k时刻已知的Av(k_l)=V(k)-V(k-1)近似替代Δ v(k),得到控制模型中的v(k) + A v(k-l)即用v(k) + Δ v(k_l)来表征伺服系统摩擦的未建模动态，而无需建立内部机理尚不完全明确的复杂的摩擦模型。
[0073]步骤4.6:利用H)控制模型和表征伺服系统摩擦的未建模动态，建立基于摩擦补偿的伺服系统控制模型:
[0074]H (z-1) u (k) =R (z—1) w (k) -G (z—1) y (k) -K (z_1) [v (k) + Δ v (k_l)]
[0075]式中，H(z^)，R(z^)，G(z^)为PD 控制模型参数:H(z^) = (1+V-1)，Ii1 是待定系数 ^(z—1) = G(z_0 = go+giZ-1, g0 = Kp+Kd, gi = -Ki, Kp 和 Kd 是比例和微分系数 ^(z—1)是未建模动态补偿增益多项式，K(P) = Hk1Z^k1为未建模动态补偿增益多项式系数，z—1为时间后移算子，通过伺服系统的历史输入数据和输出数据可以得到控制模型中表征伺服系统摩擦的未建模动态:
【权利要求】
1.一种基于摩擦补偿的伺服系统控制方法，其特征在于:包括以下步骤: 步骤1:伺服系统的控制机构发出电流信号，驱动伺服电机，伺服电机输出转矩信号控制伺服系统所带负载从初始位置转向目标位置； 步骤2:伺服系统的编码器实时检测伺服系统所带负载的转动角度； 步骤3:判断伺服系统所带负载是否偏离目标位置，如偏离，则执行步骤4，否则返回步骤2 ; 步骤4:对伺服系统进行基于摩擦补偿的控制； 步骤4.1:根据伺服系统的动力学机理，以伺服电机的电流信号为输入信号，以伺服系统所带负载的转动角度为输出信号，建立伺服系统的离散线性模型:
A (z-1) y (k+1) = B (z_1) u (k) 其中，伺服系统的离散线性模型参数A(z<) = l+aiz<+a2z' B(z<) = b0+blZ_1,a” a2, b0, bi是未知参数； 步骤4.2:根据建立的伺服系统的离散线性模型确定伺服系统所带负载的理想转动角度；
y* (k+1) = (k) -a2y (k~l) +b0u (k) +b^ (k~l) 其中:/(k+l)离散线性模型在第k+1时刻的输出信号，即在第k+1时刻伺服系统所带负载的理想转动角度；y(k)是第k时刻伺服系统所带负载的实际转动角度；u(k)为第k时刻伺服电机的电流信号； 步骤4.3:确定第k+Ι时刻伺服系统所带负载的实际转动角度I (k+1)与第k+Ι时刻伺服系统所带负载的理想转动角度/(k+Ι)之间的偏差信号v(k+l)，即表征伺服系统摩擦的未建模动态；
V(k+1) = y (k+1)-y* (k+1) 步骤4.4:根据表征伺服系统摩擦的未建模动态V (k+1)和伺服系统的离散线性模型，建立包含伺服系统摩擦的伺服系统离散非线性模型:
A (z—1) y (k+Ι) = B (z-1) u (k) +v (k+1) 其中，V (k+1) = V (k) + Δ V (k), V (k)为第k时刻表征伺服系统摩擦的未建模动态；Av(k)为未建模动态在第k+Ι时刻的增量； 步骤4.5:确定未建模动态在第k时刻的增量，该增量与未建模动态在第k+Ι时刻的增量近似相等；
Δ V(k-Ι) = V(k) -V(k-1) 其中，v(k)为第k时刻表征伺服系统摩擦的未建模动态，V (k-1)为第k+Ι时刻表征伺服系统摩擦的未建模动态； 步骤4.6:利用PD控制模型和表征伺服系统摩擦的未建模动态，建立基于摩擦补偿的伺服系统控制模型:
H (z-1) u (k) =R (z-1) w (k) -G (z_1) y (k) -K (z_1) [v (k) + Δ v (k-1)] 式中，H(z^)，R(z^)，G(z^)为PD控制模型参数:H(z^) = (1+V-1)，Ii1是待定系数；R(z^) = G(z^) = go+g^^1, g0 = Kp+Kd, gl = -Ki, Kp 和 Kd 是比例和微分系数 ^(z—1)是未建模动态补偿增益多项式，K(P) = Hk1Z^k1为未建模动态补偿增益多项式系数，z—1为时间后移算子； 步骤4.7:将基于摩擦补偿的伺服系统控制模型代入包含伺服系统摩擦的伺服系统离散非线性模型，得到伺服系统的闭环方程:
[A (z—1) H (z—1) +Z-1B (z—1) G (z—1) ] y (k+Ι) = B (z—1) G (z—1) w (k) + [H (z—1) -B (z—1) K (z—1)][v (k) + Δ V (k-1) ] +H (z_1) [ Δ V (k) - Δ V (k_l)] 式中:Av(k)-Av(k-1)是未建模动态在第k+1时刻的增量与未建模动态在第k时刻的增量的偏差； 步骤4.8:采用极点配置方法确定hp Kp和Kd ； 步骤4.9:在稳态时对表征伺服系统摩擦的未建模动态进行全补偿:令H(P)-B (z—1)K(z^) = O，令K(I) = H(I)B(I),确定未建模动态补偿增益多项式系数Ic1 ; 步骤4.10:将确定的hpKpKph代入基于摩擦补偿的伺服系统控制模型，得到基于摩擦补偿的伺服系统控制模型的控制输出，即得到u (k)，即第k时刻的伺服系统的电流信号；步骤5:根据得到的伺服电机的电流信号驱动伺服电机，伺服电机输出转矩信号，从而控制伺服系统所带负载回到目标位置，并保持在目标位置。
【文档编号】G05B13/04GK104166346SQ201410384731
【公开日】2014年11月26日 申请日期:2014年8月6日 优先权日:2014年8月6日
【发明者】王良勇, 杨枭, 柴天佑, 迟瑛 申请人:东北大学