舰船用多回路无模型自适应艏向控制方法技术

本发明专利技术提供一种舰船用多回路无模型自适应艏向控制方法，本发明专利技术中控制系统采用外环导航控制器和内环角速度控制器的组合方式，外环导航控制器计算期望转艏角速度，内环MFAC角速度控制器完成角速度控制，间接实现航向控制的目的。实际应用中，角速度传感器噪声大，本发明专利技术利用控制系统历史输入输出数据进行角速度预测，通过卡尔曼滤波器对角速度数据滤波，作为内环角速度控制器的反馈输入，抑制角速度传感器的噪声，有效提高实际应用中的控制效果。本发明专利技术将MFAC控制理论引入舰船艏向控制领域，借助MFAC理论独特的自适应性及在线数据驱动优点，本发明专利技术提供的舰船用多回路无模型自适应艏向控制方法具有较强的自适应性。

Multi loop model free adaptive bow control method for ship

The invention provides a multi-loop model-free adaptive heading control method for naval vessels. The control system adopts a combination of an outer loop navigation controller and an inner loop angular velocity controller, the outer loop navigation controller calculates the desired heading angular velocity, and the inner loop MFAC angular velocity controller completes the angular velocity control and indirectly realizes the heading control. The purpose of the system. In practical application, the angular velocity sensor has large noise. The method uses the historical input and output data of the control system to predict the angular velocity, filters the angular velocity data through Kalman filter, and acts as the feedback input of the inner loop angular velocity controller to suppress the noise of the angular velocity sensor, thus effectively improving the control effect in practical application. Fruit. The invention introduces MFAC control theory into the field of ship heading control, and by virtue of the unique adaptability of MFAC theory and the advantages of on-line data driving, the multi-loop model-free adaptive heading control method for ship has strong adaptability.

