基于扩张误差符号积分鲁棒的电机伺服系统位置控制器的实现方法

摘要

本发明涉及机电伺服控制领域，公开了一种基于扩张误差符号积分鲁棒的电机伺服系统位置控制器(RISEE)，属于机电伺服控制领域。本发明选取直流旋转电机位置伺服系统作为研究对象，建立了考虑系统的总扰动的非线性模型；所设计的控制器通过引入基于扩张误差信号积分的鲁棒项针对系统存在的外部干扰以及未建模动态等不确定性具有良好的鲁棒性；本发明所设计的基于扩张误差符号积分的电机伺服系统鲁棒位置控制器为全状态反馈控制器，并能使电机伺服系统的位置输出具有渐近跟踪性能，即当时间趋于无穷时跟踪误差为零；本发明所设计的控制器参数容易调节并且控制输入电压连续，更利于在工程实际中应用。

权利要求

1.一种基于扩张误差符号积分鲁棒的电机伺服系统位置控制器的实现方法，其特征在于，包括以下步骤：步骤一、建立电机位置伺服系统的数学模型：

公式(1)中J为负载的转动惯量；y为负载的角位移；Kf为力矩放大系数；u为控制输入电压； 为可建模的非线性摩擦模型，其中 代表不同的摩擦水平， 代表不同的形状函数矢量用来描述各种非线性摩擦的影响， 其中B为粘性摩擦系数；

为包括外干扰及未建模摩擦的不确定性项；

针对直流旋转电机伺服系统，定义参数集θ＝[θ1,θ2]T，其中θ1＝J/Kf，θ2＝B/Kf代表系统参数的已知名义值；定义系统状态变量为由式(1)表征的非线性模型，则系统非线性模型的状态空间形式可以表达为：公式(2)中f(x,t)＝d(x,t)/Kf为总的扰动包括实际系统中的建模不确定项和参数偏差影响；

假设1：系统状态x1、x2可测；

假设2：总扰动f(x,t)足够光滑并且 其中δ为已知常数；

步骤二、针对公式(2)中的状态方程，设计基于扩张误差符号积分鲁棒的电机伺服系统位置控制器，其具体步骤如下：步骤二(一)、定义一组类似开关函数的变量为：

公式(3)中z1＝x1-x1d为系统的跟踪误差，即位置命令x1d与实际位置x1的差值，k1、k2为正的反馈增益；在公式(3)中引入了一个扩张误差信号r来获得额外的设计自由；

步骤二(二)、设计非线性鲁棒控制器输入u，使得电机伺服系统具有渐近跟踪性能；

根据公式(3)，扩张误差信号r可以整理为：

基于系统状态方程(2)，可以得到：

根据公式(5)的结构，电机伺服系统的非线性鲁棒控制器设计为：kr为正反馈增益；ua为基于模型的前馈补偿控制律；us为非线性鲁棒控制律用来保证名义系统的稳定性；un为基于扩张误差信号r积分的鲁棒控制律，其用来处理时变的扰动，un的值将在以下的步骤中给出；

把(6)中的控制律带入到(5)中，可以得到：

对公式(7)进行微分可以得到：

根据公式(8)可以设计鲁棒控制律un为：

其中sign(r)定义为：

由于扩张误差信号r未知，为了计算公式(9)中的sign(r)，定义函数g(t)为：由于r(t)＝limτ→0(g(t)-g(t-τ))/τ，τ可以选取为采样时间，根据(11)可以看出只需要知道r的符号sign(r)即可，因此只需要知道g(t)增加还是减小就可以获得sign(r)，其中sign(r)＝sign(g(t)-g(t-τ))；

步骤三、调节参数τ、τ＞0，k1、k1＞0；k2、k2＞0以及kr、kr＞0，从而来确保整个系统稳定，并使电液位置伺服系统的负载角位移输出y(t)跟踪期望的位置指令yd。

说明书

基于扩张误差符号积分鲁棒的电机伺服系统位置控制器的实

现方法

技术领域

[0001] 本发明涉及机电伺服控制领域，具体而言涉及一种基于扩张误差符号积分鲁棒的电机伺服系统位置控制器的实现方法。

背景技术

