带有不确定动力学的吊车有限时间轨迹跟踪控制器及方法

摘要

本发明公开了一种带有不确定动力学的吊车有限时间轨迹跟踪控制器及方法，包括：设计两个终端滑模观测器，其中一个观测器用来估计负载摆角，另一个观测器用来估计不确定动力学。然后，通过这些估计的信息，提出有限时间轨迹跟踪控制方法。利用Lyapunov方法以及LaSalle不变性原理证明了闭环系统的稳定性与收敛性。仿真结果表明所提控制方法的正确性与有效性。

权利要求

1.一种带有不确定动力学的吊车有限时间轨迹跟踪控制器，其特征是，包括：设计第一终端滑模观测器对负载摆角θ进行估计；设计第二终端滑模观测器对不确定动力学h进行估计；根据所得到的估计值设计无负载摆角反馈的有限时间轨迹跟踪控制器如下：其中，F为施加于台车上的合力，k04∈R+为正的控制增益； 为台车速度的估计误差，为吊车位移的一阶导数，为吊车位移一阶导数的估计值，为吊车位移二阶导数的估计值；p3,q3∈R+为正的奇数，且有p3＜q3；e3＝xd-x为台车的跟踪误差，xd为台车的目标轨迹；

M为台车质量，mp为负载质量； 为γ2的估计值，γ2＝h；frx为摩擦力，l为吊绳长度；为负载摆角的估计值，为负载摆角一阶导数的估计值，为负载摆角二阶导数的估计值。

2.如权利要求1所述的一种带有不确定动力学的吊车有限时间轨迹跟踪控制器，其特征是，所述第一终端滑模观测器具体为：其中，定义辅助函数 为p的估计值，pe为观测误差，

k01∈R+为正的观测增益，p1,q1∈R+为正奇数，且有p1＜q1；pe为观测误差，b1为正常数。

3.如权利要求1所述的一种带有不确定动力学的吊车有限时间轨迹跟踪控制器，其特征是，所述第二终端滑模观测器具体为：其中，定义变量： γ2＝h；

引入状态：

关于时间求导：

则： u为不确定动态h关于时间的导数；

以及 分别为γ1和γ2的估计，k02∈R+为正的观测增益，γv＝l1sgn(e1),l1,l2,l3,l4,l5∈R+为正的观测增益，q2和p2为正的奇数，且q2＞p2；

其中，k01∈R+为正的观测增益，p1,q1∈R+为正奇数，且有p1＜q1，pe(0)为辅助函数p在负载摆角为零时的观测误差。

4.一种带有不确定动力学的吊车有限时间轨迹跟踪控制方法，其特征是，包括：(1)假设第一不确定动力学f关于时间的导数是有界，第二不确定动力学h关于时间的导数有界，负载摆角θ以及 的初始估计与实际值相同；

(2)定义关于负载摆角θ的辅助函数p以及 求解辅助函数p的观测误差pe，根据观测误差pe设计第一终端滑模观测器，对负载摆角θ进行估计；使得 在有限时间To内准确收敛至p，且 在有限时间To内准确收敛至负载摆角θ；其中 为辅助函数p的估计值，为负载摆角θ的估计值；

(3)定义关于第二不确定动力学h的辅助函数Q以及 设计第二终端滑模观测器，在有限的时间内精确的估计出不确定动力学h；

(4)根据得到的负载摆角θ以及第一不确定动力学h的估计值，得到无负载摆角反馈的有限时间轨迹跟踪控制器；

(5)将实际检测的台车位移x、台车速度 输入到上述带有不确定动力学的吊车有限时间轨迹跟踪控制器中，输出施加于台车上的合力F，在系统台车、负载质量、吊绳长度、摩擦力参数不确定以及存在外部扰动的情况下均能够在有限时间内实现台车的精确定位以及吊钩摆动、负载绕吊钩摆动的有效抑制与消除。

5.如权利要求4所述的一种带有不确定动力学的吊车有限时间轨迹跟踪控制方法，其特征是，所述步骤(2)中，关于负载摆角θ的辅助函数p具体为:其中，g为重力加速度，l为吊绳长度，为负载摆角的二阶导数。

6.如权利要求5所述的一种带有不确定动力学的吊车有限时间轨迹跟踪控制方法，其特征是，所述步骤(2)中，第一终端滑模观测器具体为：其中， k01∈R+为正的观测增益，p1,q1∈R+为正奇数，且有p1＜q1；b1为正常数。

