基于扰动观测器的低维优化轨迹跟踪控制系统及方法技术方案

本发明专利技术属于无人智能船舶自动控制技术领域，具体涉及一种基于扰动观测器的低维优化轨迹跟踪控制系统及方法，能够控制无人船跟踪预设轨迹航行，本发明专利技术尤其适用于外界环境干扰较强的复杂海况。所述控制系统由LMPC控制器和反馈部分构成。LMPC控制器由LMPC最优化问题和船舶运动数学模型构成；反馈部分由线性扰动观测器和低维度优化模型构成。所述方法包括以下步骤：步骤一：建立船舶运动数学模型；步骤二：建立线性扰动观测器；步骤三：建立低维度优化模型；步骤四：求解LMPC最优化问题。求解LMPC最优化问题。求解LMPC最优化问题。

【技术实现步骤摘要】
基于扰动观测器的低维优化轨迹跟踪控制系统及方法


[0001]本专利技术属于无人智能船舶自动控制
，具体涉及一种基于扰动观测器的低维优化轨迹跟踪控制系统及方法，能够控制无人船跟踪预设轨迹航行，本专利技术尤其适用于外界环境干扰较强的复杂海况。

技术介绍

[0002]随着全球智能化浪潮的到来，无人机、无人车等载运工具的发展取得长足进步，无人系统的探索研发充满活力，与此同时，无人船在海洋
中受到了极大关注。无人船具有无人化、智能化、低成本、小体积、高效率等优势，在水域智能设备中占有重要的地位。
[0003]线性模型预测控制(Liner Model Predictive Control，LMPC)是一种用于轨迹跟踪的实时控制方法，它基于被控系统数学模型制定的最佳控制策略。LMPC的特点在于，它能够根据实时更新的模型进行在线优化，以滚动方式生成最优控制指令，即具有在线滚动优化特性，进而适应动态系统和变化的约束条件。因此，LMPC在许多领域都有广泛的应用，包括工业过程控制、能源管理、交通控制、飞行器控制、无人船控制等。
[0004]传统的基于LMPC的无人船轨迹跟踪控制方法由LPMC最优化问题和船舶运动数学模型构成，二者的连接构成一个闭环，将参考轨迹与船舶运动数学模型输出状态信息的差(计算航迹偏差)作为LPMC最优化问题的输入，LPMC最优化问题的输出与船舶运动数学模型直接相连作为船舶运动数学模型的输入。在无人船轨迹跟踪控制中，LMPC根据船舶运动数学模型预测未来一段时间系统的行为，用于制定下一时刻的最优控制策略。当系统受到环境干扰时，LMPC通过优化控制策略来减小干扰对系统性能的影响，但是由于船舶运动数学模型无法描述系统所受到的干扰，因此传统的基于LMPC的无人船轨迹跟踪控制方法无法有针对性地对干扰做出反应，只能处理幅度较小、程度较轻的干扰问题。但对于海上风浪较大，海况较复杂的情况，环境干扰的幅度较大、程度严重，上述方法无法实现有效的轨迹跟踪控制。
[0005]线性扰动观测器能够对环境干扰建立数学模型，描述干扰的动态情况，因此在无人船轨迹控制中引入线性扰动观测器能够预测环境干扰信息，再通过最优化过程对干扰进行有针对性地抑制，从而改善系统的抗干扰能力，提高稳定性。然而，扰动观测器的引入会增大系统的信号维度，导致控制方法的计算量增加。低维度优化模型能够将高维度的干扰估计问题转化为低维度的最优化问题，从而将高维扰动量转换成低维扰动补偿控制量，进而降低计算负载，提高计算效率，缩减控制时间，提升控制实时性。
[0006]因此，本专利技术在传统的基于LMPC的无人船轨迹跟踪控制方法基础上引入线性扰动观测器和低维度优化模型，提出一种基于扰动观测器的低维优化轨迹跟踪控制系统及方法，用于控制无人船跟踪预设轨迹航行，具备较强的抗干扰能力和稳定性，尤其适用于外界环境干扰较强的复杂海况。

技术实现思路

