一种基于RHC的有杆拖挂式无人系统在线轨迹跟踪控制方法

技术领域

本发明属于有杆拖挂式无人系统的自动化与控制技术领域，涉及一种基于滚动时域控制(RHC：Receding Horizon Control)的有杆拖挂式无人系统在线轨迹跟踪控制方法。

背景技术

有杆拖挂式无人系统的轨迹跟踪控制问题是通过设计合理的跟踪方法，并结合其运动学/动力学及相关约束关系，对标准轨迹或者理想轨迹进行跟踪，从而得出实际轨迹和控制律的过程。

有杆拖挂式无人系统为一种牵引-拖挂车系统(Tractor-Trailer System)，该类系统被广泛应用于航空、农业、运输等各个领域。目前，基于线性化模型的线性控制技术已广泛应用于牵引-拖挂车系统控制，但如果转向角大于10度，线性化模型的精度就会降低。为了提高精度，目前提出基于非线性控制理论来设计跟踪方法，如横向函数法、虚拟转向法、非线性模型预测控制和李雅普诺夫方法等。

然而，有杆拖挂式无人系统的轨迹跟踪控制问题中仍存在以下难点和重点：(1)系统的非线性和耦合特性；(2)输入和输出的物理约束；(3)环境不确定性的影响。此外，现有的大部分跟踪控制算法难以处理环境中的实时、动态扰动，且均只能解决系统的倒车或者正向行驶问题，而对于既涉及倒车又涉及正向行驶的参考轨迹，其跟踪问题没有得到很好的解决。这主要是因为有杆拖挂式无人系统的运动学或者动力学模型较为复杂，对于正向运动与倒车之间切换的过程很容易发散，而现有方法难以有效解决这一过程的轨迹跟踪控制问题。

综上所述，目前，工程应用上迫切需要一种能兼顾计算精度和效率的、具有良好适用性的有杆拖挂式无人系统轨迹跟踪控制算法。

发明内容

为了解决上述技术问题，本发明提出了一种用于有杆拖挂式无人系统轨迹跟踪控制问题，能在线处理实时动态扰动，且可兼顾效率、精度及工程许用性的方法。

为了达到上述目的，本发明采用的技术方案为：

一种基于RHC的有杆拖挂式无人系统在线轨迹跟踪控制方法，包括以下步骤：

步骤1：建立有杆拖挂式无人系统的运动学模型

将挂车和拖车的速度分别定义为v

为提高基于最优控制的轨迹规划方法的计算效率，且选择的状态变量应便于施加边界条件和其他机械约束，建立如下所示的有杆拖挂式无人系统的运动学模型：

步骤2：建立有杆拖挂式无人系统跟踪控制问题中的不等式约束

步骤2-1：建立避碰不等式约束

通常标准轨迹为无碰撞的可行轨迹，但由于外界扰动等因素的原因，实际轨迹与标准轨迹不可能完全重合，若实际轨迹与标准轨迹偏差过大，可能会导致实际轨迹与障碍物发生碰撞的现象。为避免这个问题的发生，将实际轨迹与标准轨迹的偏差约束在一个可行的范围之内，具体为：