【技术实现步骤摘要】
舰船用多回路无模型自适应艏向控制方法
本专利技术涉及一种舰船用多回路无模型自适应艏向控制方法，用于舰船艏向控制，属于舰船自动运动控制领域，本专利技术中的舰船是指广义上的各种水中航行装备，如水面船舶、潜水器、潜艇、水下无人航行器、水面无人艇等，在本专利技术中统称为舰船，都在本专利技术的应用范围内。
技术介绍
舰船的航向控制对于舰船系统来说非常重要，只有保证了舰船的航向稳定，才能有效的跟踪期望航迹。目前在实际工程应用中，舰船的航向控制基本上采用的是PID控制算法以及常规的基于“模型导向”设计策略开发的控制算法。PID控制器是一种基于离线数据的数据驱动控制算法，但舰船运行于海洋环境中时容易受到模型摄动、海洋环境干扰力等影响，导致PID控制器难以维持一致的控制效果，需要重新调整参数才能使系统保持良好控制性能或稳定。而基于“模型导向”设计策略开发的控制器，严重地依赖于系统数学模型，由于获得精确的数学模型十分困难，存在未建模动态、模型摄动等影响导致系统的自适应较差，难以保证系统鲁棒性能，从而很难在工程中获得应用。无模型自适应控制理论(MFAC)不依赖于精确的数学模型，采用数据驱动方式调节控制参数，已应用于多种领域并取得了良好效果，如程启明等提出的公布号为CN101957598A,专利技术名称为“一种大时滞系统灰色无模型控制方法”的专利技术专利，马洁等发表的论文《大型舰船综合减摇系统无模型自适应控制》等，但目前已公开的方法均不适用于舰船的艏向控制，因为舰船的艏向系统不满足MFAC算法对受控系统“拟线性”假设条件的要求，即受控系统输入增加时相应的受控系统的输出是不减的。姜权权等人提出的专利技术名称为“舰船用重定义输出式无模型自适应艏向控制算法”的尚未公开的专利中，在无模型自适应控制理论(MFAC)中重定义系统输出(船体艏向和角速度的函数)，使得舰船的艏向控制系统满足MFAC理论对受控系统的“拟线性”假设条件，从而使得该重定义输出式MFAC理论可以应用于舰船的艏向控制中。而本专利技术提出的方法为外环导航控制器和内环角速度控制器的组合方式，MFAC控制器用于内环角速度的控制，此外，本专利技术利用控制系统历史输入输出数据进行角速度预测，通过卡尔曼滤波器估计系统转艏角速度，解决了实际应用中角速度传感器噪声大的问题。因此，二者的理论基础和控制系统结构具有本质不同，并且本专利技术中引入的对角速度传感器噪声的处理过程将有效提高实际应用中的控制效果，相对于现有技术具有显著进步。蔡满军等发表的论文《一种带有无模型外环补偿的PID控制》，控制系统采用了多回路结构，内环采用PID控制方法，外环无模型自适应控制作为补偿，实际控制系统输出取外环无模型自适应控制与内环PID控制之和，该方法本质为对控制系统中原有控制方法的加性修正，而本专利技术中MFAC控制器为内环控制器，与外环导航控制器为串联关系，二者原理具有本质不同。
技术实现思路
本专利技术的目的是为了提供一种舰船用多回路无模型自适应艏向控制方法，舰船航向控制系统不满足无模型自适应控制(modelfreeadaptivecontrol，MFAC)算法的“拟线性”假设条件，导致MFAC算法无法直接应用于舰船航向控制，本专利技术中控制系统采用外环导航控制器和内环角速度控制器的组合方式，外环导航控制器计算期望转艏角速度，内环MFAC角速度控制器完成角速度控制，间接实现航向控制的目的。实际应用中，角速度传感器噪声大，本专利技术利用控制系统历史输入输出数据进行角速度预测，通过卡尔曼滤波器对角速度数据滤波，作为内环角速度控制器的反馈输入，抑制角速度传感器的噪声，有效提高实际应用中的控制效果。借助MFAC理论独特的自适应性及在线数据驱动优点，本专利技术提供的舰船用多回路无模型自适应艏向控制方法具有较强的自适应性。本专利技术的目的是这样实现的：步骤如下：步骤(1)由制导模块给出舰船的期望艏向ψ*(k)，其中k为离散控制系统的运行时刻；步骤(2)由艏向传感器测量得到系统实际艏向ψ(k)，将所述舰船期望艏向与实际艏向相减，得到艏向误差e(k)＝ψ*(k)-ψ(k)，如果艏向误差绝对值|e(k)|小于设定的阈值e0并保持，则波浪滑翔器艏向控制系统实际输出稳定收敛到期望输出，跳出循环，否则将e(k)作为外环导航控制器的输入，解算出期望转艏角速度r*(k)，进入步骤(3)；步骤(3)无模型自适应控制器根据控制系统输出的历史数据u(i)，i＝1,2,…,k-1和系统转艏角速度的历史数据r(i)，i＝1,2,…,k-1，估算系统伪偏导数步骤(4)根据系统伪偏导数系统转艏角速度的历史数据r(i)，i＝1,2,…,k-1以及控制系统输出当前值和历史数据u(i)，i＝1,2,…,k，系统转艏角速度的预测值步骤(5)由角速度传感器测量得到系统实际转艏角速度的测量值r(k)；步骤(6)采用卡尔曼滤波器对系统转艏角速度估计，得到系统转艏角速度的估计值其中在卡尔曼滤波器中，系统转艏角速度的预测值作为状态值的一步预测，将系统实际转艏角速度的测量值r(k)作为状态观测值；步骤(7)将所述系统转艏角速度的估计值作为无模型自适应控制器的输入，解算出控制系统期望输出u*(k+1)；步骤(8)执行机构驱动舰船转向，进入步骤(2)进行循环。本专利技术还包括这样一些结构特征：1.步骤(2)中所述的外环导航控制器，控制算法包括PID、模糊PID或S面。2.步骤(3)中所述的无模型自适应控制器，包括紧格式无模型自适应控制器、偏格式无模型自适应控制器、全格式无模型自适应控制器。3.步骤(3)中所述的控制系统输出可以是期望舵角，或期望转艏力矩。4.步骤(2)和步骤(5)中所述的艏向传感器和角速度传感器，为磁罗经或惯导，艏向传感器和角速度传感器可采用一个集成传感器或两个独立传感器。与现有技术相比，本专利技术的有益效果是：1、通过外环导航控制器和内环角速度控制器的组合方式，将MFAC控制理论引入舰船艏向控制领域，通过对角速度的控制时间对艏向角的间接控制，避免了MFAC控制理论直接进行艏向控制时舰船的艏向系统不满足受控系统“拟线性”假设条件的限制，借助MFAC理论独特的自适应性及在线数据驱动优点，本专利技术提供的舰船用多回路无模型自适应艏向控制方法具有较强的自适应性。2、利用控制系统历史输入输出数据进行角速度预测，不依赖于动力学系统精确的数学模型，基于角速度预测利用卡尔曼滤波器估计系统转艏角速度，解决了实际应用中角速度传感器噪声大的问题，有效提高实际应用中的控制效果。附图说明图1是舰船艏向控制系统结构图；图2是舰船用多回路无模型自适应艏向控制方法流程图。具体实施方式下面结合附图与具体实施方式对本专利技术作进一步详细描述。结合图1说明舰船艏向控制系统的结构。制导模块给出系统期望艏向ψ*(k)，导航控制器依据系统期望艏向ψ*(k)和艏向传感器测得的实际艏向ψ(k)，计算出期望转艏角速度r*(k)作为MFAC角速度控制器的输入，MFAC角速度控制器结合卡尔曼滤波器计算的角速度估计值计算得到伪偏导数估计值和下一时刻控制系统期望输出u*(k+1)，执行机构依据控制系统指令驱动舰船转向，舰船的实际运动情况还受海洋环境的影响，由艏向传感器和角速度传感器实时监测舰船的艏向和角速度。其中，传感器测得的舰船角速度r(k)作为观测值，由伪偏导数估计值和本文档来自技高网...

