基于模糊观测器的鲁棒自适应无人船路径跟踪控制方法技术

本发明专利技术公开了一种基于模糊未知观测器的鲁棒自适应欠驱动水面船路径跟踪控制方法，包括以下步骤：建立无人船运动学和动力学模型；构建路径跟踪误差动态；提出速度可变的视线制导律；建立模糊逻辑系统；基于模糊未知观测器的控制器设计。本发明专利技术在制导子系统中，提出了一种速度可变的视线制导律，提高了制导系统的操纵灵活性和鲁棒性，使位置误差渐近稳定到零；在控制子系统中，通过设计模糊未知干扰观测器对未知干扰进行快速精确的估计，在设计的速度和航向控制器中进行有效补偿，使制导信号与实际量之间的追踪误差渐近稳定回到零，所涉及的算法框架可使整个闭环系统具有全局渐近稳定特性，极大地提高了路径跟踪控制系统的操纵灵活性和跟踪精度。

Robust adaptive UAV path tracking control method based on Fuzzy Observer

The invention discloses a robust adaptive under-actuated surface ship path tracking control method based on a fuzzy unknown observer, which includes the following steps: establishing the kinematics and dynamics model of an unmanned ship; constructing the path tracking error dynamics; proposing a line-of-sight guidance law with variable speed; establishing a fuzzy logic system; and designing a controller based on a fuzzy unknown observer. In the guidance subsystem, the present invention proposes a line-of-sight guidance law with variable speed, which improves the control flexibility and robustness of the guidance system and makes the position error asymptotically stable to zero. In the control subsystem, the unknown disturbance is quickly and accurately estimated by designing a fuzzy unknown disturbance observer, and the designed speed and course controller is effectively compensated to enable guidance. The tracking error between the signal and the actual quantity is asymptotically stable to zero. The algorithm framework can make the whole closed-loop system globally asymptotically stable, and greatly improve the flexibility and tracking accuracy of the path tracking control system.

