一种采用等效扰动补偿伺服系统的幂次吸引重复控制方法与流程

本发明涉及基于等效扰动估计的幂次吸引重复控制方法，该方法适用于周期位置伺服系统，也可用于其它含有周期运行过程的工业场合。

背景技术：

控制器设计时，内模原理要求闭环系统中包含输入信号模型，即将输入信号模型植入控制器，构成反馈控制作用，实现闭环系统输出无静差地跟踪输入参考信号。重复控制提供一种基于内模原理的控制器设计方法，它具有“记忆”和“学习”特性，以输出误差信号修正前一周期的控制输入。它能够完全抑制周期扰动，从而实现精确控制。重复控制技术在电力电子线路、工业机器人及硬盘驱动等高精度伺服系统中得到应用。

吸引律方法直接采用跟踪误差信号，控制器设计更为直接、简洁。通常的吸引律反映了不考虑扰动时期望的系统误差动态特性；对于存在干扰的情形，因为含有干扰项，无法实现直接依据吸引律设计的控制器。解决的办法是将干扰抑制措施“嵌入”原吸引律，构建具有扰动抑制作用的理想误差动态，依据构造的理想误差动态方程设计控制器。这样，闭环系统动态过程由理想误差动态所决定，且具有理想误差动态所表征的期望跟踪性能。

对于以吸引律方法设计数字控制器，通过离散化连续时间吸引律进行设计，刻画跟踪误差瞬态和稳态行为的性能指标可通过分析理想误差动态特性给出，具体有下述四个指标：绝对吸引层、单调递减区域、稳态误差带以及进入稳态误差带的最大步数。这些指标的具体取值依赖于控制器参数和等效干扰信号的界，因此，控制器参数和等效干扰信号的界不同，三个指标的取值也不同。一旦给定理想误差动态形式，可预先给出各项指标的具体表达式，用于指导控制器参数整定。

扩张状态观测器(eso)是自抗扰控制系统的核心单元，其基本做法是将总体扰动(包括内扰和外扰)定义为新的状态，借用状态观测方法，构造扩张状态(包括总体扰动作用)的状态观测器。它不仅能够估计系统状态，还能估计系统模型中总体扰动的实时作用量，用于补偿扰动信号的影响。由于总体扰动囊括系统模型中的不确定性，大大简化了系统模型，控制增益也可看成已知的，便于控制器设计。扩张观测器提供了一种通用且实用的不确定特性观测方法。

技术实现要素：

为了克服现有的幂次吸引重复控制方法的系统跟踪精度较低、无法抑制周期扰动的不足，本发明提供一种采用等效扰动补偿伺服系统的幂次吸引重复控制方法，为使得闭环系统具有预先设定的期望误差跟踪性能，依据幂次吸引构造的理想误差动态方程设计电机伺服重复控制器，在实现对周期干扰成分完全抑制的同时，考虑到扰动存在非周期成分，在闭环系统中引入扰动观测器，以便补偿非周期性干扰，进一步提高控制性能，使得电机伺服系统实现高速、高精度跟踪；本发明将影响系统输出的扰动作用扩张成新的变量，构造扰动观测器，这个扰动观测器不需要直接量测扰动信号，也无需知道扰动信号的具体模型，本发明具体给出稳态误差带、绝对吸引层、单调减区域以及跟踪误差首次进入稳态误差带所需最多步数四个指标的具体表达式，可用于指导控制器参数整定。

本发明解决上述技术问题采用的技术方案是：

一种采用等效扰动补偿伺服系统的幂次吸引重复控制器设计方法，包括以下步骤：

步骤1.给定周期参考信号，满足

rk＝rk-n(1)

其中，n为参考信号的周期，rk和rk-n分别表示k时刻和k-n时刻的参考信号；

步骤2.定义跟踪误差

式中

a1(q^-1)＝a1+a2q^-1+...+anq^-n+1＝q(a(q^-1)-1)

a(q^-1)＝1+a1q^-1+...+anq^-n

b(q^-1)＝b0q^-1+...+bmq^-m

满足

a(q^-1)yk＝q^-db(q^-1)uk+wk(3)