7.如权利要求4所述的一种带有不确定动力学的吊车有限时间轨迹跟踪控制方法，其特征是，所述步骤(3)中，关于不确定动力学h的辅助函数Q具体为；

对Q关于时间求导得：

其中，frx为摩擦力，l为吊绳长度；为负载摆角的估计值，为负载摆角一阶导数的估计值，为负载摆角二阶导数的估计值；F为施加于台车上的合力，M为台车质量，mp为负载质量。

8.如权利要求7所述的一种带有不确定动力学的吊车有限时间轨迹跟踪控制方法，其特征是，第二终端滑模观测器具体为：其中，定义变量： γ2＝h；

引入状态：

则： u为不确定动态h关于时间的导数；

以及 分别为γ1和γ2的估计，k02∈R+为正的观测增益，γv＝l1sgn(e1)，l1,l2,l3,l4,l5∈R+为正的观测增益，q2和p2为正的奇数，且q2＞p2。

9.如权利要求4所述的一种带有不确定动力学的吊车有限时间轨迹跟踪控制方法，其特征是，所述步骤(4)中，无负载摆角反馈的有限时间轨迹跟踪控制器具体为：其中，F为施加于台车上的合力，k04∈R+为正的控制增益； 为台车速度的估计误差，为吊车位移的一阶导数，为吊车位移一阶导数的估计值，为吊车位移二阶导数的估计值；p3,q3∈R+为正的奇数，且有p3＜q3；e3＝xd-x为台车的跟踪误差，xd为台车的目标轨迹；

M为台车质量，mp为负载质量； 为γ2的估计值，γ2＝h；frx为摩擦力，l为吊绳长度；为负载摆角的估计值，为负载摆角一阶导数的估计值，为负载摆角二阶导数的估计值。

10.如权利要求4所述的一种带有不确定动力学的吊车有限时间轨迹跟踪控制方法，其特征是，为抑制并消除负载摆角，期望的台车轨迹选择为：其中， 为目标位置；ka， 为台车最大允许加速度以及速度； 表示调节初始加速度的参数；κ＞1.0754为正的控制增益。

说明书

带有不确定动力学的吊车有限时间轨迹跟踪控制器及方法

技术领域

[0001] 本发明涉及欠驱动桥式吊车系统的控制技术领域，尤其涉及一种带有不确定动力学以及无负载摆角反馈的桥式吊车有限时间轨迹跟踪控制器及设计方法。

背景技术

[0002] 吊车，又称起重机，是一种大型的工程搬运设备，被广泛地应用于建筑工地、海港、码头等诸多领域。根据结构的差异，吊车可大致地分为桥式吊车、塔式吊车、回转悬臂式吊车。尽管吊车种类繁多，但它们都有一个本质特性：欠驱动特性。欠驱动系统节省了部分执行器，因此具有硬件成本低、机电结构简单、重量轻、能耗小等优点。考虑到欠驱动系统的诸多优势，其控制方法的研究已经成为近年来的一大热点。在各类吊车中，桥式吊车最具代表性，应用也最为广泛。众多学者针对欠驱动桥式吊车系统提出了一系列有意义的控制方法。

[0003] 直到现在，欠驱动桥式吊车系统的控制问题仍然是一个开放的课题。一方面，由于台车质量、负载质量、吊绳长度、摩擦力、外部扰动的不确定性使得桥式吊车系统的动力学具有不确定项。并且，这些不确定项很难提前预测，导致已有大多数控制方法的控制性能大打折扣。因此，吊车控制方法的设计应充分考虑不确定动力学的影响。另一方面，已有大多数控制方法均需要负载摆角的反馈。然而，在很多情况下，负载摆角是无法测量的。因此，设计出不需要负载摆角反馈的高性能控制方法是吊车现场实际的需要。

[0004] 实际上，输入整形方法以及PD控制器并不需要负载摆角的反馈。输入整形方法根据吊绳长度信息，将基本命令信号与一系列被称为输入整形器的特定脉冲信号做卷积运算。该方法可保证系统无残余摆动，然而其控制性能却严重依赖于模型的精确程度，当模型参数存在不确定性时，其控制效果会急剧下降。PD控制器结构简单，易于工程实现。然而，PD控制器对参数不确定性十分敏感，限制了其实用性。