【技术实现步骤摘要】
基于模糊观测器的鲁棒自适应无人船路径跟踪控制方法
本专利技术属于无人船领域，尤其涉及一种无人船精确路径跟踪控制方法。
技术介绍
由于在海上民用和军事上的灵活性和多功能性，欠驱动水面船的应用变得越来越普遍。欠驱动水面船的运动控制一直都是研究热点，通常被分为镇定问题、轨迹追踪和路径跟踪。路径跟踪控制是欠驱动水面船在自主执行各种高风险海事任务过程中一项基础且关键的功能。通常路径跟踪控制系统可分为制导子系统和控制子系统。在制导子系统设计中，主要是采用视线制导方法，比例视线制导最先被提出，通过横向误差与一个设定参数的反正切值计算期望舵角。积分视线制导在比例视线制导的基础上，通过一个积分项补偿侧滑角的影响。自适应视线制导，通过自适应方法估计未知的侧滑角。还有给予各种观测器的视线制导律，利用观测器观测未知的侧滑角。在控制系统的设计中，反步控制、滑模控制、利亚诺夫直接法等被广泛采用于船舶运动控制中，但是这些控制方法都依靠精确的数学模型参数且没有考虑参数摄动对系统稳定性的影响。在已有的制导方法中，无人船的速度通常预定义为常量。在这种情况下，无人船实际上仅由方向舵控制，从而不仅降低了总体操纵性与灵活性，而且增加了方向舵的操纵负担。在控制子系统中，快速精确的扰动估计和补偿没有实现，极大地降低了路径跟踪控制系统的精度。
技术实现思路
为解决现有技术存在的上述问题，本专利技术要设计一种能提高路径跟踪控制系统的精度的基于模糊未知观测器的鲁棒自适应欠驱动水面船路径跟踪控制方法。为了实现上述目的，本专利技术的技术方案如下：基于模糊未知观测器的鲁棒自适应欠驱动水面船路径跟踪控制方法，利用路径跟踪控制系统进行跟踪控制，所述的路径跟踪控制系统包括制导子系统和控制子系统。所述的制导子系统是一个决策系统，结合无人船与参考路径之间的误差产生速度和航向的参考指令，以此参考指令动作，跟踪误差将渐近收敛到零；所述的控制子系统是一个执行系统，使无人船实际姿态和参考指令达到一致。所述的路径跟踪控制方法，包括以下步骤：A、建立无人船运动学和动力学模型无人船运动学模型如下：x代表惯性坐标系下无人船的横坐标，y代表惯性坐标系下无人船的纵坐标，ψ代表惯性坐标系下无人船的航向，u代表浮体坐标系下无人船的前向速度、v代表浮体坐标系下无人船的横向速度，r代表浮体坐标系下无人船的航向角速度，其中是x的导数，是y的导数，是ψ的导数。无人船动力学模型如下：式中：d11是无人船在前向速度维度上的阻尼参数，d22是无人船在横向速度维度上的阻尼参数，d33是无人船在航向角速度维度上的阻尼参数，m11是无人船在前向速度维度上的质量参数，m22是无人船在横向速度维度上的质量参数，m33是无人船在航向角速度维度上的质量参数，τu和τr分别为可利用的控制输入前向推力和转向力矩，是无人船在前向速度上的外界干扰，是无人船在横向速度上的外界干扰，是无人船在航向角速度速度上的外界干扰。进一步将无人船动力学模型整理为如下形式：其中：Du被作为前向速度维度上的集总的不确定性，Dv被作为横向速度维度上的集总的不确定性，Dr被作为航向角速度维度上的集总的不确定性，集总的不确定性包括模型参数摄动、内部未知动态及外界干扰，其形式为：B、构建路径跟踪误差动态在无人船跟踪参数路径上选取一个移动虚拟点，以这个移动虚拟点为原点，其在惯性坐标系下的横纵坐标分别为xp和yp，建立一个相对于惯性坐标系旋转角度φp的坐标系，称之为路径正切参考坐标系，无人船相对于移动虚拟点在路径参考坐标系横坐标方向上的位置误差为xe，在纵坐标方向上的位置误差为ye，xe和ye的计算公式如下：路径跟踪误差的动态为：utar是路径上移动虚拟点的速度，表达成下列形式：C、提出速度可变的视线制导律基于推导出的路径跟踪误差动态(4)，设计制导律如下，使路径跟踪误差渐近稳定到零，制导子系统达到渐近稳定：式中：ud是无人船前向速度u的参考值，ψd是航向ψ的参考值，βd是侧滑角β的理想信号，k1＞0是前向速度制导律中的设定常数，Δ>0是前视距离，k2＞0是航向制导律中的设定常数，是理想航速值。运用以上设计的制导律，路径跟踪误差将渐近收敛到零点，无人船速度和航向得到双重制导，制导子系统的决策水平和灵活性都得到了极大的提高。运用设计的航向制导律，得到下列公式：将整体的制导律代到路径跟踪误差动态中，得：定义第一个李亚诺夫方程如下：求取第一个李亚诺夫方程的导数，并将制导律代入其中，得：这里有ud≥udmin＞0和因此得到：其中k＝2min{k1,k2}。由于设计的李亚诺夫方程的导数是负定的，满足渐近稳定特性的充分条件，因此制导子系统的渐近稳定性得到了证明和保证。D、建立模糊逻辑系统模糊逻辑系统被表达成下列形式：Rj:如果X1是F1j,X2是……,Xn是则Y1是θ1j,Y2是……,Ym是其中：X＝[X1,X2,…,Xn]T∈Rn和Y＝[Y1,Y2,…,Ym]T∈Rm分别是模糊系统的输入和输出变量。Fij,i＝1,2,…,n；j＝1,2,…N是第i条模糊规则的模糊序列，θij,i＝1,2,…,m；j＝1,2,…N是模糊权重参数。模糊系统的整体输出被表达为下列形式：其中：ξ(X)＝[ξ1(X),ξ2(X),…,ξN(X)]T是模糊基函数方程，被定义成下列形式：是模糊序列Fij的隶属度函数，被选取为高斯函数。由于模糊逻辑系统的通用逼近能力，集总的不确定项Du、Dr被完全描绘为如下形式：是最有权重参数，是理想的逼近误差，它们是有界的，即：E、基于模糊未知观测器的控制器设计E1、速度控制速度控制器被设计成下列的形式：其中ku＞0,ue＝u-ud是速度追踪误差，是模糊未知观测器的输出，被设计为：ξu为预定义的模糊基方程，v:＝[u,v,r]T是无人船速度矢量，和分别是权重参数和逼近误差的估计，它们的自适应律如下：辅助不确定性观测误差被定义为：σu＝ue-ρu其中：设计第二个李亚诺夫方程：和是相应的自适应估计误差。对第二个李亚诺夫方程V2求微分：将设计的速度控制器以及参数自适应率代入到上述方程中，得：从此得到结论，速度制导信号能被渐近追踪，所有的误差信号都能渐近稳定到零。E2、航向控制航向控制器被设计成下列的形式：其中kr＞0,ψe＝ψ-ψd是航向追踪误差，re＝r-rd是航向角速度追踪误差，rd是一个虚拟控制律，公式如下：rd＝-kψψe+ψd是模糊未知观测器的输出，被设计为：ξr为预定义的模糊基方程，v:＝[u,v,r]T是无人船的速度矢量，和分别是权重参数和逼近误差的估计，它们的自适应律如下：辅助不确定性观测误差被定义为：σr＝re-ρr其中：定义第三个李亚诺夫方程：对第三个李亚诺夫方程V3求导，得：将设计的航向控制器以及参数自适应率代入到上述方程中，得：从以上证明结果得出结论，所有误差信号都能将近稳定到零，制导航向能够被精确地追踪。与现有技术相比，本专利技术具有以下有益效果：1、本专利技术在制导子系统中，提出了一种速度可变的视线制导律，提高了制导系统的操纵灵活性和鲁棒性，使位置误差渐近稳定到零；在控制子系统中，通过设计模糊未知干扰观测器对未知干扰进行快速精确的估计，在设计的速度和航向控制器中进行有效补偿，使制导信号与实际量之间的追踪误差渐近稳定回到零，所涉及的算法框架本文档来自技高网...