其中，ek+1表示k+1时刻的跟踪误差，rk+1表示k+1时刻的参考信号，yk+1、yk、yk+1-n和yk-n分别表示k+1、k、k+1-n和k-n时刻的输出信号，uk和uk-n分别表示k和k-n时刻的输入信号，wk+1和wk+1-n分别表示k和k-n时刻的干扰信号，d表示延迟，a(q^-1)和b(q^-1)为q^-1的多项式，q^-1表示一步延迟算子，n表示a(q^-1)的阶数，m表示b(q^-1)的阶数，a1,...,an,b0,...,bm为系统参数且b0≠0，n≥m，d为整数，且d≥1；

步骤3.构造等效扰动

dk＝wk-wk-n(4)

其中，n为参考信号的周期，dk表示k时刻的等效扰动信号，wk和wk-n分别表示k时刻和k-n时刻的干扰信号；

利用(4)将跟踪误差表达为

ek+1＝rk+1-yk+1-n+a1(q^-1)(yk-yk-n)-q^-d+1b(q^-1)(uk-uk-n)-dk+1(5)

其中，dk+1表示k+1时刻的等效扰动；

步骤4.设计观测器，估计等效扰动

设计观测器对等效扰动dk+1进行观测，并以观测值补偿等效扰动，观测器的两个观测变量为和分别用来估计ek和dk，根据误差动态(式(5))，设计如下形式的观测器

其中，表示对误差ek+1的估计，表示对误差ek的估计，表示等效扰动，β1表示关于误差的观测器增益系数，β2表示关于等效扰动的观测器增益系数，表示跟踪误差的估计误差；

等效扰动的估计误差为

跟踪误差的估计误差为

将式(7)和(8)写成如下形式

记其特征方程为

|λi-b|＝0(10)

即

λ²+(β1-β2-1)λ-β1＝0(11)

因此，特征根为

对参数β1和β2进行配置，使得所有特征根都在单位圆内，则矩阵b是schur稳定矩阵，估计误差渐近收敛，即

步骤5.构造具有扰动抑制措施的幂次吸引律

其中，ρ和ε均为可调参数，表示吸引指数，且0＜ρ＜1，ε＞0，

步骤6.构造具有等效扰动补偿的重复控制器

结合式(5)和式(12)，设计具有等效扰动补偿的重复控制器

记

将重复控制器表达为

uk＝uk-n+vk(14)

将uk作为伺服对象的控制器输入信号，可测量获得伺服系统输出信号yk，跟随参考信号rk变化。

进一步，给出稳态误差带、绝对吸引层、单调减区域以及跟踪误差首次进入稳态误差带所需最多步数等四个指标的表达式，用于刻画系统跟踪性能，并指导控制器参数整定，其中的稳态误差带、绝对吸引层、单调减区域以及最大收敛步数定义如下：

1)单调减区域δmdr：当ek大于此边界时，ek同号递减，即满足如下条件：

2)绝对吸引层δaal：当系统跟踪误差的绝对值|ek|大于此界时,其|ek|单调递减,即满足如条件：

3)稳态误差带δsse：当系统误差一旦收敛进入该边界，那么误差就会稳定在此区域内，即满足如下条件：

4)最大收敛步数跟踪误差最多经过步进入稳态误差带。

等效扰动补偿误差满足时，各指标的表达式如下

单调减区域δmdr

δmdr＝max{δmdr1,δmdr2}(18)

其中，δmdr1和δmdr2均为实数，且由式(19)确定。

绝对吸引层δaal

δaal＝max{δaal1,δaal2}(20)

其中，δaal1和δaal2均为实数，且由式(21)确定。

稳态误差带δsse

δsse＝max{δsse1,δsse2}(22)

其中，δsse1和δsse2均为实数，且由式(23)确定；

另外，在给出δsse后，跟踪误差进入稳态误差带的最大步数

其中，e0为跟踪误差初始值，表示不小于·的最小整数。

更进一步，对于两种情形，依据给出的δmdr、δaal、δsse表达式及收敛步数表达式确定相应的计算公式；

情形：

1)单调减区域δmdr

1.1)当时

1.2)当时

1.3)当时

其中

2)绝对吸引层δaal

2.1)当时

2.2)当时

2.3)当时

其中

3)稳态误差带

3.1)当或者δaal≥δsse时

δsse＝δaal(31)

3.2)当时

其中δsse是方程的正实根。

4)收敛步数

其中，e0为跟踪误差初始值，表示不小于·的最小整数；

情形：

1)单调减区域δmdr

1.1)当时

1.2)当时

1.3)当时

