面向无人水下航行器轨迹跟踪的直接螺旋桨转速管模型预测控制——集成非线性推进器映射

《Control Engineering Practice》:Direct propeller-speed tube model predictive control for unmanned underwater vehicle trajectory tracking with integrated nonlinear thruster mapping

【字体: 大 中 小 】 时间:2026年09月23日 来源:Control Engineering Practice 5.3

编辑推荐:

   **摘要** 传统的UUV轨迹跟踪依赖于分层运动控制、推力分配和推力到转速转换,这可能导致映射误差累积,并使执行器约束的直接施加变得复杂。本文提出了一种管式模型预测控制(Tube-MPC)方法,利用非线性转速级预测模型直接优化螺旋桨转速(PRS)。标称MPC律与基于LQR的

  

**摘要**

传统的UUV轨迹跟踪依赖于分层运动控制、推力分配和推力到转速转换,这可能导致映射误差累积,并使执行器约束的直接施加变得复杂。本文提出了一种管式模型预测控制(Tube-MPC)方法,利用非线性转速级预测模型直接优化螺旋桨转速(PRS)。标称MPC律与基于LQR的辅助控制器相结合,后者包含有界光滑非线性修正项,以抑制模型失配和干扰。由于非线性残差依赖于候选管半径,文中引入了一种单调自一致映射。在所述的区域包含条件和有限超解条件下,通过离线不动点迭代可获得一个鲁棒正不变超矩形外管。该管提供了PRS幅值和状态约束收紧,同时首次移动参数化降低了在线优化负担。在所述的终端条件、初始化条件、参考匹配条件和工作域条件下,该方法保证了标称递归可行性、鲁棒的PRS幅值和状态约束满足,以及实用跟踪性能。在UUV平台上进行的实验涵盖了圆形轨迹和伯努瓦叶形轨迹跟踪,采用相同的调参。在两种任务中,所提方法均实现了低于所测基线方法的跟踪误差。

**引言**

精确的运动控制对于无人水下航行器(UUV)的运作至关重要(Hao, Wang, Shen, Shi, 2024, Heshmati-Alamdari, Nikou, Dimarogonas, 2021, Liu, Wen, Wu, Li, Sun, 2026, Wei, Shen, Shi, 2021)。传统系统通常采用分层架构,由运动控制器生成广义力,随后进行推力分配以及推力到螺旋桨转速(PRS)的转换(Shen, Shi, 2020, Tanakitkorn, Wilson, Turnock, Phillips, 2017)。尽管该架构具有模块化特点,但在运动空间与执行空间之间引入了多个依赖模型的映射。

由载体建模、推力分配和推力到PRS转换产生的误差可能通过该级联过程累积(Johansen and Fossen, 2013)。在零推力附近,复合的广义力到PRS映射可能变得敏感。尽管几何构型矩阵由推进器布局确定,但伪逆分配后经过条件不良的局部推力反演可能将微小的力变化放大为显著的PRS波动(Zhang and Guo, 2019)。此外,单个PRS限制必须在广义力域中进行近似,且分配和反演后其满足并不能自动保证(Jimoh, Yue, Grimble, 2024, Tang, Xue, Liu, Wang, Ye, Fan, 2023)。

现有方法通过扰动观测器、广义力级的自适应或基于学习的补偿(Chen, Yang, Guo, Li, 2016, Cui, Yang, Li, Sharma, 2017),以及正则化或零空间推力分配(Fossen, Johansen, 2006, Johansen, Fossen, 2013)来缓解这些效应。然而,广义力补偿保留了后续的分配和反演阶段,而分配正则化通常在力跟踪精度与执行器负载、条件数和指令光滑度之间进行权衡。