[0002] 电机伺服系统由于具有响应快、传动效率高、维护方便以及能源获取方便等突出优点，广泛应用于工业及国防等重要领域，如机床进给、火箭炮随动系统、机器人等。随着这些领域的发展和技术水平的不断进步，迫切需要高性能的电机伺服系统作为支撑，传统基于线性化方法得到的控制性能逐渐不能满足系统需求。电机伺服系统存在诸多模型不确定性，包括参数不确定性(如负载质量的变化、随温度及磨损而变化的粘性摩擦系数等)以及不确定性非线性(如外干扰等)，这些不确定性的存在可能会严重恶化期望的控制性能，甚至使基于系统名义模型所设计的控制器不稳定，因此成为发展先进控制器的主要障碍。

[0003] 一般地，自适应控制能有效的估计未知常数参数并能提高其跟踪精度，然而当系统遭受大的未建模扰动时可能会不稳定。传统鲁棒控制器，如滑模控制器，可以有效提高整个闭环系统对未建模扰动的鲁棒性，但是控制器输入会产生抖动现象，不利于在工程实际中应用；如自抗扰控制器(ADRC)对系统中存在的大的扰动能有效的进行前馈补偿，但是所提出的ADRC方法仅仅只能确保系统的跟踪误差有界。总的来看，自适应控制和鲁棒控制有它们各自的优缺点。美国普渡大学的Bin Yao教授团队针对非线性系统的所有不确定性，提出了一种数学论证严格的非线性自适应鲁棒控制(ARC)理论框架。其团队主要基于系统非线性数学模型设计非线性控制器，针对参数不确定性，设计恰当的在线参数估计策略，以提高系统的跟踪性能；对可能发生的外干扰等不确定性非线性，通过强增益非线性反馈控制予以抑制。由于强增益非线性反馈控制往往导致较强的保守性(即高增益反馈)，在工程使用中有一定困难，并且系统中潜在的大的未建模扰动可能会使系统的跟踪性能变差。为了补偿在ARC设计时的扰动，有学者设计了基于扩张状态观测器的ARC设计方法，并从理论和实验结果上验证了所提出的控制器能使系统具有良好的跟踪性能。然而，以上所提出的非线性设计方法仅仅只能确保系统的跟踪误差有界，这样的性能可能会在实际高精度需求的场合难以满足要求。对此有学者提出了基于误差符号积分的鲁棒控制(RISE)方法对存在匹配性扰动的系统能确保其跟踪误差在稳态时趋于零，然而这种控制器设计方法相对复杂并且只能保证整个系统半全局渐近稳定。如何恰当的设计出能保证整个系统全局渐近稳定并且简单的控制器仍是目前研究的焦点。

[0004] 总结来说，现有电机伺服系统的控制策略的不足之处主要有以下几点：

[0005] 1.传统滑模控制器作用于系统会使控制输入产生抖动现象；

[0006] 2.自抗扰控制器(ADRC)只能确保系统的跟踪误差有界；

[0007] 3.传统的自适应鲁棒控制(ARC)存在高增益反馈现象。传统自适应鲁棒控制存在高增益反馈的问题，也就是通过增加反馈增益来减小跟踪误差。然而高增益反馈易受测量噪声影响且可能激发系统的高频动态进而降低系统的跟踪性能，甚至导致系统不稳定；

[0008] 4.传统的自适应鲁棒控制(ARC)对同时存在参数不确定性和不确定性非线性的系统只能保证跟踪误差有界(即保证跟踪误差在一个有界的范围内，并不能确保跟踪误差趋于零)。传统的自适应鲁棒控制对同时存在参数不确定性和不确定性非线性的系统只能确保系统的跟踪误差有界，这样的性能可能会在实际高精度需求的场合难以满足要求。

[0009] 5.基于误差符号积分的鲁棒控制(RISE)器设计相对复杂并且只能保证整个系统半全局渐近稳定。

发明内容

[0010] 本发明为解决传统滑模控制器作用于系统会使控制输入产生抖动现象、自抗扰控制器(ADRC)只能确保系统的跟踪误差有界、传统的自适应鲁棒控制(ARC)存在高增益反馈现象以及对同时存在参数不确定性和不确定性非线性的系统只能保证跟踪误差有界(即保证跟踪误差在一个有界的范围内，并不能确保跟踪误差趋于零)，同时基于误差符号积分的鲁棒控制(RISE)器设计相对复杂并且只能保证整个系统半全局渐近稳定的问题，提出一种基于扩张误差符号积分的电机伺服系统鲁棒位置控制器。

[0011] 本发明为解决上述问题采取的技术方案如下：

[0012] 基于扩张误差符号积分鲁棒的电机伺服系统位置控制器的实现方法，包括以下步骤：

[0013] 2、基于扩张误差符号积分鲁棒的电机伺服系统位置控制器的实现方法，其特征在于，包括以下步骤：