[0005] 滑模控制方法以及自适应控制方法可有效地处理系统参数存在不确定性的问题。详细地来说，传统的一阶滑模控制方法已成功应用于桥式吊车系统中，解决了定位和消摆问题，并取得很好地控制结果。不过，传统的一阶滑模控制方法是不连续的，对驱动装置带来潜在的危险并伴随着震颤现象。并且，以上控制方法仅能保证系统的渐近稳定性，这在高精度要求的运输任务中是远远不够的；另外，以上控制方法均假设其不确定动力学与系统参数为线性的关系，均需要负载摆角的反馈。

发明内容

[0006] 本发明的目的就是为了解决上述问题，提出了一种带有不确定动力学的吊车有限时间轨迹跟踪控制器及方法，该控制器及方法基于两个终端滑模观测器，其中一个观测器用来估计负载摆角，另一个观测器用来估计不确定动力学。

[0007] 为了实现上述目的，本发明采用如下技术方案：

[0008] 一种带有不确定动力学的吊车有限时间轨迹跟踪控制器，包括：

[0009] 设计第一终端滑模观测器对负载摆角θ进行估计；设计第二终端滑模观测器对不确定动力学h进行估计；根据所得到的估计值设计无负载摆角反馈的有限时间轨迹跟踪控制器如下：

[0010]

[0011]

[0012] 其中，k04∈R+为正的控制增益； 为台车速度的估计误差，为吊车位移的一阶导数，为吊车位移一阶导数的估计值，为吊车位移二阶导数的估计值；p3,q3∈R+为正的奇数，且有p3＜q3；e3＝xd-x为台车的跟踪误差，xd为台车的目标轨迹；M为台车质量，mp为负载质量； 为γ2的估计值，γ2＝h；frx为摩擦力，l为吊绳长度； 为负载摆角的估计值，为负载摆角一阶导数的估计值，为负载摆角二阶导数的估计值；

[0013] 进一步地，所述第一终端滑模观测器具体为：

[0014]

[0015] 其中，定义辅助函数 为p的估计值，pe为观测误差，

[0016] k01∈R+为正的观测增益，p1,q1∈R+为正奇数，且有p1＜q1；pe为观测误差，b1为正常数。

[0017] 进一步地，所述第二终端滑模观测器具体为：

[0018]

[0019]

[0020] 其中，定义变量： γ2＝h；

[0021] 引入状态：

[0022] 关于时间求导：

[0023] 则： u为不确定动态h关于时间的导数；

[0024] 以及 分别为γ1和γ2的估计，k02∈R+为正的观测增益，γv＝l1sgn(e1),l1,l2,l3,l4,l5∈R+为正的观测增益，q2和p2为正的奇数，且q2＞p2。

[0025] 一种带有不确定动力学的吊车有限时间轨迹跟踪控制方法，包括：

[0026] (1)假设不确定动力学f关于时间的导数是有界，不确定动力学h关于时间的导数有界，负载摆角θ以及 的初始估计与实际值相同；

