一种具有横摇约束的欠驱动船舶航向制导方法
阅读说明:本技术 一种具有横摇约束的欠驱动船舶航向制导方法 (Under-actuated ship course guidance method with rolling constraint ) 是由 刘志全 秦毅峰 朱云浩 储瑞婷 刘嘉昊 田晓 于 2021-09-17 设计创作,主要内容包括:本发明提供一种具有横摇约束的欠驱动船舶航向制导方法,具体步骤包括:步骤S1、设定路径(x-(p)(ω),y-(p)(ω))和路径参数ω;步骤S2、根据步骤S1获取路径点坐标(x-(p),y-(p))信息和路径切向角α-(p)信息;步骤S3、通过测量获得船舶位置坐标(x,y)信息和船舶运动状态信息;步骤S4、根据步骤S3所获得的船舶位置坐标信息和船舶运动状态信息估计横向漂角;步骤S5、结合步骤S1~步骤S4所获取的船舶信息,计算指令航向角ψ-(d)。本发明有效提高了恶劣海况下的指令航向角的精度,实现了对船舶航向的准确控制。(The invention provides an under-actuated ship course guidance method with rolling constraint, which specifically comprises the following steps: step S1, setting Path (x) p (ω),y p (ω)) and a path parameter ω; step S2, obtaining the coordinates (x) of the path point according to the step S1 p ,y p ) Information and path tangent angle alpha p Information; step S3, obtaining ship position coordinate (x, y) information and ship motion state information through measurement; step S4, estimating a transverse drift angle according to the ship position coordinate information and the ship motion state information obtained in the step S3; step S5, combining the ship information acquired in the steps S1-S4, calculating the command heading angle psi d . The invention effectively improves the precision of the instruction course angle under the severe sea condition and realizes the accurate control of the ship course.)
技术领域
本发明涉及船舶运动控制技术领域,特别涉及一种具有横摇约束的欠驱动船舶航向制导方法。
背景技术
船舶在风浪中航行不可避免的产生六自由度摇摆运动,其中横摇运动最为剧烈,大幅横摇运动严重影响电气设备正常运行、船舶安全航行和船员的舒适性。欠驱动船舶的运动控制装置通常为航向控制装置(舵)和推进控制装置(推力器),对于橫荡和横摇运动没有相应的控制装置。欠驱动船舶的路径跟踪控制在船舶运动控制
技术领域
承担重要角色,要求船舶的航向控制系统根据航向制导规律计算的指令航向角以恒定的速度跟踪预先规划的路径或轨迹,目前常用的航向制导方法是LOS(line of sight,视线法)方法。航向制导规律是路径跟踪控系统中的重要部分,船舶路径跟踪水平面坐标系如图1所示,其中:XOY为大地坐标系,(xp(ω),yp(ω))为参数化路径,ω为路径参数,为方便起见省略参数ω将路径点坐标简写为(xp,yp),(x,y)为船舶位置坐标,xe为切向跟踪误差,ye为垂向跟踪误差,ψ为航向角,β为横向漂角,αp为路径切向角,v为橫荡速度,u为纵荡速度,U为航速,Δ为前视距离。其中,船舶位置信息可以由GPS全球定位系统测量获得,船舶运动状态信息 (包括纵荡速度u、横摇角φ和航向角ψ等)可以由陀螺仪测量获得。针对参数化路径跟踪控制问题,目前提出的LOS方法(例如比例LOS、积分LOS 和自适应LOS等方法)基本都考虑了横向漂角估计和垂向跟踪误差收敛问题,对于切向跟踪误差的收敛问题考虑较少,同时大幅横摇运动对航向角及航向制导规律的影响并没有加以考虑,这对于风浪中大幅摇摆的欠驱动船舶路径跟踪控制是考虑不充分的。因此,针对没有横摇减摇控制装置的欠驱动船舶,考虑横摇约束的航向制导方法将有助于提高欠驱动船舶的路径跟踪精度。
发明内容
本发明的目的是提出一种具有横摇约束的欠驱动船舶航向制导方法,解决在恶劣海况下大幅横摇的欠驱动船舶路径控制的跟踪精度问题。
为实现上述目的,本发明提供一种具有横摇约束的欠驱动船舶航向制导方法,具体步骤包括:步骤S1、设定路径(xp(ω),yp(ω))和路径参数ω;步骤S2、根据步骤S1获取路径点坐标(xp,yp)信息和路径切向角αp信息;步骤S3、通过测量获得船舶位置坐标(x,y)信息和船舶运动状态信息;步骤S4、根据步骤S3 所获得的船舶位置坐标信息和船舶运动状态信息估计横向漂角;步骤S5、结合步骤S1~步骤S4所获取的船舶信息,计算指令航向角ψd。
优选地,步骤S3所述的船舶运动状态信息包括某一相同t时间的纵荡速度u、横摇角φ、航向角ψ、横摇角速度p和航向角速度r。
优选地,步骤S4所述的估计横向漂角具体包括如下步骤:
步骤S401、根据某一相同t时间的船舶位置坐标(x,y)信息,计算切向跟踪误差xe和垂向跟踪误差ye;
步骤S402、根据步骤S401中的切向跟踪误差xe和垂向跟踪误差ye计算横向漂角β的估计值
优选地,步骤S402所述的横向漂角β的估计值采用如下公式计算:
其中,为g的估计。
优选地,步骤S401所述的切向跟踪误差xe和垂向跟踪误差ye的计算公式如下:
优选地,步骤S1所述的路径参数ω是时间t的函数,该路径参数ω由更新规律公式计算获得:
其中,u为橫荡速度,ψ为航向角,,αp(ω)为路径切向角,xe为切向跟踪误差, x′p(ω)为xp(ω)对ω的导数,y′p(ω)为yp(ω)对ω的导数,k为设计的正常数,为ω对时间t的导数;(xp(ω),yp(ω))为构成路径的点的坐标。
优选地,步骤S2中所述的路径切向角αp由如下公式计算:
其中,步骤S2中所述的路径点坐标(xp,yp)和路径切向角αp分别由路径 (xp(ω),yp(ω))和路径切向角αp(ω)在某一相同t时间计算获得。
优选地,步骤S3所述的船舶运动状态与船舶位置的关系由四自由度运动学耦合模型描述,该模型表达式如下:
其中,为船舶位置坐标(x,y)分别对时间t的导数,v为纵荡速度,u为橫荡速度,为横摇角φ对时间t的导数,为航向角ψ对时间t的导数。
优选地,所述的可由降阶观测器的方法计算获得,降阶观测器公式如下:
其中,M为虚拟状态,为M对时间t的导数,k1为设计的正常数,为αp对时间t的导数。
优选地,根据所获取的路径切向角αp、横向漂角β的估计值和垂向跟踪误差ye,步骤S5中所述的指令航向角ψd采用如下公式计算:
其中,Δ为前视距离。
综上所述,与现有技术相比,本发明提供的一种具有横摇约束的欠驱动船舶航向制导方法,具有如下有益效果:考虑了恶劣海况下欠驱动船舶大幅横摇运动对航向角及航向制导规律的影响,通过测量的船舶运动状态,计算获得横向漂角估计,有效提高了恶劣海况下的指令航向角的精度,实现了对船舶航向的准确控制。
附图说明
图1为本发明的具有横摇约束的欠驱动船舶航向制导方法的路径跟踪坐标系示意图;
图2为本发明的具有横摇约束的欠驱动船舶航向制导方法的指令航向角的计算流程示意图。
具体实施方式
以下将结合本发明实施例中的附图1~附图2,对本发明实施例中的技术方案、构造特征、所达成目的及功效予以详细说明。
需要说明的是,附图采用非常简化的形式且均使用非精准的比例,仅用以方便、明晰地辅助说明本发明实施方式的目的,并非用以限定本发明实施的限定条件,故不具技术上的实质意义,任何结构的修饰、比例关系的改变或大小的调整,在不影响本发明所能产生的功效及所能达成的目的下,均应仍落在本发明所揭示的技术内容能涵盖的范围内。
需要说明的是,在本发明中,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括明确列出的要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。
本发明提供了一种具有横摇约束的欠驱动船舶航向制导方法,如图1和图2所示,该欠驱动船舶航向制导方法包括如下步骤:
步骤S1、设定路径(xp(ω),yp(ω))和路径参数ω。
其中,步骤S1所述的路径参数ω是时间t的函数,该路径参数ω由如下更新规律公式计算获得:
式(1)中,u为橫荡速度,ψ为航向角,αp(ω)为路径切向角,xe为切向跟踪误差,x′p(ω)为xp(ω)对ω的导数,y′p(ω)为yp(ω)对ω的导数,k为设计的正常数,为ω对时间t的导数;(xp(ω),yp(ω))为构成路径的点的坐标;
进一步,路径切向角αp(ω)由如下公式计算:
步骤S2、根据步骤S1获取t时间的路径点坐标(xp,yp)信息和t时间的路径切向角αp信息。
步骤S3、根据GPS全球定位系统测量获得t时间的船舶位置坐标(x,y)信息,并通过安装在船舶上的陀螺仪获得t时间的船舶运动状态信息。
其中,步骤S3所述的船舶运动状态信息包括纵荡速度u、横摇角φ、航向角ψ、横摇角速度p和航向角速度r。
进一步地,船舶运动状态与船舶位置的关系由四自由度运动学耦合模型描述,具体如下:
式(3)中,为船舶位置坐标(x,y)分别对时间t的导数,v为纵荡速度,u 为橫荡速度,为横摇角φ对时间t的导数,为航向角ψ对时间t的导数。
步骤S4、根据步骤S3所获得的船舶位置坐标信息和船舶运动状态信息估计横向漂角,具体包括如下步骤:
步骤S401、根据船舶位置坐标(x,y)信息,计算切向跟踪误差xe和垂向跟踪误差ye,其计算公式如下:
步骤S402、根据步骤S401中的切向跟踪误差xe和垂向跟踪误差ye计算横向漂角β的估计值
其中,步骤S402所述的横向漂角β的估计值采用如下公式计算:
式(5)中,为g的估计。
进一步地,所述的可由降阶观测器的方法计算获得,降阶观测器公式如下:
式(6)中,M为虚拟状态,为M对时间t的导数,k1为设计的正常数,为αp对时间t的导数。
步骤S5、根据步骤S1~步骤S4所获取的路径切向角αp、横向漂角β的估计值和垂向跟踪误差ye,计算指令航向角ψd。
其中,步骤S5中所述的指令航向角ψd采用如下公式计算:
式(7)中,Δ为前视距离,通常为船长的2到3倍。
根据步骤S5计算获得的指令航向角ψd,使船舶航向角ψ获得能够进行跟踪的指令航向角ψd,即船舶可以根据指令航向角ψd调整船舶航行方向,实现船舶航向控制,完成船舶航向制导。
综上所述,与现有欠驱动船舶航向制导方法相比,本发明所提供的具有横摇约束的欠驱动船舶航向制导方法由于考虑了恶劣海况下欠驱动船舶大幅横摇运动对航向角及航向制导规律的影响能够有效提高恶劣海况下的指令航向角精度等优势。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
- 上一篇:一种医用注射器针头装配设备
- 下一篇:全覆盖路径生成方法、装置、终端设备及存储介质