其中

2)绝对吸引层δaal

2.1)当时

2.2)当时

2.3)当时

其中

3)稳态误差带

3.1)当或者δaal≥δsse时

δsse＝δaal(40)

3.2)当时

其中δsse是方程的正实根；

4)收敛步数

其中，e0为跟踪误差初始值，表示不小于·的最小整数。

本发明的技术构思为：提供一种采用等效扰动补偿伺服系统的幂次吸引重复控制方法。根据给定参考信号和构造的等效扰动，引入观测器对等效扰扰动进行估计，并将干扰抑制措施嵌入幂次吸引律中，形成具有干扰抑制作用的理想误差动态，从而设计出具有等效扰动补偿的重复控制器，实现对给定参考信号的快速高精度跟踪。

本发明的有益效果主要表现在：具有等效扰动补偿、周期干扰完全抑制、快速收敛性能和高跟踪精度。

附图说明

图1是交流永磁同步电机伺服系统方框图。

图2是等效扰动观测器方框图。

图3是幂次吸引重复控制器方框图。

图4是当扰动wk＝5sin(2πfkts)+0.15sgn(sin(2kπ/150))，控制器参数取ε＝0.1，ρ＝0.3，δ＝0.3时的仿真结果，图中标出δmdr，δaal及δsse。

图5是当扰动wk＝-10sin(2πfkts)+0.15sgn(sin(2kπ/150))，控制器参数取ε＝0.1，ρ＝0.3，δ＝0.3时的仿真结果，图中标出δmdr，δaal及δsse。

图6是当扰动wk＝5sin(2πfkts)+0.15sgn(sin(2kπ/150))，控制器参数取ε＝0.15，ρ＝0.5，δ＝0.3时的仿真结果，图中标出δmdr，δaal及δsse。

图7是当扰动wk＝-10sin(2πfkts)+0.15sgn(sin(2kπ/150))，控制器参数取ε＝0.15，ρ＝0.5，δ＝0.3时的仿真结果，图中标出δmdr，δaal及δsse。

图8-11是反馈控制器参数取ρ＝0.3，ε＝0.1时，永磁同步电机控制装置的实验结果，其中：

图8是基于幂次吸引律的反馈控制器作用下的参考位置信号和实际位置信号；

图9是基于幂次吸引律的反馈控制器作用下的控制电压信号；

图10是基于幂次吸引律的反馈控制器作用下的位置误差；

图11是基于幂次吸引律的反馈控制器作用下的位置误差分布直方图。

图12-15是反馈控制器参数取ρ＝0.3，ε＝0.1，观测器参数取β1＝0.2，β2＝0.5时，永磁同步电机控制装置的实验结果，其中：

图12是基于幂次吸引律和等效扰动补偿的反馈控制器作用下的参考位置信号和实际位置信号；

图13是基于幂次吸引律和等效扰动补偿的反馈控制器作用下的控制电压信号；

图14是基于幂次吸引律和等效扰动补偿的反馈控制器作用下的位置误差；

图15是基于幂次吸引律和等效扰动补偿的反馈控制器作用下的位置误差分布直方图。

图16-19是重复控制器参数取ρ＝0.3，ε＝0.1时，永磁同步电机控制装置的实验结果，其中：

图16是基于幂次吸引律的重复控制器作用下的参考位置信号和实际位置信号；

图17是基于幂次吸引律的重复控制器作用下的控制电压信号；

图18是基于幂次吸引律的重复控制器作用下的位置误差；

图19是基于幂次吸引律的重复控制器作用下的位置误差分布直方图。

图20-23是重复控制器参数取ρ＝0.3，ε＝0.1，观测器参数取β1＝0.2，β2＝0.5时，永磁同步电机控制装置的实验结果，其中：

图20是基于幂次吸引律和等效扰动补偿的重复控制器作用下的参考位置信号和实际位置信号；

图21是基于幂次吸引律和等效扰动补偿的重复控制器作用下的控制电压信号；

图22是基于幂次吸引律和等效扰动补偿的重复控制器作用下的位置误差；

图23是基于幂次吸引律和等效扰动补偿的重复控制器作用下的位置误差分布直方图。

图24-27是反馈控制器参数取ρ＝0.5，ε＝0.15时，永磁同步电机控制装置的实验结果，其中：

图24是基于幂次吸引律的反馈控制器作用下的参考位置信号和实际位置信号；