[0027] (2定义关于负载摆角θ的辅助函数p以及 求解辅助函数p的观测误差pe，根据观测误差pe设计第一终端滑模观测器，对负载摆角θ进行估计；使得 在有限时间To内准确收敛至p，且 在有限时间To内准确收敛至负载摆角θ；其中 为辅助函数p的估计值，为负载摆角θ的估计值；

[0028] (3)定义关于不确定动力学h的辅助函数Q以及 设计第二终端滑模观测器，在有限的时间内精确的估计出不确定动力学h；

[0029] (4)根据得到的负载摆角θ以及不确定动力学h的估计值，得到无负载摆角反馈的有限时间轨迹跟踪控制器；

[0030] (5)将实际检测的台车位移x、台车速度 输入到上述带有不确定动力学的吊车有限时间轨迹跟踪控制器中，输出驱动台车运动的力矩F，在系统台车、负载质量、吊绳长度、摩擦力参数不确定以及存在外部扰动的情况下均能够在有限时间内实现台车的精确定位以及吊钩摆动、负载绕吊钩摆动的有效抑制与消除。

[0031] 进一步地，所述步骤(2)中，关于负载摆角θ的辅助函数p具体为:

[0032]

[0033] 其中，g为重力加速度，l为吊绳长度， 为负载摆角的二阶导数。

[0034] 进一步地，所述步骤(2)中，第一终端滑模观测器具体为：

[0035]

[0036] 其中， k01∈R+为正的观测增益，p1,q1∈R+为正奇数，且有p1＜q1；b1为正常数。

[0037] 进一步地，所述步骤(3)中，关于不确定动力学h的辅助函数Q具体为；

[0038]

[0039] 对Q关于时间求导得：

[0040] 其中，frx为摩擦力，l为吊绳长度；为负载摆角的估计值，为负载摆角一阶导数的估计值，为负载摆角二阶导数的估计值；F为施加于台车上的合力。

[0041] 进一步地，第二终端滑模观测器具体为：

[0042]

[0043]

[0044] 其中，定义变量： γ2＝h；

[0045] 引入状态：

[0046] 则： u为不确定动态h关于时间的导数；

[0047] 以及 分别为γ1和γ2的估计，k02∈R+为正的观测增益，γv＝l1sgn(e1)，+l1,l2,l3,l4,l5∈R为正的观测增益，q2和p2为正的奇数，且q2＞p2。

[0048] 进一步地，所述步骤(4)中，无负载摆角反馈的有限时间轨迹跟踪控制器具体为：

[0049]

[0050]

[0051] 其中，k04∈R+为正的控制增益； 为台车速度的估计误差，为吊车位移的一阶导数，为吊车位移一阶导数的估计值，为吊车位移二阶导数的估计值；p3,q3∈R+为正的奇数，且有p3＜q3；e3＝xd-x为台车的跟踪误差，xd为台车的目标轨迹；M为台车质量，mp为负载质量； 为γ2的估计值，γ2＝h；frx为摩擦力，l为吊绳长度；为负载摆角的估计值，为负载摆角一阶导数的估计值，为负载摆角二阶导数的估计值；

[0052] 进一步地，为抑制并消除负载摆角，期望的台车轨迹选择为：

[0053]

[0054] 其中， 为目标位置； 为台车最大允许加速度以及速度； 表示调节初始加速度的参数；κ＞1.0754为正的控制增益。

[0055] 本发明的有益效果是：

[0056] 与已有大多数控制方法相比，本发明所提控制器不需要负载摆角的反馈，并解决系统存在的不确定动力学的问题。本发明所提控制方法针对不确定系统参数以及外部扰动具有很强的鲁棒性；不需要负载摆角的反馈，更具实际运行价值。本发明所设计控制器可实现有限时间的收敛性。利用Lyapunov方法以及LaSalle不变性原理证明了闭环系统的稳定性与收敛性。仿真结果表明所提控制方法的正确性与有效性。

附图说明

[0057] 图1为桥式吊车系统示意图；

[0058] 图2为利用本发明方法在精确模型参数下得到的控制输入、负载摆角和台车轨迹仿真结果图；

[0059] 图3为利用LQR控制器在精确模型参数下得到的控制输入、负载摆角和台车轨迹仿真结果图；

[0060] 图4为利用增强耦合非线性控制器在精确模型参数下得到的控制输入、负载摆角和台车轨迹仿真结果图；

[0061] 图5为利用PD控制器在精确模型参数下得到的控制输入、负载摆角和台车轨迹仿真结果图；

[0062] 图6为利用本发明方法在不确定动力学作用下得到的控制输入、负载摆角和台车轨迹仿真结果图；

[0063] 图7为基于运动规划的自适应控制方法在不确定动力学作用下得到的控制输入、负载摆角和台车轨迹仿真结果图。具体实施方式：

[0064] 下面结合附图与实例对本发明做进一步说明：

[0065] 本发明提出了一种带有不确定动力学以及无负载摆角反馈的桥式吊车有限时间轨迹跟踪控制器及设计方法。具体来说，基于两个终端滑模观测器，其中一个观测器用来估计负载摆角，另一个观测器用来估计不确定动力学。然后，通过这些估计的信息，提出有限时间轨迹跟踪控制方法。利用Lyapunov方法以及LaSalle不变性原理证明了闭环系统的稳定性与收敛性。仿真结果表明所提控制方法的正确性与有效性。

[0066] 1.桥式吊车动力学模型

[0067] 桥式吊车系统模型如图1所示，其动力学模型可描述为：

[0068]

[0069]

[0070] 其中，M为台车质量，mp表示负载质量，l代表吊绳长度，h和f为不确定动力学，x(t)代表吊车位移，θ(t)表示负载摆角，frx为摩擦力，F为施加于台车上的合力。

[0071] 实际上，(1)式的不确定动力学h以及(2)式的不确定动力学f是由不确定的台车质量ΔM、不确定的负载质量Δmp、不确定的吊绳长度Δl、不确定的摩擦力Δfrx、外部扰动d1以及d2引起的。此时不确定动力学h和f可写为：

[0072]

[0073]

[0074] 为不失一般性，进行如下的假设：

[0075] 假设1：不确定动力学f关于时间的导数是有界的，其界限为lb1，即：

[0076]

[0077] 其中，b1∈R+为已知的正常数。

[0078] 假设2：为促进接下来分析，假设θ以及 的初始估计与实际值相同，即：

[0079] 假设3：不确定动力学h关于时间的导数表示为u。虽然u未知，但其幅值为有界的，即||u||≤π，其中，π∈R+为已知的正常数。

[0080] 2.无负载摆角反馈的有限时间轨迹跟踪控制器设计

[0081] 2.1负载摆角估计

[0082] 为估计不方便测量的负载摆角，设计了一个终端滑模观测器。

[0083] 针对吊车系统，sinθ≈θ,cosθ≈1是成立的。因此，(2)式可写为：

[0084]

[0085] 定义辅助函数p以及 分别为 其中， 为p的估计值，为θ的估计值。p的观测误差为：

[0086]

[0087] 其中，pe为观测误差。

[0088] 为估计p，针对带有不确定动力学f的系统(6)，设计如下形式的终端滑模观测器：

[0089]

[0090] 其中，k01∈R+为正的观测增益，p1,q1∈R+为正奇数，且有p1＜q1，b1∈R+为已知的正常数。

[0091] 定理1：针对含有不确定动力学f的动力学方程(6)，滑模观测器(8)可保证 在有限时间To内准确收敛至p，且 在有限时间To内准确收敛至θ，其中：

[0092]

[0093] 那么，当t≥To时，pe≡0，

[0094] 证明：选取候选Lyapunov函数为：

[0095]

[0096] 对(10)式关于时间求导并将(7)、(8)式代入可得：

[0097]

[0098] 将(5)式代入(11)式可得：

[0099]

[0100] p1、q1为正的奇数，那么p1+q1为偶数，则 与此同时，求解(12)式可得：

[0101]

[0102] 由(13)式可知，当t≥T0时，VO1(t)≡0，其中：

[0103]

[0104] 由VO1(t)≡0可得：

[0105]

[0106] 由(15)式以及p、的定义可得：

[0107]

[0108] 定义 结合假设2，(16)式可写为：

[0109]

[0110] 求解(17)式可得：

[0111] α＝0  (18)

[0112] 由(18)式得：

[0113]

[0114] 由(15)、(19)式可知，定理1得证。

[0115] 2.2不确定动力学h的估计

[0116] 为保证控制器的高性能，应估计出吊车系统中未确定动态h，并进行有效地补偿。为此，设计一个滑模观测器来估计不确定动力学h。

[0117] 定义一个辅助函数： 对Q关于时间求导可得：

[0118]

[0119] 由(19)式可知，当t≥T0时，引入一个辅助函数E，其表达式为： 此时，(20)式可写为：

[0120]

[0121] 为促进接下来滑模观测器的设计，引入一个新的状态 其表达式为：

[0122]

[0123] 其中，k02∈R+为正的观测增益。

[0124] 对(22)式关于时间求导可得：

[0125]

[0126] 那么，对不确定动态h的估计问题就转换成了对线性增广系统(23)的状态估计。其中(23)式中 可测量/可求出。假设不确定动态h关于时间的导数为u，并引入两个新的变量γ1、γ2，其表达式为： γ2＝h。此时，(23)可写为：

[0127]

[0128]

[0129] 为估计不确定动态h(γ2)，定义如下形式的终端滑模观测器：

[0130]

[0131]

[0132] 其中，以及 分别为γ1和γ2的估计，γv＝l1sgn(e1),l1,l2,l3,l4,l5∈R+为正的观测增益， q2和p2为正的奇数，且有q2＞p2。

[0133] 定义观测误差e为：e＝[e1 e2]T。那么，由(24)-(27)式可得观测误差e的动力学方程为：

[0134]

[0135]

[0136] 引理1：在终端滑模观测器(26)和(27)的作用下，当t≥T0时，观测误差系统(28)和(29)中的观测误差e是一致最终有界的。在此过程中，假设γ1、γ2在t＝T0时的估计值与实际值相等，即：

[0137] 证明：考虑如下形式的Lyapunov函数：

[0138]

[0139] 对(30)式关于时间求导，并将(28)、(29)式代入可得：

[0140]

[0141] 其中：

[0142]

[0143] 由于k02,l2,l3为正数，那么β为正定的。因此，β的最小特征值λmin为正的。

[0144] 紧接着，(31)式可写为：

[0145]

[0146] 当||e||≠0时，为保证 以下条件应满足：

[0147]

[0148] 换句话说，当e不在集合 内时， 为负。此时，VO2单调递减。明显地，VO2的递减最终将驱动e进入集合D内，然后将限制在集合D内。由于
即||e(T0)||＝0，由Lyapunov定理以及LaSalle不变性原理可知，当t≥T0
时，观测误差均限制在集合D内。这表明e是一致最终有界的。

[0149] 定理2：考虑由线性系统(19)、(20)以及终端滑模观测器(21)、(22)得到的误差观测系统(23)、(24)，选择观测增益l1,l2,l3,l4,l5使得：

[0150]

[0151] l5-π＞0  (35)

[0152] 在有限的时间内可精确的估计出不确定动力学h。

[0153] 证明：此过程包括如下两方面的证明。

[0154] 1)e1的有限时间收敛性

