一种欠驱动无人水面艇固定时间路径跟踪控制方法
本发明涉及一种欠驱动无人水面艇固定时间路径跟踪控制方法,属于船舶运动控制。
背景技术:
1、无人水面艇是海洋资源勘探、水下地形测绘、水质监测、海上通信中继等任务的重要装备载体,路径跟踪控制是其实现自主航行的核心技术。欠驱动无人水面艇仅配备纵荡推力与艏摇力矩两类执行机构,无独立横荡控制输入,系统具有欠驱动、强耦合与非线性特性,且实际航行中持续受风、浪、海流等未知外部环境扰动作用,对控制方法的收敛性能、抗扰能力与工程可实现性均提出了较高要求。
2、在收敛性能方面,现有欠驱动无人水面艇路径跟踪控制方法多基于渐近稳定理论设计,仅能保证跟踪误差随时间推移最终收敛至零或其邻域,无法给出与系统初始状态无关的收敛时间上界。部分有限时间控制方案虽提升了收敛速度,但其收敛时间上界仍依赖于系统初始偏差大小,初始偏差越大则收敛时间越长,难以预先确定统一的调节时长,无法满足应急作业、多艇协同、高精度测绘等对瞬态响应速度和任务时效性要求较高的应用场景。
3、在控制器设计方面,反步控制是处理欠驱动非线性系统的常用方法,但其在逐级构造虚拟控制量的过程中需要反复进行解析求导,易引发“复杂性爆炸”问题,显著增加控制器的计算负担与工程落地难度。采用常规低通滤波器可避免重复求导,但滤波误差仅具备渐近收敛特性,无法匹配固定时间控制的收敛速度要求。此外,传统反步控制高度依赖精确的系统动力学模型,当存在未知海洋环境扰动时,闭环系统的控制精度与稳定性能易出现衰减,鲁棒性不足。
4、在控制信号更新方面,连续式或周期式高频控制更新会持续占用艇载通信带宽、增加控制器计算负荷,并加速执行器机械磨损。现有静态事件触发机制采用固定阈值判断控制量是否更新,阈值无法随航行状态、跟踪误差大小在线自适应调整,难以在控制性能与通信开销之间取得动态平衡;若触发条件设计不当,还可能出现触发间隔趋近于零的芝诺现象,无法达到降低更新频次的实际效果。
5、综上,目前尚缺乏一种能够协同实现路径制导、扰动在线估计、虚拟控制量高效微分、固定时间误差反馈与动态事件触发更新的欠驱动无人水面艇路径跟踪控制方案,难以同时兼顾收敛时效性、抗扰鲁棒性与工程经济性。
技术实现思路
1、为解决背景技术中存在的问题,本发明提供一种欠驱动无人水面艇固定时间路径跟踪控制方法。
2、实现上述目的,本发明采取下述技术方案:一种欠驱动无人水面艇固定时间路径跟踪控制方法,所述方法包括如下步骤:
3、s1:获取欠驱动无人水面艇的位置、航向与运动速度状态,建立欠驱动无人水面艇的运动学模型与动力学模型;
4、s2:根据期望路径与无人水面艇当前位置,构建路径跟踪误差,并确定期望路径的切向角与沿期望路径传播的虚拟目标速度;
5、s3:基于系统动力学模型构造固定时间扰动观测器,在线估计作用于无人水面艇的外部环境扰动,估计结果用于后续控制器的扰动前馈补偿;
6、s4:基于跟踪误差、期望路径切向角与无人水面艇侧滑角,生成具备固定时间收敛特性的期望航向角,并更新期望路径的路径参数;
7、s5:结合期望航向角、跟踪误差、外部环境扰动估计结果以及固定时间微分器输出,生成纵荡推力控制指令与艏摇力矩控制指令;
8、s6:针对纵荡推力与艏摇力矩两个控制通道,分别计算控制指令相对于前次传输值的触发误差,并基于动态阈值变量构造动态事件触发条件;
9、s7:根据动态事件触发条件判断是否更新控制指令,将控制指令传输至无人水面艇的执行器,以驱动无人水面艇跟踪期望路径。
10、进一步的,所述s1包括如下步骤:
11、s101:建立大地坐标系与艇体坐标系,作为运动描述的参考基准;
12、s102:通过坐标旋转变换建立位置航向状态与艇体速度之间的映射关系,得到运动学模型;
13、s103:基于刚体动力学与水动力特性,建立包含惯性项、耦合阻尼项、控制输入项与外部扰动项的动力学模型。
14、进一步的,所述s2包括如下步骤:
15、s201:采用与时间无关的连续几何标量作为路径参数对期望路径进行参数化描述,建立随期望路径运动的切向-法向坐标系;
16、s202:根据期望路径对路径参数的导数,计算期望路径切向角,并定义沿期望路径传播的虚拟目标速度;
17、s203:将大地坐标系下的位置偏差投影至切向-法向坐标系,分解得到沿迹误差与偏航误差两类跟踪误差分量;
18、s204:推导跟踪误差随时间演化的动力学关系,为后续导引与控制设计提供误差基准。
19、进一步的,所述s3包括如下步骤:
20、s301:将外部环境扰动折算为单位惯性下的归一化等效扰动,作为观测器的估计对象;
21、s302:构造辅助状态变量,并设计包含非线性反馈的辅助状态更新律;
22、s303:基于辅助变量与非线性反馈律,输出归一化等效扰动的实时估计值;
23、s304:根据系统惯性参数反解得到各物理通道的扰动估计结果,用于实现后续控制器的扰动前馈补偿。
24、进一步的,所述s4包括如下步骤:
25、s401:根据纵荡与横荡速度计算无人水面艇的侧滑角,并确定艇体航向与路径切向的相对航向偏差;
26、s402:结合期望路径切向角、偏航误差以及侧滑角补偿,生成具备固定时间收敛特性的期望航向角;
27、s403:根据沿迹误差设计路径参数的更新律,驱动期望路径上的参考点随无人水面艇同步运动,实现沿迹误差的固定时间收敛。
28、进一步的,所述s5包括如下步骤:
29、s501:定义航向跟踪误差与纵荡速度误差,构造航向控制通道的虚拟控制量;
30、s502:采用固定时间微分器对虚拟控制量进行微分估计,得到虚拟控制量的导数输出,替代解析求导运算;
31、s503:结合系统动力学补偿、扰动前馈补偿以及固定时间误差反馈,分别生成纵荡推力与艏摇力矩的控制中间量。
32、进一步的,所述s6包括如下步骤:
33、s601:针对纵荡推力与艏摇力矩两个控制通道,采用相互独立的事件触发调度规则,两个通道分别计算触发误差、判断触发时刻,互不耦合;
34、s602:定义连续运行的辅助控制量,并计算辅助控制量与当前保持控制量之间的触发误差;
35、s603:构造由动态可调增益与有界辅助变量组成的动态触发阈值;
36、s604:以触发误差幅值与动态阈值的比较结果作为事件触发判据,确定下一控制指令的更新时刻。
37、进一步的,所述s7包括如下步骤:
38、s701:对纵荡推力、艏摇力矩两个控制通道分别执行独立的传输规则:
39、当对应通道的动态事件触发条件满足时,将当前时刻的控制指令更新传输至对应执行器,刷新执行器的目标控制值;
40、当对应通道的动态事件触发条件未满足时,执行器保持前一触发时刻接收的控制指令不变,直至下一次触发更新;
41、s702:引入连续过渡函数对控制指令进行平滑处理,用于理论分析环节抑制指令跳变引发的执行器冲击;
42、s703:输出最终的纵荡推力与艏摇力矩至无人水面艇的执行机构,驱动无人水面艇完成路径跟踪。
43、与现有技术相比,本发明的有益效果是:
44、本发明针对欠驱动无人水面艇路径跟踪控制的技术需求,融合固定时间扰动观测、固定时间微分估计、固定时间导引控制与动态事件触发调度机制,可保证路径跟踪误差在与系统初始状态无关的有界时间内收敛至预定邻域,满足应急作业、高精度测绘等高时效性场景的应用要求;通过固定时间微分器替代反步控制中的解析求导运算,有效避免计算复杂度爆炸问题,且微分估计收敛特性与固定时间控制框架相匹配,降低了控制器的工程落地难度;依托固定时间扰动观测器在线估计并补偿外部海洋环境扰动,提升了复杂海况下系统的控制精度与鲁棒性,降低了控制方案对精确动力学模型的依赖;采用双通道独立的动态事件触发机制,触发阈值可随系统运行状态自适应调整,在保障控制性能的前提下减少了控制指令传输频次与执行器动作次数,可有效规避芝诺现象,兼顾控制性能与工程经济性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com