[0014] 步骤一、建立电机位置伺服系统的数学模型：

[0015]

[0016] 公式(1)中J为负载的转动惯量；y为负载的角位移；Kf为力矩放大系数；u为控制输入电压； 为可建模的非线性摩擦模型，其中 代表不同的摩擦水平， 代表不同的形状函数矢量用来描述各种非线性摩擦的影响， 其中B为粘性摩擦系数；为包括外干扰及未建模摩擦的不确定性项；

[0017] 针对直流旋转电机伺服系统，定义参数集θ＝[θ1,θ2]T，其中θ1＝J/Kf，θ2＝B/Kf代表系统参数的已知名义值；定义系统状态变量为

[0018] 由式(1)表征的非线性模型，则系统非线性模型的状态空间形式可以表达为：

[0019]             (2)

[0020]

[0021] 公式(2)中f(x,t)＝d(x,t)/Kf为总的扰动包括实际系统中的建模不确定项和参数偏差影响；

[0022] 假设1：系统状态x1、x2可测；

[0023] 假设2：总扰动f(x,t)足够光滑并且 其中δ为已知常数；

[0024] 步骤二、针对公式(2)中的状态方程，设计基于扩张误差符号积分的电机伺服系统鲁棒位置控制器，其具体步骤如下：

[0025] 步骤二(一)、定义一组类似开关函数的变量为：

[0026]

[0027] 公式(3)中z1＝x1-x1d为系统的跟踪误差，k1、k2为正的反馈增益。在公式(3)中引入了一个扩张的误差信号r来获得额外的设计自由；

[0028] 步骤二(二)、设计非线性鲁棒控制器输入u，使得电机伺服系统具有渐近跟踪性能[0029] 根据公式(3)，扩张误差信号r可以整理为：

[0030]

[0031] 基于系统状态方程(2)，可以得到：

[0032]

[0033] 根据公式(5)的结构，电机伺服系统的非线性鲁棒控制器设计为：

[0034] u＝ua+us+un,ua＝θTYd,

[0035]

[0036]

[0037] kr为正反馈增益；ua为基于模型的前馈补偿控制律；us为非线性鲁棒控制律用来保证名义系统的稳定性；un为基于扩张误差符号r积分的鲁棒控制律，其用来处理时变的扰动，un的值将在以下的步骤中给出；

[0038] 把(6)中的控制律带入到(5)中，可以得到：

[0039]

[0040] 对公式(7)进行微分可以得到：

[0041]

[0042] 根据公式(8)可以设计鲁棒控制律un为：

[0043]

[0044] 其中sign(r)定义为：

[0045]

[0046] 由于信号r未知，为了计算公式(9)中的sgn(r)，定义函数g(t)为：

[0047]

[0048] 由于r(t)＝limτ→0(g(t)-g(t-τ))/τ，τ可以选取为采样时间，根据(11)可以看出只需要知道r的符号sgn(r)即可，因此只需要知道g(t)增加还是减小就可以获得sgn(r)，其中sgn(r)＝sgn(g(t)-g(t-τ))；

[0049] 步骤三、调节参数τ(τ＞0)、k1(k1＞0)、k2(k2＞0)以及kr(kr＞0)，从而来确保整个系统稳定，并使电液位置伺服系统的位置输出y(t)跟踪期望的位置指令yd。

[0050] 本发明的有益效果是：本发明选取直流旋转电机位置伺服系统作为研究对象，建立了考虑系统的总扰动的非线性模型；所设计的控制器通过引入基于扩张误差信号积分的鲁棒项针对系统存在的外部干扰以及未建模动态等不确定性具有良好的鲁棒性；本发明所设计的基于扩张误差符号积分的电机伺服系统鲁棒位置控制器为全状态反馈控制器，并能使电机伺服系统的位置输出具有渐近跟踪性能，即当时间趋于无穷时跟踪误差为零；本发明所设计的控制器参数容易调节并且控制输入电压连续，更利于在工程实际中应用。

[0051] 应当理解，前述构思以及在下面更加详细地描述的额外构思的所有组合只要在这样的构思不相互矛盾的情况下都可以被视为本公开的发明主题的一部分。另外，所要求保护的主题的所有组合都被视为本公开的发明主题的一部分。

[0052] 结合附图从下面的描述中可以更加全面地理解本发明教导的前述和其他方面、实施例和特征。本发明的其他附加方面例如示例性实施方式的特征和/或有益效果将在下面的描述中显见，或通过根据本发明教导的具体实施方式的实践中得知。