[0155] 考虑如下形式的Lyapunov函数：

[0156]

[0157] 对(36)式关于时间求导，并将(28)式代入可得：

[0158]

[0159] 针对||e1||≠0，为保证 选择：

[0160]

[0161] 为保证(38)式成立，选择：

[0162]

[0163] 求解(39)式可得：

[0164]

[0165] 那么，

[0166]

[0167] 成立。

[0168] 对(41)式关于时间积分，可得：

[0169]

[0170] 由(42)式可知，当t＝T1时：

[0171]

[0172] 由(28)式可得：

[0173] 2)e2的有限时间收敛性：当t≥T1时， 且有：

[0174]

[0175] 为完成定理2的证明，考虑如下形式的正定标量函数：

[0176]

[0177] 对(45)式关于时间求导，并将(35)、(44)式代入可得:

[0178]

[0179] 求解(46)式可得:

[0180]

[0181] 由(47)式可得，当t＝T2时：

[0182] ||e2||＝0。换句话说，不确定动态可在有限时间T2内，由 精确估计出不确定动力学h。

[0183] 2.3无负载反馈的有限时间轨迹跟踪控制器

[0184] 为完成轨迹跟踪控制器的设计，定义如下形式的台车位移估计表达式：

[0185]

[0186] 其中，k03,δ0∈R+为正的增益，p3,q3∈R+为正的奇数，且有p3＜q3，e3＝xd-x为台车的跟踪误差，xd为台车的目标轨迹，