【技术保护点】
1.舰船用多回路无模型自适应艏向控制方法，其特征在于：步骤如下：步骤(1)由制导模块给出舰船的期望艏向ψ*(k)，其中k为离散控制系统的运行时刻；步骤(2)由艏向传感器测量得到系统实际艏向ψ(k)，将所述舰船期望艏向与实际艏向相减，得到艏向误差e(k)＝ψ*(k)‑ψ(k)，如果艏向误差绝对值|e(k)|小于设定的阈值e0并保持，则波浪滑翔器艏向控制系统实际输出稳定收敛到期望输出，跳出循环，否则将e(k)作为外环导航控制器的输入，解算出期望转艏角速度r*(k)，进入步骤(3)；步骤(3)无模型自适应控制器根据控制系统输出的历史数据u(i)，i＝1,2,…,k‑1和系统转艏角速度的历史数据r(i)，i＝1,2,…,k‑1，估算系统伪偏导数

【技术特征摘要】
1.舰船用多回路无模型自适应艏向控制方法，其特征在于：步骤如下：步骤(1)由制导模块给出舰船的期望艏向ψ*(k)，其中k为离散控制系统的运行时刻；步骤(2)由艏向传感器测量得到系统实际艏向ψ(k)，将所述舰船期望艏向与实际艏向相减，得到艏向误差e(k)＝ψ*(k)-ψ(k)，如果艏向误差绝对值|e(k)|小于设定的阈值e0并保持，则波浪滑翔器艏向控制系统实际输出稳定收敛到期望输出，跳出循环，否则将e(k)作为外环导航控制器的输入，解算出期望转艏角速度r*(k)，进入步骤(3)；步骤(3)无模型自适应控制器根据控制系统输出的历史数据u(i)，i＝1,2,…,k-1和系统转艏角速度的历史数据r(i)，i＝1,2,…,k-1，估算系统伪偏导数步骤(4)根据系统伪偏导数系统转艏角速度的历史数据r(i)，i＝1,2,…,k-1以及控制系统输出当前值和历史数据u(i)，i＝1,2,…,k，系统转艏角速度的预测值步骤(5)由角速度传感器测量得到系统实际转艏角速度的测量值r(k)；步骤(6)采用卡尔曼滤波器对系统转艏角速度估计，得到系统转艏角速度的估计值其中在...

【专利技术属性】
技术研发人员：王磊峰，廖煜雷，潘恺文，李晔，张蔚欣，姜权权，范佳佳，贾知浩，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23