一种基于扩张状态观测器的机械臂伺服系统全阶滑模控制方法
【技术领域】
[0001] 本发明涉及一种基于扩张状态观测器的机械臂伺服系统全阶滑模控制方法，特别 是对于系统状态和不确定项均未知的机械臂伺服系统的全阶滑模控制控制方法。
【背景技术】
[0002] 机械臂伺服系统在机器人及航天等高技术领域已获得广泛应用，运动精度作为机 械臂伺服系统完成指定操作任务的重要性能指标，已成为个国内外学者研究的热点。针对 如何有效提高系统的运动精度，国内外已提出多种控制方法，包括PID控制，自适应控制， 滑模控制及鲁棒控制等。其中由于滑模控制具有算法简单，对外界扰动及参数摄动不敏感 及响应速度快等优点，在机械臂伺服系统控制中应用已越来越广泛。
[0003] 在传统的滑模控制中，由于控制器增益过高或者控制器的不连续开关特性，容易 引起系统的抖振问题。系统抖振不但影响系统的定位精度和跟踪性能，甚至会对系统本身 造成损害。因此，如何消除系统的抖振，是滑模控制在机械臂伺服控制中亟待解决的问题。 目前已有部分改进的滑模控制方法能在一定程度上减弱抖振带来的影响，例如用饱和函数 近似替代符号函数设计滑模控制器或将滑模与自适应控制相结合，实时更新滑模切换增益 等。
[0004] 为了有效消除机械臂伺服系统中滑模控制的抖振问题，本发明设计了一种基于扩 张状态观测器的全阶滑模控制方法，采用扩张状态观测器来估计伺服系统中所包含的未知 状态和不确定项，并基于估计值设计了全阶滑模控制器，实现机械臂伺服系统的精确定位 和跟踪。
【发明内容】
[0005] 为了解决带有未知状态及不确定项的机械臂伺服系统中的滑模抖振问题，并有效 提高伺服系统的鲁棒性，本发明设计了一种基于扩张状态观测器的全阶滑模控制方法，该 方法采用扩张状态观测器来估计系统的未知状态及不确定项，并通过观测值设计全阶滑模 控制器，在该控制器中通过引入一阶滤波器，使控制信号连续，从而有效消除滑模抖振问 题，使机械臂伺服系统能够对期望位置实现快速定位跟踪。
[0006] 为了解决上述技术问题提出的技术方案如下：
[0007] -种基于扩张状态观测器的机械臂伺服系统全阶滑模控制方法，包括以下步骤：
[0008] 步骤1，建立机械臂伺服系统模型，初始化系统状态及控制参数；
[0009] 1. 1，机械臂伺服系统模型表示成如下形式
[0011] 其中Q1, %是连杆和电机的转角；I是连杆的惯性环节；J是电机的转动惯量；K是 弹簧的刚度；u是输入转矩；M和L分别表示连杆的质量和长度；y = (^是系统的输出；
[0012] 1.2,定义状态变量A =免，％ =4 =名，·％ =&，％ =#2 =鳥，则伺服系统方程 写成如下状态空间形式
[0014]其中，f(x) = [x2 -(MglVl)Sin(X1)-KZl(X1-X3) x4 (K/J) (x「x3)]T，g(x) = [0 0 0 1/J]T;经坐标变换后式（2)可转化为
系统的输出；
[0017] 1. 3,令&(f) = a⑶+ (/h&Q)?，其中b。为b的估计值，定义扩展状态J5 =况?)，则式 (3)写成以下等效形式
[0020] 步骤2,扩张状态观测器设计；
[0021] 令Zl，i = 1，2, 3, 4, 5,为系统（4)中状态变量萬的观测值，并定义观测误差为 巧=? -^，则扩张状态观测器的表达式设计为
[0023] 其中，β β 2, β 3, β 4, β 5> 0为观测器增益· fal ( ·)为如下形式的幂次函数：
[0025] 其中，δ > 〇,〇 < α ' 1，为小的正常数；sgn( ·)为符号函数；假设观测误差满 足条件Ix1-Z1I彡I1，其中I 1X)为很小的正数；
[0026] 步骤3,无抖振全阶滑模控制器设计，过程如下：
[0027] 3. 1，定义跟踪误差e及其各阶导数为
[0029] 其中yd为参考轨迹；
[0030] 3. 2,设计如下全阶滑模面
[0032] 其中，λ 〇, i = 1,2, 3, 4为控制参数，且选择时要保证p 是赫尔维兹多项式；
[0033] 3. 3,根据式（8)，设计全阶滑模控制器为
[0037] V = -ksgn(s) (12)其中，T 彡 0, k = kp+kT+η，η > 0, kp> 0, k 〇 为控制 器参数；
[0038] 3. 4,设计李雅普诺夫函数：
[0040] 对V求导并将式（8)-(12)代入，如果判定系统是稳定的。
[0041] 本发明基于扩张状态观测器，设计了一种机械臂伺服系统的全阶滑模控制方法， 有效消除了传统滑模控制中的抖振问题，并提高系统的鲁棒性，实现伺服系统地精确跟踪 控制。
[0042] 本发明的技术构思为：针对传统滑模在机械臂伺服控制中存在的抖振问题，且机 械臂伺服系统中往往存在在未知状态和非线性不确定项，本发明采用扩张状态观测器来估 计系统的未知状态和不确定项，并根据观测到的状态值设计了一种全阶滑模控制器，在该 控制器中采用了一阶滤波器，使得在实际控制信号中并不包含传统滑模的切换项，与传统 的降阶滑模控制信号相比，控制信号是连续的，从而有效消除了传统滑模的抖振问题。本发 明提供了一种能够有效改善滑模抖振问题，并在一定程度上提高系统鲁棒性的基于扩张状 态观测器的全阶滑模控制方法，确保机械臂伺服系统能够实现精确的跟踪控制。
[0043] 本发明的优点为：实现机械臂伺服系统的精确跟踪控制，有效消除传统滑模控制 中的抖振问题，提高系统的鲁棒性。
【附图说明】
[0044] 图1为本发明的控制流程图；
[0045] 图2为参考轨迹为Θ = 〇. Isin (Ji t)时本发明的位置跟踪轨迹示意图；
[0046] 图3为参考轨迹为Θ = 〇. Isin (Ji t)时本发明的位置跟踪误差示意图；
[0047] 图4为参考轨迹为Θ = 〇. Isin (Ji t)时本发明控制信号示意图；
[0048] 图5为参考轨迹为Θ =〇. Isin(Jit)时本发明的观测器误差示意图，其中（a)是 观测器1的误差示意图；(b)是观测器2的误差示意图；（C)是观测器3的误差示意图；（d) 是观测器4的误差示意图；（e)是观测器5的误差示意图；
[0049] 图6为参考轨迹为H4sin(2 )+ :时本发明的位置跟踪轨迹示意图；
[0050] 图7为参考轨迹为〇 = 〇.4sin(2 )+ 0.20)4 :时本发明的位置跟踪误差示意图；
[0051] 图8为参考轨迹为Θ = 〇. 4sin(2t)+0. 2cos(t)时本发明控制信号的示意图；
[0052] 图9为参考轨迹为Θ = 〇. 4sin(2t)+0. 2cos(t)时本发明的观测器误差示意图， 其中（a)是观测器1的误差示意图；(b)是观测器2的误差示意图；（c)是观测器3的误差 示意图；（d)是观测器4的误差示意图；（e)是观测器5的误差示意图；
【具体实施方式】
[0053] 下面结合附图对本发明做进一步说明。
[0054] 参照图1-图9, 一种基于扩张状态观测器的机械臂伺服系统全阶滑模控制方法， 包括以下步骤：
[0055] 步骤1，建立机械臂伺服系统模型，初始化系统状态及控制参数；
[0056] 1. 1，机械臂伺服系统模型表示成如下形式
[0058] 其中qi，％是连杆和电机的转角；I是连杆的惯性环节；J是电机的转动惯量；K是 弹簧的刚度；u是输入转矩；M和L分别表示连杆的质量和