[0187] 因此，无负载摆角反馈的有限时间轨迹跟踪控制器设计为：

[0188]

[0189] 其中， 为台车速度的估计误差，k04∈R+为正的控制增益。

[0190] 定理3：所提跟踪控制器(50)以及终端滑模观测器(8)、(26)、(27)可保证台车轨迹在有限时间内收敛至期望轨迹。

[0191] 证明：由e3，e4的定义可得：

[0192]

[0193] 由(49)、(51)式可知：

[0194]

[0195] 另一方面，由(1)式可得:

[0196]

[0197] 为证明定理3，选择如下的Lyapunov候选函数：

[0198]

[0199] 对(54)式关于时间求导，并将(50)、(51)、(53)式代入可得:

[0200]

[0201] 由定理1可知，当t≥T0时， 由定理2可知，当t≥T2时， 其中：T2≥T0。那么，(55)式可写为:

[0202]

[0203] 经过有限时间T2后，(49)式可简化为:

[0204]

[0205] 其中:

[0206]

[0207] 求解(50)式可得:

[0208]

[0209] 因此，有(58)式可知，当t≥T3时，e3≡0，e4≡0，其中:

[0210]

[0211] 这表明，台车的跟踪误差e3在有限的时间T3内收敛至0。

[0212] 备注1：为抑制并消除负载摆角，期望的台车轨迹xd选择为

[0213]

[0214] 其中， 为目标位置； 为台车最大允许加速度以及速度； 表示调节初始加速度的参数；κ＞1.0754为正的控制增益。