[0007]本专利技术的目的在于提出一种基于扰动观测器的低维优化轨迹跟踪控制系统及方法，用于控制无人船跟踪预设轨迹航行，具备较强的抗干扰能力和稳定性，尤其适用于外界环境干扰较强的复杂海况。
[0008]下面结合附图对本专利技术进行说明。
[0009]本专利技术的第一方面提供一种基于扰动观测器的低维优化轨迹跟踪控制系统，其结构如图1所示，所述控制系统由LMPC控制器和反馈部分构成。LMPC控制器由LMPC最优化问题和船舶运动数学模型J构成；反馈部分由线性扰动观测器DO和低维度优化模型构成。在LMPC控制器中，参考轨迹O(t)与船舶运动数学模型J的输出状态信息相减得到计算航迹偏差；计算航迹偏差输入到LMPC最优化问题中，得到最优解u*(k|k)；最优解u*(k|k)与反馈部分中低维度优化模型输出的扰动补偿控制量Vu*相加，二者之和即为最优控制律u(k)；最优控制律u(k)输入到船舶运动数学模型J中计算得到下一时刻的输出状态信息。在反馈部分中，当前时刻的输出状态信息和最优控制律u(k)传递给线性扰动观测器DO计算得到下一时刻干扰的预测值再将干扰的预测值传给低维度优化模型求解得到扰动补偿控制量Vu*。环境干扰τ
σ
(t)直接作用于船舶运动数学模型J上，通过输出状态信息引入到反馈部分，再由反馈部分进行描述和抑制。
[0010]本专利技术的第二方面提供一种基于扰动观测器的低维优化轨迹跟踪控制方法(在下文中称为反馈LMPC)，其流程如图2所示，先建立船舶运动数学模型，再建立线性扰动观测器和低维度优化模型，在此基础上求解LMPC最优化问题得到最优控制率。具体包括以下步骤：
[0011]步骤一：建立船舶运动数学模型
[0012]无人船的船舶运动数学模型J如下：
[0013][0014]其中，t表示时间，K(t)表示无人船的位置和方向，为K(t)的导数，v(t)是无人船速度向量，为v(t)的导数，F(
·
)为针对位置和方向的惯性坐标系
‑
附体坐标系转换算子，和G(
·
)为针对速度向量的惯性坐标系
‑
附体坐标系转换算子，u(t)表示控制向量(即为无人船电机推力)，τ
σ
(t)表示外部环境干扰(实际为无人船所受的外力)，M、H为无人船的惯性矩阵和阻尼矩阵。
[0015]为便于分析，将上述模型J改写为状态空间表达式如下：
[0016][0017]其中，x(t)是状态向量(包括无人船的位置、方向和速度向量，x(t)＝[K(t)v(t)]T
)，是x(t)的导数，τ
d
(t)是线性化的环境干扰，y(t)表示系统输出，控制向量u(t)为系统输入，A、B和P分别为状态转移矩阵、输入转移矩阵和输出矩阵。
[0018]对上述状态空间表达式进行离散化处理得到离散后的船舶运动数学模型J
m
：
[0019][0020]其中，k为非负整数代表当前时刻，x(k+1)为下一时刻的状态向量，x(k)为当前时刻的状态向量，u(k)为当前时刻的控制向量，τ
d
(k)为当前时刻的环境干扰，y(k)为当前时刻的输出，A
k,t
、B
k,t
和P
k,t
分别表示上述线性离散方程的状态转移矩阵、输入转移矩阵和输出矩阵。
[0021]步骤二：建立线性扰动观测器
[0022]线性扰动观测器的一般模型为：
[0023][0024]其中A
n
、B
n
、C
n
、D
n
为系统矩阵，τ
nx
、τ
ny
分别为状态和输出的干扰。
[0025]将上述模型中的t换成k即得到离散后的线性扰动观测器一般模型，再将离散后的船舶运动数学模型J
m
中的状态转移矩阵A
k,t
、输入转移矩阵B
k,t
和当前时刻的环境干扰τ
d
(k)带入到离散后的线本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于扰动观测器的低维优化轨迹跟踪控制系统，其特征在于，由LMPC控制器和反馈部分构成；所述LMPC控制器由LMPC最优化问题和船舶运动数学模型构成；所述反馈部分由线性扰动观测器和低维度优化模型构成；在LMPC控制器中，参考轨迹与船舶运动数学模型的输出状态信息相减得到计算航迹偏差；计算航迹偏差输入到LMPC最优化问题中，得到最优解；最优解与反馈部分中低维度优化模型输出的扰动补偿控制量相加，二者之和即为最优控制律；最优控制律输入到船舶运动数学模型中计算得到下一时刻的输出状态信息；在反馈部分中，当前时刻的输出状态信息和最优控制律传递给线性扰动观测器计算得到下一时刻干扰的预测值，再将干扰的预测值传给低维度优化模型求解得到扰动补偿控制量；环境干扰直接作用于船舶运动数学模型上，通过输出状态信息引入到反馈部分，再由反馈部分进行描述和抑制。2.基于扰动观测器的低维优化轨迹跟踪控制方法，其特征在于，包括以下步骤：步骤一：建立船舶运动数学模型；步骤二：建立线性扰动观测器；步骤三：建立低维度优化模型；步骤四：求解LMPC最优化问题。3.根据权利要求2所述的基于扰动观测器的低维优化轨迹跟踪控制方法，其特征在于，所述步骤三：建立低维度优化模型由所述线性扰动观测器的干扰估计构造以Δu为变量的优化目标：再由船舶电机推力...

【专利技术属性】
技术研发人员：张育，杜育宽，郝秋实，易家傅，任佳，崔亚妮，丁洁，陈敏，姚京涛，
申请(专利权)人：海南大学，
类型：发明
国别省市：