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.
【技术实现步骤摘要】
基于模糊观测器的鲁棒自适应无人船路径跟踪控制方法
本专利技术属于无人船领域,尤其涉及一种无人船精确路径跟踪控制方法。
技术介绍
由于在海上民用和军事上的灵活性和多功能性,欠驱动水面船的应用变得越来越普遍。欠驱动水面船的运动控制一直都是研究热点,通常被分为镇定问题、轨迹追踪和路径跟踪。路径跟踪控制是欠驱动水面船在自主执行各种高风险海事任务过程中一项基础且关键的功能。通常路径跟踪控制系统可分为制导子系统和控制子系统。在制导子系统设计中,主要是采用视线制导方法,比例视线制导最先被提出,通过横向误差与一个设定参数的反正切值计算期望舵角。积分视线制导在比例视线制导的基础上,通过一个积分项补偿侧滑角的影响。自适应视线制导,通过自适应方法估计未知的侧滑角。还有给予各种观测器的视线制导律,利用观测器观测未知的侧滑角。在控制系统的设计中,反步控制、滑模控制、利亚诺夫直接法等被广泛采用于船舶运动控制中,但是这些控制方法都依靠精确的数学模型参数且没有考虑参数摄动对系统稳定性的影响。在已有的制导方法中,无人船的速度通常预定义为常量。在这种情况下,无人船实际上仅由方向舵控制,从而不仅降低了总体操纵性与灵活性,而且增加了方向舵的操纵负担。在控制子系统中,快速精确的扰动估计和补偿没有实现,极大地降低了路径跟踪控制系统的精度。
技术实现思路
为解决现有技术存在的上述问题,本专利技术要设计一种能提高路径跟踪控制系统的精度的基于模糊未知观测器的鲁棒自适应欠驱动水面船路径跟踪控制方法。为了实现上述目的,本专利技术的技术方案如下:基于模糊未知观测器的鲁棒自适应欠驱动水面船路径跟踪控制方法,利用路径跟 ...
【技术保护点】
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),设计制导律如下,...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。