图25是基于幂次吸引律的反馈控制器作用下的控制电压信号；

图26是基于幂次吸引律的反馈控制器作用下的位置误差；

图27是基于幂次吸引律的反馈控制器作用下的位置误差分布直方图。

图28-31是反馈控制器参数取ρ＝0.5，ε＝0.15，观测器参数取β1＝0.2，β2＝0.5时，永磁同步电机控制装置的实验结果，其中：

图28是基于幂次吸引律和等效扰动补偿的反馈控制器作用下的参考位置信号和实际位置信号；

图29是基于幂次吸引律和等效扰动补偿的反馈控制器作用下的控制电压信号；

图30是基于幂次吸引律和等效扰动补偿的反馈控制器作用下的位置误差；

图31是基于幂次吸引律和等效扰动补偿的反馈控制器作用下的位置误差分布直方图。

图32-35是重复控制器参数取ρ＝0.5，ε＝0.15时，永磁同步电机控制装置的实验结果，其中：

图32是基于幂次吸引律的重复控制器作用下的参考位置信号和实际位置信号；

图33是基于幂次吸引律的重复控制器作用下的控制电压信号；

图34是基于幂次吸引律的重复控制器作用下的位置误差；

图35是基于幂次吸引律的重复控制器作用下的位置误差分布直方图。

图36-39是重复控制器参数取ρ＝0.5，ε＝0.15，观测器参数取β1＝0.2，β2＝0.5时，永磁同步电机控制装置的实验结果，其中：

图36是基于幂次吸引律和等效扰动补偿的重复控制器作用下的参考位置信号和实际位置信号；

图37是基于幂次吸引律和等效扰动补偿的重复控制器作用下的控制电压信号；

图38是基于幂次吸引律和等效扰动补偿的重复控制器作用下的位置误差；

图39是基于幂次吸引律和等效扰动补偿的重复控制器作用下的位置误差分布直方图。

具体实施方式

下面结合附图对本发明具体实施方式作进一步描述。

参照图1-图39，一种采用等效扰动补偿伺服系统的幂次吸引重复控制方法。其中，图1是交流永磁同步电机伺服系统方框图；图2等效扰动观测器方框图；图3是幂次吸引重复控制器方框图。

一种采用等效扰动补偿伺服系统的幂次吸引重复控制方法，包括以下步骤：

步骤1.给定周期参考信号，满足(1)；

步骤2.定义跟踪误差，电机伺服系统的二阶差分模型为(2)，系统的跟踪误差为(3)；

步骤3.构造等效扰动(4)，利用(4)将系统跟踪误差表达为(5)；

步骤4.设计观测器，估计等效扰动；

步骤5.构造具有扰动抑制措施的幂次吸引律(12)；

步骤6.构造具有等效扰动补偿的重复控制器，结合式(5)和式(12)，设计具有等效扰动补偿的重复控制器(13)，将重复控制器表达为(14)。

上述重复控制器设计，做以下说明：

1)幂次吸引律中引入dk+1，反映了对于给定周期模式的扰动信号的抑制措施，引入的反映了等效扰动的估计值，据此提供等效扰动补偿。

2)式(13)中，ek、yk、yk-1、yk-1-n均可通过测量得到，uk-1、uk-1-n为控制信号的存储值，可以从内存中读取。

3)当参考信号满足rk＝rk-1，该离散重复控制器也适用于常值调节问题，这时的等效扰动为dk＝wk-wk-1；其中，rk-1表示k-1时刻的参考信号，wk-1表示k-1时刻的干扰信号；具有等效扰动补偿的反馈控制器为

4)上述离散时间控制器针对二阶系统进行设计，按照相同的方法同样可以给出更高阶系统的设计结果。

进一步，给出稳态误差带、绝对吸引层、单调减区域以及跟踪误差首次进入稳态误差带所需最多步数四个指标的表达式，用于刻画系统跟踪性能及指导控制器参数整定。

更进一步地，对于两种情形，依据给出的δmdr、δaal、δsse表达式及收敛步数表达式确定相应的计算公式。

本实施例以永磁同步电机装置在固定区间上执行重复跟踪任务为例，其位置参考信号具有周期对称特性。以tms320f2812dsp作为控制器，韩国ls交流伺服电机apm-sb01agn作为控制对象，与elmo交流伺服驱动器以及上位机构成永磁同步电机伺服系统，进行电机位置控制。其中伺服系统采用三环控制，电流环与速度环控制器elmo驱动器提供，位置环由dsp开发板提供。