模型预测控制(MPC)因其能够显式考虑系统动力学和运行限制同时优化预测性能,而非常适合约束轨迹跟踪问题(Salt Ducaju, Olofsson, Johansson, 2025, Wei, Shi, 2023, Yan, Gong, Zhang, Wu, 2020)。近期发展包括用于载体轨迹跟踪的LPV-MPC公式化(Kedir and Abdissa, 2024)。与纯粹的被动反馈律不同,MPC可以预见约束激活并在预测时域内协调多个执行器(Liu, Xia, Wu, Guo, Zhu, Zhang, Cui, 2023, Luo, Gao, Jiang, Luo, Zhang, Wang, 2024, Tijjani, Chemori, Creuze, 2022)。在执行器级别,直接PRS优化允许将单个转速约束直接施加于优化变量本身,避免将其近似变换为广义力约束(Lee and Kim, 2023)。

然而,直接PRS控制引入了非线性的执行器级预测模型,并增加了约束处理和在线优化的复杂性。推力映射必须嵌入UUV动力学中,且预测模型误差必须显式处理(Dai, Gao, Yu, Ju, 2022, Remmas, Meurer, Hamamatsu, Chemori, Kruusmaa, 2026, Shen, Shi, Buckham, 2018)。在推进层面,预测控制也已应用于电机转速调节,包括用于永磁同步电机的Laguerre参数化MPC(Abdissa, 2024)和用于反转推进电机的强化学习辅助MPC(Delelew et al., 2026)。这些电机侧研究与此处考虑的载体级PRS公式化是互补的。

管式MPC将控制输入分为标称和辅助两个组成部分,允许标称控制器优化性能,而辅助控制器将实际轨迹限制在鲁棒正不变管内(Langson, Chryssochoos, Rakovi?, Mayne, 2004, Mayne, Kerrigan, 2007)。经典的具有加性扰动的线性Tube-MPC公式化将扰动集独立于不变管来指定(Mayne, Kerrigan, 2007, Rakovic, Kerrigan, Kouramas, Mayne, 2005)。许多UUV Tube-MPC公式化在广义力级别采用这种结构,其中标称输入以仿射形式进入动力学(Jimoh, Yue, Grimble, 2024, Yan, Yan, Nan, Cai, Hou, 2024)。

对于直接PRS模型,Taylor残差既依赖于状态失配,也依赖于与误差相关的辅助输入。因此,其界依赖于候选管半径,无法在管计算之前独立预设。这种耦合通过紧凑工作域上的单调不动点构造,以及显式的区域包含条件和有限超解条件来解决。

据此,本文开发了一种用于UUV轨迹跟踪的直接PRS Tube-MPC框架。非线性正向推力映射被嵌入预测模型中,从而消除了显式的推力分配和推力到PRS反演阶段。残余的模型失配和有界干扰通过辅助反馈和基于管的约束收紧来处理。主要贡献总结如下:

1. 通过将非线性正向推力映射集成到UUV预测模型中,开发了一种直接PRS鲁棒MPC公式化。这消除了显式的分配和反演阶段,并能够直接施加单个PRS幅值约束。

2. 为直接PRS非线性模型开发了一种可计算的超矩形外管构造。逐分量Jacobian界、扰边界、辅助输入界和Hessian界定义了一个单调自一致映射。在所述区域包含和有限超解条件下,离线迭代收敛到一个提供状态和PRS幅值收紧余量的RPI管。

3. 首次移动/终端反馈参数化减少了独立的在线控制移动数量。在所述终端条件、初始化条件、参考匹配条件和工作域条件下,建立了标称递归可行性、鲁棒的PRS幅值和状态约束满足,以及实用跟踪性能。

4. 在四推进器UUV平台上进行的硬件实验,在固定调参下覆盖圆形轨迹和伯努瓦叶形轨迹跟踪,结果表明跟踪误差低于所测基线方法,同时具有进入后管包含性、可重复性和实时可行性。

本文其余部分组织如下:第2节建立UUV轨迹跟踪问题并分析分层控制的局限性。第3节开发具有集成推进器动力学的UUV模型。第4节提出鲁棒控制层设计,包括辅助控制和RPI集合计算。第5节建立具有首次移动/终端反馈参数化的标称MPC。第6节提供稳定性分析和理论保证。第7节展示实验验证结果。第8节总结全文。

