CN109613918A - 一种高精度轨迹跟踪控制方法 - Google Patents
一种高精度轨迹跟踪控制方法 Download PDFInfo
- Publication number
- CN109613918A CN109613918A CN201811515571.3A CN201811515571A CN109613918A CN 109613918 A CN109613918 A CN 109613918A CN 201811515571 A CN201811515571 A CN 201811515571A CN 109613918 A CN109613918 A CN 109613918A
- Authority
- CN
- China
- Prior art keywords
- angle
- ship
- los
- course
- rudder angle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
Abstract
本发明公开了一种高精度轨迹跟踪控制方法,该方法是将船舶的位置和舵角分别反馈给视线瞄准导航算法和GPC控制器,视觉计算出期望航向角,GPC控制器跟踪该航向角,得到指令舵角;视觉导航算法可根据设定模仿人的视觉特征,根据距离的远近来跟踪期望的点,再根据自身的位置,可得出期望航向角;本发明利用GPC的多步预测、滚动优化、反馈校正的优势,设计一个GPC控制器,对由视觉输出的航向角进行跟踪,计算出船舶的指令舵角,实现对船舶轨迹的高精度跟踪。
Description
技术领域
本发明涉及本发明属于船舶轨迹跟踪控制领域,具体地说是一种高精度航迹跟踪控制方法。
背景技术
在船舶运动控制领域,船舶的高精度轨迹跟踪控制一直是重点研究的课题;船舶轨迹跟踪的核心是航向控制;视线法(LOS)导航算法作为一种经典的目标跟踪方法,是利用了点与点之间简单的几何关系判断可视性;它具有简单直观、参数整定容易、收敛性好的优点。该算法独立于动力学控制器,需要设计的参数少,期望航向的获取只与实际位置和给定轨迹有关,可以高效地获取期望航向角;但仅有LOS得到的航向角,只能使轨迹收敛于预设轨迹,而无法获得航行时需要的精确指令舵角,不能保证轨迹跟踪的精度。
对于高精度轨迹跟踪,其中最为关键的技术问题是航向控制。当前,控制技术和计算机技术发展迅速,但是在高精度轨迹跟踪方面缺乏相应的研究,在用先进控制方法做控制器实现高精度轨迹跟踪等方面缺乏相应的技术支撑和应用。
发明内容
本发明的目的在于克服以上所述的缺点,提供一种高精度轨迹跟踪控制方法。
为实现上述目的,本发明的具体方案如下:包括如下步骤,
a1、确定船舶的位置信息及舵角信息;
a2、将位置信息及舵角信息赋值于视线瞄准导航算法,通过视线瞄准导航算法得出期望航向角;
a3、包括一GPC控制器,通过确定的船舶位置信息及舵角信息以及期望航向角传输至GPC控制器;
a4、GPC控制器持续跟踪期望航向角得出指令舵角,实现高精度轨迹跟踪控制。
所述视线瞄准导航算法包括:
以坐标原点为起点,指向点(x,y)的射线在坐标平面上与x轴正方向的夹角为LOS角;定义四象限反正切计算,该角角度为arctan(y,x)∈(-π,π);地球坐标系下,假设船舶当前的位置为P=[x,y],LOS的位置为Plos=[xlos,ylos],利用船舶的位置和期望轨迹,计算获得期望航向;
LOS角具体为:
GPC控制器持续跟踪期望航向角得出指令舵角,具体方法如下:
a、根据已建立的船舶模型中多项式系数A和B,可得到预测输出:
其中ψ为航向,δ为舵角,e为外部白噪声,d+1为系统的纯滞后;
b、由下式递推计算p步航向预测输出,构成向量ψm:
其中k=1,…,p;p为预测步长;
c、实际操船要求航向近似于一阶惯性系统并逐步逼近设定值ψs;考虑系统的滞后,由下式递推计算p-d步参考轨迹,构成向量ψr,其中α为柔化系数,
d、取目标函数为:
J=min{(ψr-ψ)T(ψr-ψ)+λΔδTΔδ}
其中λ为加权系数;极小化目标函数得t时刻的命令舵角为:
δ(k)=δ(k-1)+Δδ
其中,
Δδ=(1,0,…,0)(GTG+λI)-1GT(ψr-ψm)
本发明的有益效果为:该方法是将船舶的位置和舵角分别反馈给视线瞄准导航算法和GPC控制器,视觉计算出期望航向角,GPC控制器跟踪该航向角,得到指令舵角;视觉导航算法可根据设定模仿人的视觉特征,根据距离的远近来跟踪期望的点,再根据自身的位置,可得出期望航向角;本发明利用GPC的多步预测、滚动优化、反馈校正的优势,设计一个GPC控制器,对由视觉输出的航向角进行跟踪,计算出船舶的指令舵角,实现对船舶轨迹的高精度跟踪。
附图说明
图1为本发明的控制过程示意图;
图2为本发明的LOS导航算法示意图;
图3为本发明的定半径的LOS导航算法示意图;
具体实施方式
下面结合附图和具体实施例对本发明作进一步详细的说明,并不是把本发明的实施范围局限于此。
如图1至图3所示,本实施例所述的一种高精度轨迹跟踪控制方法。
为实现上述目的,本发明的具体方案如下:包括如下步骤,
a1、确定船舶的位置信息及舵角信息;
a2、将位置信息及舵角信息赋值于视线瞄准导航算法,通过视线瞄准导航算法得出期望航向角;
a3、包括一GPC控制器,通过确定的船舶位置信息及舵角信息以及期望航向角传输至GPC控制器;
a4、GPC控制器持续跟踪期望航向角得出指令舵角,实现高精度轨迹跟踪控制。
视线瞄准导航算法包括,即los算法:
以坐标原点为起点,指向点(x,y)的射线在坐标平面上与x轴正方向的夹角为LOS角,定义四象限反正切计算,该角角度为arctan(y,x)∈(-π,π);地球坐标系下,假设船舶当前的位置为P=[x,y],LOS的位置为Plos=[xlos,ylos],利用船舶的位置和期望轨迹,计算获得期望航向;
LOS角具体为:
若LOS的位置位于前一个路点和后一个路点的连线间,如图3所示,图中 (xk,yk),(xk+1,yk+1)代表两个相邻的航路点,(x,y)代表船舶的当前位置。以(x,y)为圆心,R为半径(R=nLpp,Lpp为船长,n=2~5)画一条圆弧;当船舶靠近(xk,yk) 和(xk+1,yk+1)之间的轨迹段时,圆弧将与轨迹线相交于两点AB(ti),AF(ti),船舶位置(x,y)与AF(ti)之间的连线即是LOS,LOS与水平坐标X之间的夹角即是所求的船舶期望航向ψlos;按照期望航向跟踪虚拟点可以使船舶轨迹逐渐收敛至给定轨迹。在航向控制器的作用下,船舶以给定航速沿期望航向逐渐收敛至期望轨迹。
船舶沿当前轨迹跟踪完毕,需要一定的更新原则将期望轨迹切换至下一段轨迹,以达到连续跟踪给定轨迹的目的。当被控船舶的位置(x,y),满足如下关系时:
(xk+1-x)2+(yk+1-y)2≤R2
则需要将跟踪的当前期望航向点转换成下一个期望航向点,即:取k=k+1。利用船舶的位置和下一个期望航向点的数据计算出新的LOS角。
GPC控制器持续跟踪期望航向角得出指令舵角,具体方法如下:
a、根据已建立的船舶模型中多项式系数A和B,可得到预测输出:
其中ψ为航向,δ为舵角,e为外部白噪声,d+1为系统的纯滞后;
b、由下式递推计算p步航向预测输出,构成向量ψm:
其中k=1,…,p;p为预测步长;
c、实际操船要求航向近似于一阶惯性系统并逐步逼近设定值ψs;考虑系统的滞后,由下式递推计算p-d步参考轨迹,构成向量ψr,其中α为柔化系数,
d、取目标函数为:
J=min{(ψr-ψ)T(ψr-ψ)+λΔδTΔδ}
其中λ为加权系数;极小化目标函数得t时刻的命令舵角为:
δ(k)=δ(k-1)+Δδ
其中,
Δδ=(1,0,…,0)(GTG+λI)-1GT(ψr-ψm)
本发明的有益效果为,该方法是将船舶的位置和舵角分别反馈给视线瞄准导航算法和GPC控制器,视觉计算出期望航向角,GPC控制器跟踪该航向角,得到指令舵角;视觉导航算法可根据设定模仿人的视觉特征,根据距离的远近来跟踪期望的点,再根据自身的位置,可得出期望航向角;本发明利用GPC的多步预测、滚动优化、反馈校正的优势,设计一个GPC控制器,对由视觉输出的航向角进行跟踪,计算出船舶的指令舵角,实现对船舶轨迹的高精度跟踪。
以上所述仅是本发明的一个较佳实施例,故凡依本发明专利申请范围所述的构造、特征及原理所做的等效变化或修饰,包含在本发明专利申请的保护范围内。
Claims (3)
1.一种高精度轨迹跟踪控制方法,其特征在于:包括如下步骤,
a1、确定船舶的位置信息及舵角信息;
a2、将位置信息及舵角信息赋值于视线瞄准导航算法,通过视线瞄准导航算法得出期望航向角;
a3、包括一GPC控制器,通过确定的船舶位置信息及舵角信息以及期望航向角传输至GPC控制器;
a4、GPC控制器持续跟踪期望航向角得出指令舵角,实现高精度轨迹跟踪控制。
2.根据权利要求1所述的一种高精度轨迹跟踪控制方法,其特征在于:所述视线瞄准导航算法包括:
以坐标原点为起点,指向点(x,y)的射线在坐标平面上与x轴正方向的夹角为LOS角;定义四象限反正切计算,该角角度为arctan(y,x)∈(-π,π);地球坐标系下,假设船舶当前的位置为P=[x,y],LOS的位置为Plos=[xlos,ylos],利用船舶的位置和期望轨迹,计算获得期望航向;
LOS角具体为:
3.根据权利要求1所述的一种高精度轨迹跟踪控制方法,其特征在于:GPC控制器持续跟踪期望航向角得出指令舵角,具体方法如下:
a、根据已建立的船舶模型中多项式系数A和B,可得到预测输出:
其中ψ为航向,δ为舵角,e为外部白噪声,d+1为系统的纯滞后;
b、由下式递推计算p步航向预测输出,构成向量ψm:
其中k=1,…,p;p为预测步长;
c、实际操船要求航向近似于一阶惯性系统并逐步逼近设定值ψs;考虑系统的滞后,由下式递推计算p-d步参考轨迹,构成向量ψr,其中α为柔化系数,
d、取目标函数为:
J=min{(ψr-ψ)T(ψr-ψ)+λΔδTΔδ}
其中λ为加权系数;极小化目标函数得t时刻的命令舵角为:
δ(k)=δ(k-1)+Δδ
其中,
Δδ=(1,0,…,0)(GTG+λI)-1GT(ψr-ψm)
k=2,3,…;k1=min{k-1,n}。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811515571.3A CN109613918A (zh) | 2018-12-12 | 2018-12-12 | 一种高精度轨迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811515571.3A CN109613918A (zh) | 2018-12-12 | 2018-12-12 | 一种高精度轨迹跟踪控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109613918A true CN109613918A (zh) | 2019-04-12 |
Family
ID=66009116
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811515571.3A Pending CN109613918A (zh) | 2018-12-12 | 2018-12-12 | 一种高精度轨迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109613918A (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110426958A (zh) * | 2019-08-06 | 2019-11-08 | 大连海事大学 | 无人船艇航行控制方法、系统、存储介质及计算机设备 |
CN111077847A (zh) * | 2019-12-31 | 2020-04-28 | 武汉华中数控股份有限公司 | 多轴机床线性轴滚动角误差产生的刀具矢量误差补偿方法 |
CN112068550A (zh) * | 2020-08-11 | 2020-12-11 | 闽江学院 | 一种船舶航向跟踪控制的方法 |
CN113467250A (zh) * | 2021-07-27 | 2021-10-01 | 浙江中裕通信技术有限公司 | 基于北斗导航和数据驱动的船舶航向及其区域估计方法 |
CN113625725A (zh) * | 2021-09-02 | 2021-11-09 | 中国舰船研究设计中心 | 一种水面无人艇路径跟踪控制方法 |
CN113932816A (zh) * | 2021-11-16 | 2022-01-14 | 北京中科海讯数字科技股份有限公司 | 基于水声数据综合态势下的航迹优化方法 |
CN116736864A (zh) * | 2023-07-12 | 2023-09-12 | 北鲲睿航科技(上海)有限公司 | 一种自主航行控制方法及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1800781A (zh) * | 2004-12-30 | 2006-07-12 | 中国科学院自动化研究所 | 一种航迹自动舵控制系统及其方法 |
CN102298326A (zh) * | 2011-06-30 | 2011-12-28 | 哈尔滨工程大学 | 欠驱动auv自适应轨迹跟踪控制装置及控制方法 |
CN103645734A (zh) * | 2013-12-02 | 2014-03-19 | 广州市健坤网络科技发展有限公司 | 一种无舵船舶的自动化航向控制系统及方法 |
CN103777635A (zh) * | 2014-01-13 | 2014-05-07 | 哈尔滨工程大学 | 动力定位船舶鲁棒自适应航迹跟踪控制系统 |
CN103955218A (zh) * | 2014-04-28 | 2014-07-30 | 上海大学 | 一种基于非线性控制理论的无人艇轨迹跟踪控制装置及方法 |
CN105511464A (zh) * | 2015-12-01 | 2016-04-20 | 南京长峰航天电子科技有限公司 | 一种船舶自主航行控制系统及控制方法 |
-
2018
- 2018-12-12 CN CN201811515571.3A patent/CN109613918A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1800781A (zh) * | 2004-12-30 | 2006-07-12 | 中国科学院自动化研究所 | 一种航迹自动舵控制系统及其方法 |
CN102298326A (zh) * | 2011-06-30 | 2011-12-28 | 哈尔滨工程大学 | 欠驱动auv自适应轨迹跟踪控制装置及控制方法 |
CN103645734A (zh) * | 2013-12-02 | 2014-03-19 | 广州市健坤网络科技发展有限公司 | 一种无舵船舶的自动化航向控制系统及方法 |
CN103777635A (zh) * | 2014-01-13 | 2014-05-07 | 哈尔滨工程大学 | 动力定位船舶鲁棒自适应航迹跟踪控制系统 |
CN103955218A (zh) * | 2014-04-28 | 2014-07-30 | 上海大学 | 一种基于非线性控制理论的无人艇轨迹跟踪控制装置及方法 |
CN105511464A (zh) * | 2015-12-01 | 2016-04-20 | 南京长峰航天电子科技有限公司 | 一种船舶自主航行控制系统及控制方法 |
Non-Patent Citations (1)
Title |
---|
LIU HENGZHI等: "Research on Ship Trajectory Tracking with High Precision Based on LOS", 《INTERNATIONAL CONFERENCE ON ELECTRICAL ENGINEERING, CONTROL AND ROBOTICS(EECR 2018)》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110426958A (zh) * | 2019-08-06 | 2019-11-08 | 大连海事大学 | 无人船艇航行控制方法、系统、存储介质及计算机设备 |
CN111077847A (zh) * | 2019-12-31 | 2020-04-28 | 武汉华中数控股份有限公司 | 多轴机床线性轴滚动角误差产生的刀具矢量误差补偿方法 |
CN112068550A (zh) * | 2020-08-11 | 2020-12-11 | 闽江学院 | 一种船舶航向跟踪控制的方法 |
CN113467250A (zh) * | 2021-07-27 | 2021-10-01 | 浙江中裕通信技术有限公司 | 基于北斗导航和数据驱动的船舶航向及其区域估计方法 |
CN113467250B (zh) * | 2021-07-27 | 2022-01-07 | 浙江中裕通信技术有限公司 | 基于北斗导航和数据驱动的船舶航向及其区域估计方法 |
CN113625725A (zh) * | 2021-09-02 | 2021-11-09 | 中国舰船研究设计中心 | 一种水面无人艇路径跟踪控制方法 |
CN113932816A (zh) * | 2021-11-16 | 2022-01-14 | 北京中科海讯数字科技股份有限公司 | 基于水声数据综合态势下的航迹优化方法 |
CN113932816B (zh) * | 2021-11-16 | 2023-09-22 | 北京中科海讯数字科技股份有限公司 | 基于水声数据综合态势下的航迹优化方法 |
CN116736864A (zh) * | 2023-07-12 | 2023-09-12 | 北鲲睿航科技(上海)有限公司 | 一种自主航行控制方法及系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109613918A (zh) | 一种高精度轨迹跟踪控制方法 | |
CN106950955B (zh) | 基于改进los引导算法的船舶航迹控制方法 | |
CN109460043A (zh) | 一种基于多模态非奇异终端滑模船舶航迹自抗扰控制方法 | |
CN104960674B (zh) | 一种运动目标的指向跟踪控制方法 | |
CN105045284A (zh) | 一种抗干扰无人飞行器路径跟踪控制方法 | |
CN113126644B (zh) | 基于自适应视线法的无人机三维航迹跟踪方法 | |
US20180032077A1 (en) | Method for guiding and controlling drone using information for controlling camera of drone | |
CN107515617A (zh) | 一种固定翼无人机航线平滑切换控制方法 | |
Ji et al. | Time-varying sliding mode guidance scheme for maneuvering target interception with impact angle constraint | |
CN110032214B (zh) | 基于矢量场的快速Standoff目标跟踪方法 | |
CN104085539B (zh) | 成像定标的姿态控制方法 | |
CN110687931A (zh) | 一种方位角姿态与前置导引切换的一体化机动导引方法 | |
CN106598051B (zh) | 一种基于动力矢量的航迹控制方法 | |
Zhao et al. | Trajectory reshaping based guidance with impact time and angle constraints | |
CN108333944B (zh) | 基于框架角自适应调整的cmg操纵方法及系统 | |
CN108037523A (zh) | 一种应用于无人机的电子辅助波束对准方法 | |
CN112937918B (zh) | 一种基于强化学习的多约束下的卫星姿态机动规划方法 | |
Cheng et al. | Lyapunov-based switched-gain impact angle control guidance | |
CN113176788A (zh) | 一种基于变前向距离los制导律的飞行器路径跟踪方法 | |
CN111251303A (zh) | 一种周期性姿态调整的机器人运动控制方法 | |
CN116627033A (zh) | 基于自适应横程走廊的再入滑翔飞行器预测校正方法 | |
CN106919185B (zh) | 基于Dubins曲线的稳定平台位置伺服控制方法 | |
CN110109481A (zh) | 基于轨道变换法的多无人飞行器跟踪目标相角修正方法 | |
CN114200966B (zh) | 一种基于感知信息的无人航行器目标定方位等距跟踪方法 | |
CN107894778B (zh) | 一种基于相平面分析的飞行器大幅调姿控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190412 |