通过参数估计获得伺服对象的数学模型为

yk+1-1.8949yk+0.8949yk-1＝1.7908uk-0.5704uk-1+wk+1(43)

其中，yk，uk分别为位置伺服系统的位置输出与控制输入，wk为干扰信号。

该实施例中将通过数值仿真和实验结果说明本发明给出重复控制器的有效性。

数值仿真本实施例以正弦信号作为系统参考信号，相应的重复控制器表达式可写成

给定位置参考信号为rk＝20(sin(2πfkts-1/2π)+1)，单位为度(deg)，频率f＝1hz，采样周期ts＝0.001s，采样周期n＝1000。仿真时选取适当扰动量wk，它由周期扰动和非周期随机干扰构成。

在重复控制器(44)作用下，选取不同的控制器参数ρ、ε，伺服系统的三个边界层也各不相同。为说明本发明专利关于单调减区域δmdr、绝对吸引层δaal和稳态误差带δsse的理论正确性，以为例进行数值仿真。

1)当控制器参数ε＝0.1，ρ＝0.3，δ＝0.3时，根据三个边界值的计算公式，可知

δsse＝δaal＝δmdr＝0.7035

2)当控制器参数ε＝0.15，ρ＝0.5，δ＝0.3时，根据三个边界值的计算公式，可知

δsse＝δaal＝0.3823，δmdr＝0.8884

仿真结果见图4-7，其中图4，6是扰动量wk＝5sin(2πfkts)+0.15sgn(2kπ/150)的仿真结果，图5，7是扰动量wk＝-10sin(2πfkts)+0.15sgn(2kπ/150)的仿真结果。

在给定系统模型、参考信号和干扰信号的情况下，上述数值结果验证了本专利给出的重复控制器作用下系统跟踪误差的单调减区域δmdr、绝对吸引层δaal和稳态误差带δsse的准确性。

实验验证实验所用永磁同步电机控制系统的方框图见图1所示。通过设置不同控制器参数，验证基于幂次吸引律的离散重复控制的跟踪性能。给定位置信号rk＝a(sin(2πfkts)+1)，其中，幅值a＝135deg,采样周期ts＝5ms，频率f＝1hz，以为例进行实验验证。

采用的反馈控制器具有如下形式

采用的基于扰动补偿的反馈控制器具有如下形式

采用的重复控制器具有如下形式

采用的基于扰动补偿的重复控制器具有如下形式

1)采用控制器(45)，控制器参数取ρ＝0.3，ε＝0.1，实验结果如图8-11所示，图中δsse＝0.15deg。

2)采用控制器(46)，控制器参数取ρ＝0.3，ε＝0.1，等效扰动观测器参数取β1＝0.2，β2＝0.5，实验结果如图12-15所示，图中δsse＝0.1deg。

3)采用控制器(47)，控制器参数取ρ＝0.3，ε＝0.1，实验结果如图16-19所示，图中δsse＝0.1deg。

4)采用控制器(48)，控制器参数取ρ＝0.3，ε＝0.1，等效扰动观测器参数取β1＝0.2，β2＝0.5，实验结果如图20-23所示，图中δsse＝0.08deg。

5)采用控制器(45)，控制器参数取ρ＝0.5，ε＝0.15，实验结果如图24-27所示，图中δsse＝0.15deg。

6)采用控制器(46)，控制器参数取ρ＝0.5，ε＝0.15，等效扰动观测器参数取β1＝0.2，β2＝0.5，实验结果如图28-31所示，图中δsse＝0.11deg。

7)采用控制器(47)，控制器参数取ρ＝0.5，ε＝0.15，实验结果如图32-35所示，图中δsse＝0.1deg。

8)采用控制器(48)，控制器参数取ρ＝0.5，ε＝0.15，等效扰动观测器参数取β1＝0.2，β2＝0.5，实验结果如图36-39所示，图中δsse＝0.07deg。

上述实验结果表明，引入等效扰动，以等效扰动观测器对其进行估计，提供对于系统未建模特性和外部未知扰动的补偿，能够有效抑制未知扰动对跟踪性能的影响；采用重复控制对周期扰动实现完全抑制，进一步了提高系统的控制性能。