**符号说明**

对于标量,|·|表示绝对值;对于向量和矩阵,‖·‖表示欧几里得范数,除非另有说明。对于矩阵H,$H_i$表示其第$i$行,|H|表示逐元素绝对值。算子⊕表示Minkowski和,⊙表示Hadamard积;$dist_H(·, ·)$表示Hausdorff距离。

**问题建模**

本研究考虑在近似恒定深度下的水平面三自由度(3-DOF)轨迹跟踪,如图1所示。

**具有集成推进器动力学的UUV模型**

状态向量和控制向量为$\mathbf{x}=[\boldsymbol{\eta}^T, \mathbf{v}^T]^T \in \mathbb{R}^{n_x}$,$\mathbf{u}=\mathbf{n}=[n_1, n_2, n_3, n_4]^T \in \mathbb{R}^{n_u}$,其中$n_x=6$,$n_u=4$。非线性正向推力映射(8)直接嵌入载体动力学中,以获得PRS级预测模型。

**鲁棒辅助控制与约束收紧**

直接PRS预测模型对于执行器输入是非线性的,因此其Taylor残差既依赖于状态失配,也依赖于辅助修正,而相应的扰边界依赖于候选管半径。与具有预设不确定集的经典加性扰动构造不同,管和残差界必须自一致地计算。本节开发了一个有界非线性辅助控制器和一个离线计算的鲁棒正不变集。

**标称MPC公式化**

本节利用收紧后的集合(42)和(43)建立标称跟踪MPC。标称PRS被直接优化,而跟踪目标函数以状态误差坐标表示。

**理论分析**

本节建立了标称递归可行性、标称跟踪收敛性、鲁棒的PRS幅值和状态约束满足,以及实际受扰系统的实用跟踪性能。

全文中,假设1及定理1和定理3的条件成立,因此集合$\mathcal{E}$(39)鲁棒正不变;使用收紧后的集合$\mathcal{U}$和$\mathcal{X}$(42)和(43),且$\mathbb{P}_N(z_0, 0)$可行。标称结果仅需此条件以及终端可接受性条件(49)。

**实验验证**

本节在四推进器UUV平台上评估所提的直接PRS Tube-MPC方法,与两种分层MPC变体——广义力增强的非线性MPC(GP-MPC)和滑模控制器(SMC)进行比较。采用两个参考任务,调参相同:匀速圆形路径(第7.3节),用于支持精度、管包含性、执行器和时序比较;以及Gerono伯努瓦叶形机动(第7.4节),该机动同时激励速度和曲率,用于测试……

**结论**

本文提出了一种直接优化螺旋桨转速以用于UUV轨迹跟踪的Tube-MPC框架,从而避免了分层控制架构中固有的级联映射误差。统一了集成推进器动力学的预测模型,结合辅助鲁棒补偿层和离线计算的不变误差管,通过标称约束收紧实现了执行器约束的直接处理。分块移动参数化……

**CRediT作者贡献声明**

徐宇申:写作——原稿撰写,方法论,形式化分析。楚楚:写作——审阅与编辑,监督,资源。胡轩宇:软件,数据管理。

**利益冲突声明**

作者声明不存在已知的可能影响本文所述工作的竞争性经济利益或个人关系。

徐宇申 | 楚楚 | 胡轩宇

上海理工大学机械工程学院,上海市杨浦区军工路516号,邮编200093,中国
相关新闻
生物通微信公众号
微信
新浪微博

热点排行

    今日动态 | 人才市场 | 新技术专栏 | 中国科学人 | 云展台 | BioHot | 云讲堂直播 | 会展中心 | 特价专栏 | 技术快讯 | 免费试用

    版权所有 生物通

    Copyright© eBiotrade.com, All Rights Reserved

    联系信箱:

    粤ICP备09063491号