附图说明

[0053] 附图不意在按比例绘制。在附图中，在各个图中示出的每个相同或近似相同的组成部分可以用相同的标号表示。为了清晰起见，在每个图中，并非每个组成部分均被标记。现在，将通过例子并参考附图来描述本发明的各个方面的实施例，其中：

[0054] 图1是本发明所考虑的直流旋转电机位置伺服系统示意图。

[0055] 图2是基于扩张误差符号积分的电机伺服系统鲁棒位置控制器原理示意及流程图；

[0056] 图3是本发明所设计的控制器(图中以RISEE标识)和传统PID控制器(图中以PID标识)分别作用下系统的跟踪误差随时间变化的曲线示意图。

[0057] 图4是电机位置伺服系统的实际控制输入u随时间变化的曲线示意图。

具体实施方式

[0058] 为了更了解本发明的技术内容，特举具体实施例并配合所附图式说明如下。

[0059] 在本公开中参照附图来描述本发明的各方面，附图中示出了许多说明的实施例。本公开的实施例不必定意在包括本发明的所有方面。应当理解，上面介绍的多种构思和实施例，以及下面更加详细地描述的那些构思和实施方式可以以很多方式中任意一种来实施，这是因为本发明所公开的构思和实施例并不限于任何实施方式。另外，本发明公开的一些方面可以单独使用，或者与本发明公开的其他方面的任何适当组合来使用。

[0060] 结合图1至图2说明本实施方式，本实施方式的基于扩张误差符号积分鲁棒的电机伺服系统位置控制器的实现方法具体步骤如下：

[0061] 步骤一、建立电机位置伺服系统的数学模型，本发明以直流旋转电机(如图1所示)为例，根据牛顿第二定律可得系统的运动学方程为：

[0062]

[0063] 公式(1)中J为负载的转动惯量；y为负载的角位移；Kf为力矩放大系数；u为控制输入电压； 为可建模的非线性摩擦模型，其中 代表不同的摩擦水平， 代表不同的形状函数矢量用来描述各种非线性摩擦的影响，本发明为了提高控制器设计的可理解性，着重验证控制器对未建模动态的鲁棒性，从而简化控制器的补偿部分，因而采用线性摩擦模型，即 其中B为粘性摩擦系数； 为外干扰及未建模的摩擦等不确定性项。

[0064] 为使控制器的设计更具广泛性，针对直流旋转电机伺服系统，定义参数集θ＝[θ1,Tθ2] ，其中θ1＝J/Kf，θ2＝B/Kf代表系统参数的已知名义值；定义系统状态变量为由式(1)表征的非线性模型，则系统非线性模型的状态空间形式可以
表达为：

[0065]           (2)

[0066]

[0067] 公式(2)中f(x,t)＝d(x,t)/Kf为总的扰动包括实际系统中的建模不确定项和参数偏差影响。

[0068] 假设1：系统状态x1、x2可测；

[0069] 假设2：总扰动f(x,t)足够光滑并且 其中δ为已知常数。

[0070] 在以下的控制器设计中，假设2给未建模扰动施加了一些约束。虽然摩擦一般被建模为不连续函数会导致假设2有点保守，但是没有哪个执行器可以产生不连续的力来补偿不连续摩擦力的影响，因此在基于模型的控制器设计时仍然采用一些连续的摩擦模型，假设2符合实际情况。控制器的设计目标是使位置输出x1尽可能地跟踪期望跟踪的理想轨迹x1d＝yd(t)。

[0071] 步骤二、针对公式(2)中的状态方程，设计基于扩张误差符号积分的电机伺服系统鲁棒位置控制器，其具体步骤如下：

[0072] 步骤二(一)、定义一组类似开关函数的变量为：

[0073]

[0074] 公式(3)中z1＝x1-x1d为系统的跟踪误差，k1、k2为正的反馈增益。我们在公式(3)中引入了一个扩张的误差信号r来获得额外的设计自由。值得注意的是，由于扩张的误差信号r依赖于加速度 的信息从而使得它不可测，这里仅仅用来协助以下的控制器设计。

[0075] 步骤二(二)、设计非线性鲁棒控制器输入u，使得电机伺服系统具有渐近跟踪性能。

[0076] 根据公式(3)，扩张误差信号r可以整理为：

[0077]

[0078] 基于系统状态方程(2)，我们可以得到：

[0079]

[0080] 根据公式(5)的结构，电机伺服系统的非线性鲁棒控制器可以设计为：