[0215] 台车期望的目标轨迹(由(60)式表示)由两部分组成：

[0216] (i)定位参考轨迹xd1：驱动台车至目标位置；

[0217] (ii)消摆部分xd2：快速消除负载摆动并不影响台车的定位性能。

[0218] 3.数值仿真

[0219] 为验证所提控制方法的正确性与有效性，进行如下两组仿真实验。详细地来说，在第一组仿真实验中，通过对比LQR控制器，增强耦合非线性控制器，PD控制器，验证所提控制方法控制性能的优异性。在第一组组实验中，由于LQR控制器，增强耦合非线性控制器，PD控制器均是基于精确动力学的情况下提出的，所以h和f设为0。第二组仿真实验将验证所提控制方法针对不确定动力学的鲁棒性，并与基于运动规划的自适应跟踪控制器进行对比。

[0220] LQR控制器、增强耦合非线性控制器、PD控制器以及基于运动规划的自适应跟踪控制器的表达式如下：

[0221] 1)LQR控制器

[0222]

[0223] 其中， 为控制增益。

[0224] 2)增强耦合非线性控制器

[0225]

[0226] 其中， 为正的控制增益，ξx为如下的辅助函数：

[0227]

[0228] 3)PD控制器

[0229]

[0230] 其中，kp,kd∈R+为正的控制增益。

[0231] 4)基于运动规划的自适应跟踪控制器

[0232]

[0233] 其中， 为正的控制增益，r＝x-xd1为台车跟踪误差， 为参数向量的在线估计，由以下更新率产生：

[0234]

[0235] 其中，Γ为正定对称对角更新增益矩阵。

[0236] 仿真1：精确模型参数下控制性能的验证：在本组实验中，吊车系统参数的实际值与名义值是相同的，设为：

[0237] M＝7kg,mp＝1kg,l＝0.6m,h＝f＝0

[0238] 摩擦力具有如下形式：

[0239]

[0240] 台车目标位置为：

[0241] pd＝1m

[0242] 期望的台车轨迹(60)的各个参数设为：

[0243] ka＝0.5,kv＝0.5,ε＝2,κ＝4

[0244] 本发明所设计控制器、LQR控制器、增强耦合非线性控制器、PD控制器的控制增益见表1。

[0245] 表1.仿真1控制增益

[0246]

[0247] 本发明所设计控制器、LQR控制器、增强耦合非线性控制器以及PD控制器的仿真结果如图2-5所示。通过对比图2与图3-5可知，在相似的运输时间下(5s内)，所提控制方法的最大负载摆角以及驱动力是这四种控制方法中最小的。这些结果表明了所提控制方法控制性能的优异性。

[0248] 仿真2：不确定动力学作用下控制性能的验证：在本组实验中，吊车系统参数的名义值设置为：

[0249] M＝12kg,mp＝9kg,l＝0.7m

[0250] 台车质量、负载质量以及吊绳长度的实际值分别为：14kg、10kg、1.0m。那么，下式可得：

[0251] ΔM＝2kg,Δmp＝1kg,Δl＝0.3m

[0252] 摩擦力的名义值和仿真1的相同，其实际值为：

[0253]

[0254] 为模拟外部扰动，将正弦扰动d1以及随机扰动d2施加于吊车系统中，其幅值均为10。

[0255] 台车的目标位置设置为：

[0256] pd＝1m

[0257] 期望目标轨迹(60)的参数和仿真1中的相同。

[0258] 本发明所设计控制器以及基于运动规划的自适应控制器的控制增益见表2。

[0259] 表2仿真2控制增益

[0260]

[0261] 图6-7所示为所提控制方法与基于运动规划的自适应控制方法在存在不确定动力学的仿真结果。由图6-7可知，不确定动力学对所提控制方法的跟踪控制性能影响不大。然而，当存在不确定动力学时，基于运动规划的自适应控制方法的控制性能大打折扣。由图6可知，估计的负载摆角的曲线几乎与负载摆角的实际曲线相同，这表明针对负载摆角设计的终端滑模观测器的正确性。这些优点为本发明所提控制方法的实际应用带来了便利。

[0262] 上述虽然结合附图对本发明的具体实施方式进行了描述，但并非对本发明保护范围的限制，所属领域技术人员应该明白，在本发明的技术方案的基础上，本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围以内。