【技术保护点】
1.基于模糊未知观测器的鲁棒自适应欠驱动水面船路径跟踪控制方法，其特征在于：利用路径跟踪控制系统进行跟踪控制，所述的路径跟踪控制系统包括制导子系统和控制子系统；所述的制导子系统是一个决策系统，结合无人船与参考路径之间的误差产生速度和航向的参考指令，以此参考指令动作，跟踪误差将渐近收敛到零；所述的控制子系统是一个执行系统，使无人船实际姿态和参考指令达到一致；所述的路径跟踪控制方法，包括以下步骤：A、建立无人船运动学和动力学模型无人船运动学模型如下：

【技术特征摘要】
1.基于模糊未知观测器的鲁棒自适应欠驱动水面船路径跟踪控制方法，其特征在于：利用路径跟踪控制系统进行跟踪控制，所述的路径跟踪控制系统包括制导子系统和控制子系统；所述的制导子系统是一个决策系统，结合无人船与参考路径之间的误差产生速度和航向的参考指令，以此参考指令动作，跟踪误差将渐近收敛到零；所述的控制子系统是一个执行系统，使无人船实际姿态和参考指令达到一致；所述的路径跟踪控制方法，包括以下步骤：A、建立无人船运动学和动力学模型无人船运动学模型如下：x代表惯性坐标系下无人船的横坐标，y代表惯性坐标系下无人船的纵坐标，ψ代表惯性坐标系下无人船的航向，u代表浮体坐标系下无人船的前向速度、v代表浮体坐标系下无人船的横向速度，r代表浮体坐标系下无人船的航向角速度，其中是x的导数，是y的导数，是ψ的导数；无人船动力学模型如下：式中：d11是无人船在前向速度维度上的阻尼参数，d22是无人船在横向速度维度上的阻尼参数，d33是无人船在航向角速度维度上的阻尼参数，m11是无人船在前向速度维度上的质量参数，m22是无人船在横向速度维度上的质量参数，m33是无人船在航向角速度维度上的质量参数，τu和τr分别为可利用的控制输入前向推力和转向力矩，是无人船在前向速度上的外界干扰，是无人船在横向速度上的外界干扰，是无人船在航向角速度速度上的外界干扰；进一步将无人船动力学模型整理为如下形式：其中：Du被作为前向速度维度上的集总的不确定性，Dv被作为横向速度维度上的集总的不确定性，Dr被作为航向角速度维度上的集总的不确定性，集总的不确定性包括模型参数摄动、内部未知动态及外界干扰，其形式为：B、构建路径跟踪误差动态在无人船跟踪参数路径上选取一个移动虚拟点，以这个移动虚拟点为原点，其在惯性坐标系下的横纵坐标分别为xp和yp，建立一个相对于惯性坐标系旋转角度φp的坐标系，称之为路径正切参考坐标系，无人船相对于移动虚拟点在路径参考坐标系横坐标方向上的位置误差为xe，在纵坐标方向上的位置误差为ye，xe和ye的计算公式如下：路径跟踪误差的动态为：utar是路径上移动虚拟点的速度，表达成下列形式：C、提出速度可变的视线制导律基于推导出的路径跟踪误差动态(4)，设计制导律如下，...

【专利技术属性】
技术研发人员：王宁，孙卓，
申请(专利权)人：大连海事大学，
类型：发明
国别省市：辽宁,21