(x

其中，x

步骤2-2：建立状态不等式约束

系统速度v

步骤2-3：建立控制不等式约束

通过限制控制变量，使其符合系统的机械限制，控制约束可以表示为：

步骤3：建立有杆拖挂式无人系统的跟踪控制模型

为实现离轴有杆牵引系统的自主运动控制，系统应尽量沿理想轨迹运动。在满足运动约束、避碰约束、控制约束和状态约束的同时，必须使跟踪误差尽可能小，且要保证控制的稳定性。因此，可建立如下所示的有杆拖挂式无人系统跟踪控制模型：

其中，

步骤4：基于RHC的有杆拖挂式无人系统跟踪控制模型在线求解

步骤4-1：初始化时间窗口长度T、窗口滚动频率δT(δT≤T)，滚动计数参数k＝1，初始化第一个时间窗口边界条件

步骤4-2：将第k个时间窗口内(t∈[t

其中，

步骤4-3：利用最优控制方法求解公式(6)，得到第k个时间窗口内的最优控制变量

步骤4-4：滚动时间窗口，确定时间窗口初始时间及窗口左侧边界条件。若

其中，dw

同时，令k＝k+1，

若

相对于现有技术，本发明有益效果为：

本发明能以更高的精度、效率和稳定性，在线处理环境中的实时、动态扰动，能够有效解决有杆拖挂式无人系统的倒车或正向行驶过程中的跟踪控制问题，还可应用于带状态-控制约束的跟踪控制问题。所得结论可直接应用于工程实际，具有更好的工程许用性，且具有很强的可操作性和可行性，便于实际应用。

附图说明

图1为本发明的整体思路图。

图2为本发明的有杆拖挂式无人系统的实际轨迹与标准轨迹图。

图3为本发明的有杆拖挂式无人系统的跟踪误差图；图3(a)为挂车后轮中心位置横坐标跟踪误差随时间的变化图，图3(b)为挂车后轮中心位置纵坐标跟踪误差随时间的变化图，图3(c)为挂车方位角跟踪误差随时间的变化图。

图4为本发明的挂车速度、拖车速度以及拖车转向角图；图4(a)为挂车速度随时间的变化图，图4(b)为拖车速度随时间的变化图，图4(c)为拖车转向角随时间的变化图。

图5为本发明的挂车以及牵引杆转向角变化图；图5(a)为挂车转向角随时间的变化图，图5(b)为牵引杆转向角随时间的变化图。

图6为本发明的系统控制变量变化图；图6(a)为系统控制变量u

具体实施方式

以下结合具体实施例对本发明做进一步说明。

一种基于RHC的有杆拖挂式无人系统在线轨迹跟踪控制方法，包括以下步骤：

根据步骤1，对于某一有杆拖挂式无人系统，根据其几何参数，建立有杆拖挂式无人系统的运动学模型如下：

根据步骤2-1，取D＝3、S＝1，从而建立避碰不等式约束如下：

(x

根据步骤2-2，取v

根据步骤2-3，取u

根据步骤3，建立有杆拖挂式无人系统跟踪控制模型。在本实施例中，X

s.t.

根据步骤4-1，初始化时间窗口长度T＝8s，窗口滚动频率δT＝0.1s，滚动计数参数k＝1，初始化第一个时间窗口边界条件

根据步骤4-2，将第k个时间窗口内(t∈[t

根据步骤4-3，采用最优控制方法中的保辛伪谱算法求解式(6)，得到第k个时间窗口内的最优控制变量

根据步骤4-4，滚动时间窗口，确定时间窗口初始时间及窗口左侧边界条件。若

其中，dw

同时，令k＝k+1，

若

根据步骤4，得到有杆拖挂式无人系统的实际轨迹如图2所示，从而得到有杆牵引飞机系统与虚拟飞机系统的运动轨迹误差如图3所示，挂车速度、拖车速度以及拖车转向角如图4所示，挂车以及牵引杆转向角如图5所示，系统控制变量如图6所示。由结果可知，所有约束均可得到满足，且平均计算耗时约14.6ms，可实现对该有杆拖挂式无人系统的在线轨迹规划与控制。

本发明首先基于有杆拖挂式无人系统的运动学模型，结合其状态约束、控制约束以及避碰约束，建立有杆拖挂式无人系统的跟踪控制模型；然后，结合滚动时域控制思想，将全区间内的跟踪控制问题转化为单个时间窗口内的最优控制问题，并采用最优控制方法进行高效求解。本发明不仅可解决环境中的实时、动态扰动给跟踪控制带来的影响，还能克服大多数算法难以适用于带状态-控制约束的跟踪控制问题，且有效地解决了有杆拖挂式无人系统正向运动和倒车过程中的精确轨迹跟踪与控制难题，具有较高的计算效率和鲁棒性。

以上所述实施例仅表达本发明的实施方式，但并不能因此而理解为对本发明专利的范围的限制，应当指出，对于本领域的技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进，这些均属于本发明的保护范围。