[0081] u＝ua+us+un,ua＝θTYd,

[0082]

[0083]

[0084] kr为正反馈增益；ua为基于模型的前馈补偿控制律；us为非线性鲁棒控制律用来保证名义系统的稳定性；un为基于扩张误差符号r积分的鲁棒控制律，其用来处理时变的扰动，un的值将在以下的设计步骤中给出。

[0085] 把(6)中的控制律带入到(5)中，我们可以得到：

[0086]

[0087] 对公式(7)进行微分可以得到：

[0088]

[0089] 根据公式(8)可以设计鲁棒控制律un为：

[0090]

[0091] 其中sign(r)定义为：

[0092]

[0093] 由于信号r未知，为了计算公式(9)中的sgn(r)，定义函数g(t)为：

[0094]

[0095] 由于r(t)＝limτ→0(g(t)-g(t-τ))/τ，τ可以选取为采样时间，根据(11)可以看出我们只需要知道r的符号sgn(r)即可，因此我们只需要知道g(t)增加还是减小就可以获得sgn(r)，其中sgn(r)＝sgn(g(t)-g(t-τ))，这样看来，获得sgn(r)并不需要加速度 的信息，从而比获得r容易多了。

[0096] 步骤三、调节参数τ(τ＞0)、k1(k1＞0)、k2(k2＞0)以及kr(kr＞0)，从而来确保整个系统稳定，并使电液位置伺服系统的位置输出y(t)准确地跟踪期望的位置指令yd。

[0097] 本公开中，选用Lyapunov方程来分析基于控制器(6)作用下的电机位置伺服系统的稳定性：

[0098] 理论1：选取足够大的反馈增益k1、k2、kr，使得以下定义的矩阵Λ正定，那么提出的控制律(6)能够确保整个闭环电机伺服的所有信号有界，并且能获得全局渐近跟踪性能，即当t→∞时z1→0。Λ定义为：

[0099]

[0100] 其中：

[0101]

[0102]

[0103] k3＝kr-(θ1k1+θ1k2-θ2)              (15)

[0104] 选取Lyapunov方程为：

[0105]

[0106] 对公式(16)关于时间进行求导可得：

[0107]

[0108] 把公式(3)和(8)代入公式(17)，可得：

[0109]

[0110] 对(18)进一步转换可得：

[0111]

[0112] 由 可进一步整理(19)得：

[0113]

[0114] 根据公式(12)中定义的Λ为正定矩阵，对公式(20)进一步转换可得：

[0115]

[0116] 公式(21)中z定义为z＝[z1,z2,r]T；λmin(Λ)为矩阵Λ的最小特征值。

[0117] 根据公式(21)可以得到V∈L∞以及W∈L2，同时信号z有界。因此，可以得出x以及控制输入u有界。基于z1、z2以及r的动态方程，可以得到W的时间导数有界，因此W一致连续。从而，根据Barbalat引理可以得到当t→∞时W→0，理论1即得到证明。

[0118] 下面结合一个具体实例对本公开的前述实施方式的效果进行说明。

[0119] 电机伺服系统参数为：惯性负载参数J＝0.5kg·m2；力矩放大系数Kf＝4N·m/V；粘性摩擦系数B＝1.6N·m·s/rad；时变外干扰d(t)＝sin(t)N·m，选取δ＝1；系统期望跟踪的位置指令为曲线x1d(t)＝sin(πt)[1-exp(-t3)]rad。

[0120] 本发明所设计的控制器的参数选取为:τ＝0.2ms、k1＝300、k2＝60以及kr＝20；PID控制器参数选取为：P增益kP＝1000,I增益kI＝600,D增益kD＝2。

[0121] 控制器作用效果：图3是本发明所设计的控制器(图中以RISEE标识)和传统PID控制器(图中以PID标识)分别作用下系统的跟踪误差随时间变化的曲线示意图，从图中可以看出，本发明所设计的控制器作用下系统的跟踪误差明显小于PID控制器作用下系统的跟踪误差并且稳态跟踪误差趋近于0，从而使其跟踪性能获得很大的提高。

[0122] 图4是电机位置伺服系统的控制输入u随时间变化的曲线示意图，从图中可以看出，本发明所得到的控制输入信号连续而且有规律，有利于在工程实际中应用[0123] 虽然本发明已以较佳实施例揭露如上，然其并非用以限定本发明。本发明所属技术领域中具有通常知识者，在不脱离本发明的精神和范围内，当可作各种的更动与润饰。因此，本发明的保护范围当视权利要求书所界定者为准。