CN113219970A - 一种无人船向量场路径跟踪控制器及设计方法 - Google Patents

一种无人船向量场路径跟踪控制器及设计方法 Download PDF

Info

Publication number
CN113219970A
CN113219970A CN202110443952.0A CN202110443952A CN113219970A CN 113219970 A CN113219970 A CN 113219970A CN 202110443952 A CN202110443952 A CN 202110443952A CN 113219970 A CN113219970 A CN 113219970A
Authority
CN
China
Prior art keywords
path
unmanned ship
module
guidance
vector field
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.)
Granted
Application number
CN202110443952.0A
Other languages
English (en)
Other versions
CN113219970B (zh
Inventor
彭周华
古楠
李建众
王安青
刘陆
王浩亮
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Dalian Maritime University
Original Assignee
Dalian Maritime University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Dalian Maritime University filed Critical Dalian Maritime University
Priority to CN202110443952.0A priority Critical patent/CN113219970B/zh
Publication of CN113219970A publication Critical patent/CN113219970A/zh
Application granted granted Critical
Publication of CN113219970B publication Critical patent/CN113219970B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种无人船向量场路径跟踪控制器及设计方法，采用向量场方法，在期望路径周围生成空间矢量。基于产生的向量场空间矢量方向，给出了无人船制导航向信号。根据无人船位置及路径参数点位置信息，得到了无人船制导速度信号。在向量场作用下，无人船能够光滑的沿着场线运动，最终收敛到期望路径。本发明考虑了无人船的暂态控制性能，使无人船路径跟踪路线更加光滑，减小了无人船运动中的风险，降低了执行机构的压力，能够有效的降低船舶执行机构的成本。采用向量场的制导方法，可以得到更小的跟踪误差收敛效果，提高了无人船路径跟踪性能。

Description

一种无人船向量场路径跟踪控制器及设计方法
技术领域
本发明涉及无人船控制领域，尤其涉及一种无人船向量场路径跟踪控制器及设计方法。
背景技术
因海洋环境复杂多变且恶劣，海风与洋流等因素对船舶运动影响巨大，无人船的运动控制是无人船舶应用的一个难题，如何获得高效且可靠的无人船的路径跟踪控制器是科研人员致力于解决的问题。从控制器设计方面来看，现有无人船路径控制方法存在以下不足：
第一，在船舶路径跟踪的现有控制方法中未考虑无人船暂态性能，无法在无人船从一个稳定态到另一个稳定态的运动期间进行有效的船舶运动控制，导致跟踪路线不够光滑，在无人船路径跟踪控制中容易产生较大的超调和暂态振荡，致使无人船运动控制效率低下。
第二，在无人船路径跟踪现有的控制方法中如视距制导方法，其在控制无人船路径跟踪中容易产生较大的纵向跟踪误差，导致无人船实际航迹不能有效的跟踪到参考航迹，并且控制无人船跟踪时给定航迹时控制输入的不合理，造成了能源的浪费。
发明内容
本发明提供一种无人船向量场路径跟踪控制器及设计方法，以克服上述技术问题。
本发明一种无人船向量场路径跟踪控制器设计方法，包括：
建立无人船运动学模型；
根据设定的期望路径得到无人船期望路径的参数化信息；
根据设定的期望路径的参数化信息得到制导向量场信息；
根据所述无人船期望路径的给定位置信息与无人船的实际位置信息，得到无人船期望路径的位置与无人船的实际位置之间的路径误差；所述路径误差，包括：横向路径误差和纵向路径误差；
根据所述制导向量场信息与无人船的实际位置信息，得到无人船制导航向；
根据预先设定的期望速度及所述纵向路径误差，得到更新后的路径参数，并根据更新后的路径参数，得到更新后的所述无人船期望路径的位置信息；并根据所述更新后的所述无人船期望路径的位置信息，得到更新后的路径误差和无人船制导航向；
根据所述期望速度和更新后的纵向路径误差，得到无人船制导前向速度；
在向量场作用下，无人船通过所述更新后的无人船制导航向和无人船制导前向速度，沿期望路径运动。
进一步地，所述建立无人船运动学模型，包括：
所述无人船运动学模型，表示为：
Figure BDA0003036173170000021
式中，
Figure BDA0003036173170000022
分别代表欠驱动无人船在地球坐标系下的x轴、y轴上的位置以及艏摇角；
Figure BDA0003036173170000023
分别代表欠驱动无人船在船体坐标系下的纵荡速度、横漂速度和艏摇角速度。
进一步地，所述根据设定的期望路径得到无人船期望路径的参数化信息，包括：
通过式(2)得到所述无人船期望路径的参数化信息pd，pd＝[X Y]T；
Figure BDA0003036173170000024
式中，X为欠驱动无人船所要跟踪的参考路径的横坐标，Y为欠驱动无人船所要跟踪的参考路径的纵坐标；函数f1与函数f2为将参考路径参数化的函数；θ为路径参数。
进一步地，所述根据所述无人船期望路径的给定位置信息与无人船的实际位置信息得到无人船期望路径的位置与无人船的实际位置之间的路径误差，包括：
由式(3)得到无人船期望路径的位置的切线角度为：
Figure BDA0003036173170000025
得到旋转矩阵表示为：
Figure BDA0003036173170000031
无人船的实际位置表示为：
p＝[x y]T (5)
根据无人船期望路径的位置与无人船的实际位置得到的路径误差的矩阵表示为：
e＝RT(p-pd) (6)
式中，p为无人船的实际位置，e为路径误差矩阵；f′1(θ)为f1(θ)对θ的偏导数，f′2(θ)为f2(θ)对θ的偏导数，偏导数公式为
Figure BDA0003036173170000032
与
Figure BDA0003036173170000033
Figure BDA0003036173170000034
RT为旋转矩阵R的转置；atan2为计算f′1(θ)+f′2(θ)i的辅角。
进一步地，所述根据所述制导向量场信息与无人船的实际位置信息，得到无人船制导航向，包括：
制导向量场表示为：
Figure BDA0003036173170000035
式中，F为二维向量场函数，φ1(x，y，θ)＝x-f1(θ)，φ2(x，y，θ)＝y-f2(θ)，k1，k2均为正常数，φ1、φ2是向量场里的参数信息，没有具体意义；
通过式(8)计算求得无人船制导航向ψd表示为：
ψd＝atan2(F(2)，F(1)) (8)
式中，F(1)代表制导向量场的第一维，F(2)代表制导向量场的第二维。
进一步地，所述根据预先设定的期望速度及所述纵向路径误差，得到更新后的路径参数，包括：
通过式(9)计算路径参数θ的导数
Figure BDA0003036173170000036
表示为：
Figure BDA0003036173170000037
式中，vs为预先设定的期望速度，k3为正的常数，tanh为双曲正切函数，e(1)为通过误差矩阵得到的第一维路径误差，即纵向路径误差。
进一步地，所述根据所述期望速度和更新后的纵向路径误差，得到无人船制导前向速度，包括：
通过式(10)计算无人船制导前向速度ud，表示为：
Figure BDA0003036173170000038
式中，k4为正的常数。
一种无人船向量场路径跟踪控制器，用于在向量场作用下，得到无人船制导航向和制导前向速度，并发送至无人船，使得无人船沿期望路径运动，包括：参考路径模块、路径误差模块、制导向量场模块、路径参数更新模块及制导前向速度模块；所述参考路径模块的输入端与所述路径参数更新模块相连，输出端分别与所述路径误差模块和制导向量场模块相连；所述路径误差模块的输入端与所述参考路径模块和无人船相连，输出端与所述路径参数更新模块和所述制导前向速度模块相连；所述制导向量场模块的输入端与所述参考路径模块和无人船相连，输出端与无人船相连；所述路径参数更新模块的输入端与路径误差模块的输出端相连，输出端与所述参考路径模块的输入端相连；所述制导前向速度模块的输入端与所述路径误差模块相连，输出端与无人船相连；所述参考路径模块，用于根据所述路径参数更新模块输入的路径参数，得到无人船期望路径的位置信息；所述路径误差模块，用于根据所述无人船期望路径的位置信息与无人船的实际位置信息，得到无人船期望路径的位置与无人船的实际位置之间的路径误差；所述路径误差，包括：横向路径误差和纵向路径误差；所述制导向量场模块，用于根据所述无人船期望路径的位置信息与无人船的实际位置信息，得到无人船制导航向；所述路径参数更新模块，用于根据预先设定的期望速度及所述纵向路径误差，得到更新后的路径参数并发送所述参考路径模块；所述制导前向速度模块，用于通过所述期望速度、纵向路径误差，得到无人船制导前向速度。
本发明采用向量场方法，在期望路径周围生成空间矢量。基于产生的向量场空间矢量方向，给出了无人船制导航向信号。根据无人船位置及路径参数点位置信息，得到了无人船制导前向速度信号。在向量场作用下，无人船能够光滑的沿着场线运动，最终收敛到期望路径。本发明考虑了无人船的暂态控制性能，使无人船路径跟踪路线更加光滑，减小了无人船运动中的风险，降低了执行机构的压力，能够有效的降低船舶执行机构的成本，让船舶的设计、生产更加容易。采用向量场的制导方法，可以得到更小的纵向跟踪误差收敛效果，提高了无人船路径跟踪性能。另外，在路径跟踪控制过程中所需的控制输入更合理，在无人船应用中可以更加节省能源。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作以简单地介绍，显而易见地，下面描述中的附图是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
图1为一种无人船向量场路径跟踪控制器结构示意图；
图2为仿真试验中的欠驱动无人船路径跟踪图；
图3为仿真试验中的欠驱动无人船路径跟踪误差图；
图4为仿真试验中的路径跟踪向量场；
图5为仿真试验中的欠驱动无人船路径参数更新图；
图6为仿真试验中的欠驱动无人船航向跟踪效果图；
图7为仿真试验中的欠驱动无人船航速跟踪效果图；
图8为一种无人船向量场路径跟踪控制器设计方法流程图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
如图8所示，本实施例提供了一种无人船向量场路径跟踪控制器设计方法，包括：
101、建立无人船运动学模型；
具体而言，无人船运动学模型，表示为：
Figure BDA0003036173170000051
式中，
Figure BDA0003036173170000052
分别代表欠驱动无人船在地球坐标系下的x轴、y轴上的位置以及艏摇角；
Figure BDA0003036173170000053
分别代表欠驱动无人船在船体坐标系下的纵荡速度、横漂速度和艏摇角速度。
102、根据设定的期望路径得到无人船期望路径的参数化信息；
具体而言，设定的参数如下：
k1＝1，k2＝1，vS＝1，k3＝10，k4＝5
初始路径参数为：
f1(θ)＝0.5θ，f2(θ)＝0.5θ
通过式(2)得到无人船期望路径的参数化信息pd，pd＝[X Y]T；
Figure BDA0003036173170000061
式中，X为欠驱动无人船所要跟踪的参考路径的横坐标，Y为欠驱动无人船所要跟踪的参考路径的纵坐标；函数f1与函数f2为将参考路径参数化的函数；θ为路径参数。
103、根据设定的期望路径的参数化信息得到制导向量场信息；
具体而言，制导向量场表示为：
Figure BDA0003036173170000062
式中，F为二维向量场函数，φ1(x，y，θ)＝x-f1(θ)，φ2(x，y，θ)＝y-f2(θ)，k1，k2均为正常数，φ1、φ2是向量场里的参数信息，没有具体意义；
104、根据无人船期望路径的给定位置信息与无人船的实际位置信息，得到无人船期望路径的位置与无人船的实际位置之间的路径误差；路径误差，包括：横向路径误差和纵向路径误差；
具体而言，由式(3)得到无人船期望路径的位置的切线角度为：
Figure BDA0003036173170000063
得到旋转矩阵表示为：
Figure BDA0003036173170000064
无人船的实际位置表示为：
p＝[x y]T (6)
根据无人船期望路径的位置与无人船的实际位置得到的路径误差的矩阵表示为：
e＝RT(p-pd) (7)
式中，p为无人船的实际位置，e为路径误差矩阵；f′1(θ)为f1(θ)对θ的偏导数，f′2(θ)为f2(θ)对θ的偏导数，偏导数公式为
Figure BDA0003036173170000065
与
Figure BDA0003036173170000066
RT为旋转矩阵R的转置；atan2为计算f′1(θ)+f′2(θ)i的辅角。路径误差的矩阵包括二维数据，即横向路径误差和纵向路径误差。
105、根据制导向量场信息与无人船的实际位置信息，得到无人船制导航向；
具体而言，通过式(8)计算求得无人船制导航向ψd表示为：
ψd＝atan2(F(2)，F(1)) (8)
式中，F(1)代表制导向量场的第一维，F(2)代表制导向量场的第二维。
106、根据预先设定的期望速度及纵向路径误差，得到更新后的路径参数，并根据更新后的路径参数，得到更新后的无人船期望路径的位置信息；并根据更新后的无人船期望路径的位置信息，得到更新后的路径误差和无人船制导航向；
具体而言，通过式(9)计算路径参数θ的导数
Figure BDA0003036173170000071
表示为：
Figure BDA0003036173170000072
式中，vs为预先设定的期望速度，k3为正的常数，tanh为双曲正切函数，e(1)为通过误差矩阵得到的第一维路径误差，即纵向路径误差。
得到路径参数的导数
Figure BDA0003036173170000073
后，将更新后的路径参数θ代入式(2)中重新计算无人船给定路径的位置信息，然后再通过式(3)-(8)计算得到更新后的路径误差和无人船制导航向。
107、根据期望速度和更新后的纵向路径误差，得到无人船制导前向速度；
具体而言，通过式(10)计算无人船前向速度ud，表示为：
Figure BDA0003036173170000074
式中，k4为正的常数。
108、在向量场作用下，无人船通过更新后的无人船制导航向和无人船制导前向速度，沿期望路径运动。
如图1所示，本实施例提供了一种无人船向量场路径跟踪控制器，用于在向量场作用下，得到无人船制导航向和前向速度，并发送至无人船，使得无人船沿期望路径运动，包括：参考路径模块、路径误差模块、制导向量场模块、路径参数更新模块及制导前向速度模块；参考路径模块的输入端与路径参数更新模块相连，输出端分别与路径误差模块和制导向量场模块相连；路径误差模块的输入端与参考路径模块和无人船相连，输出端与路径参数更新模块和制导前向速度模块相连；制导向量场模块的输入端与参考路径模块和无人船相连，输出端与无人船相连；路径参数更新模块的输入端与误差模块的输出端相连，输出端与参考路径模块的输入端相连；制导前向速度模块的输入端与路径误差模块相连，输出端与无人船相连；参考路径模块，用于根据路径参数更新模块输入的路径参数，得到无人船期望路径的位置信息；路径误差模块，用于根据无人船期望路径的位置信息与无人船的实际位置信息，得到无人船期望路径的位置与无人船的实际位置之间的路径误差；路径误差，包括：横向路径误差和纵向路径误差；制导向量场模块，用于根据无人船期望路径的位置信息与无人船的实际位置信息，得到无人船制导航向；路径参数更新模块，用于根据预先设定的期望速度及纵向路径误差，得到更新后的路径参数并发送参考路径模块；制导前向速度模块，用于通过期望速度、纵向路径误差，得到无人船制导前向速度。
仿真试验：
仿真结果如图2-图7所示。图2是无人船在向量场路径跟踪中的运动轨迹，图2中的细虚线为给定的参考路径，粗实线为无人船的实际运动轨迹。从图2中可以看出无人船在一定距离以后跟踪上了给定的参数化路径，并在一定时间后有着较好的跟踪效果。图3是无人船在向量场路径跟踪中的路径跟踪误差图，图3中的粗实线为横坐标y的误差，细虚线为纵坐标x的误差，图3中可以看出跟踪误差快速收敛至零并保持，仅在船舶初始调整位置时跟踪误差会有一些波动。图4是无人船在向量场路径跟踪中的向量场图，图4中的粗虚线为虚拟参考路径，图4中的黑色箭头为向量场方向，图4中为虚拟参考点在(2.5 2.5)处时的向量场图。图5显示的是无人船在向量场路径跟踪中的路径参数更新图，图5中可以看出随着时间的路径参数θ更新平稳。图6是无人船在向量场路径跟踪中的航向跟踪效果图，图6中粗虚线为参考航向，细实线为实际航向，可以看出无人船舶的航向可以短时间内很好的跟踪到给定航向。图7是无人船在向量场路径跟踪中的航速跟踪效果图，图7中粗虚线为参考航速，细实线为实际航速，可以看出无人船舶的航速可以在短时间内很好的跟踪到给定航速。
最后应说明的是：以上各实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述各实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分或者全部技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。

Claims (8)

1.一种无人船向量场路径跟踪控制器设计方法，其特征在于，包括：
建立无人船运动学模型；
根据设定的期望路径得到无人船期望路径的参数化信息；
根据设定的期望路径的参数化信息得到制导向量场信息；
根据所述无人船期望路径的给定位置信息与无人船的实际位置信息，得到无人船期望路径的位置与无人船的实际位置之间的路径误差；所述路径误差，包括：横向路径误差和纵向路径误差；
根据所述制导向量场信息与无人船的实际位置信息，得到无人船制导航向；
根据预先设定的期望速度及所述纵向路径误差，得到更新后的路径参数，并根据更新后的路径参数，得到更新后的所述无人船期望路径的位置信息；并根据所述更新后的所述无人船期望路径的位置信息，得到更新后的路径误差和无人船制导航向；
根据所述期望速度和更新后的纵向路径误差，得到无人船制导前向速度；
在向量场作用下，无人船通过所述更新后的无人船制导航向和无人船制导前向速度，沿期望路径运动。
2.根据权利要求1所述的一种无人船向量场路径跟踪控制器设计方法，其特征在于，所述建立无人船运动学模型，包括：
所述无人船运动学模型，表示为：
Figure FDA0003036173160000011
式中，
Figure FDA0003036173160000012
分别代表欠驱动无人船在地球坐标系下的x轴、y轴上的位置以及艏摇角；
Figure FDA0003036173160000013
分别代表欠驱动无人船在船体坐标系下的纵荡速度、横漂速度和艏摇角速度。
3.根据权利要求2所述的一种无人船向量场路径跟踪控制器设计方法，其特征在于，所述根据设定的期望路径得到无人船期望路径的参数化信息，包括：
通过式(2)得到所述无人船期望路径的参数化信息pd，pd＝[X Y]T；
Figure FDA0003036173160000021
式中，X为欠驱动无人船所要跟踪的参考路径的横坐标，Y为欠驱动无人船所要跟踪的参考路径的纵坐标；函数f1与函数f2为将参考路径参数化的函数；θ为路径参数。
4.根据权利要求3所述的一种无人船向量场路径跟踪控制器设计方法，其特征在于，所述根据所述无人船期望路径的给定位置信息与无人船的实际位置信息，得到无人船期望路径的位置与无人船的实际位置之间的路径误差，包括：
由式(3)得到无人船期望路径的位置的切线角度为：
Figure FDA0003036173160000022
得到旋转矩阵表示为：
Figure FDA0003036173160000023
无人船的实际位置表示为：
p＝[x y]T (5)
根据无人船期望路径的位置与无人船的实际位置得到的路径误差的矩阵表示为：
e＝RT(p-pd) (6)
式中，p为无人船的实际位置，e为路径误差矩阵；f′1(θ)为f1(θ)对θ的偏导数，f′2(θ)为f2(θ)对θ的偏导数，偏导数公式为
Figure FDA0003036173160000024
与
Figure FDA0003036173160000025
Figure FDA0003036173160000026
RT为旋转矩阵R的转置；atan2为计算f′1(θ)+f′2(θ)i的辅角。
5.根据权利要求4所述的一种无人船向量场路径跟踪控制器设计方法，其特征在于，所述根据所述制导向量场信息与无人船的实际位置信息，得到无人船制导航向，包括：
制导向量场表示为：
Figure FDA0003036173160000027
式中，F为二维向量场函数，φ1(x,y,θ)＝x-f1(θ)，φ2(x,y,θ)＝y-f2(θ)，k1,k2均为正常数，φ1、φ2是向量场里的参数信息，没有具体意义；
通过式(8)计算求得无人船制导航向ψd表示为：
ψd＝atan2(F(2),F(1)) (8)
式中，F(1)代表制导向量场的第一维，F(2)代表制导向量场的第二维。
6.根据权利要求5所述的一种无人船向量场路径跟踪控制器设计方法，其特征在于，所述根据预先设定的期望速度及所述纵向路径误差，得到更新后的路径参数，包括：
通过式(9)计算路径参数θ的导数
Figure FDA0003036173160000031
表示为：
Figure FDA0003036173160000032
式中，vs为预先设定的期望速度，k3为正的常数，tanh为双曲正切函数，e(1)为通过误差矩阵得到的第一维路径误差，即纵向路径误差。
7.根据权利要求6所述的一种无人船向量场路径跟踪控制器设计方法，其特征在于，所述根据所述期望速度和更新后的纵向路径误差，得到无人船制导前向速度，包括：
通过式(10)计算无人船制导前向速度ud，表示为：
Figure FDA0003036173160000033
式中，k4为正的常数。
8.一种无人船向量场路径跟踪控制器，用于在向量场作用下，得到无人船制导航向和前向速度，并发送至无人船，使得无人船沿期望路径运动，其特征在于，包括：
参考路径模块、路径误差模块、制导向量场模块、路径参数更新模块及制导前向速度模块；
所述参考路径模块的输入端与所述路径参数更新模块相连，输出端分别与所述路径误差模块和制导向量场模块相连；所述路径误差模块的输入端与所述参考路径模块和无人船相连，输出端与所述路径参数更新模块和所述制导前向速度模块相连；所述制导向量场模块的输入端与所述参考路径模块和无人船相连，输出端与无人船相连；所述路径参数更新模块的输入端与路径误差模块的输出端相连，输出端与所述参考路径模块的输入端相连；所述制导前向速度模块的输入端与所述路径误差模块相连，输出端与无人船相连；
所述参考路径模块，用于根据所述路径参数更新模块输入的路径参数，得到无人船期望路径的位置信息；
所述路径误差模块，用于根据所述无人船期望路径的位置信息与无人船的实际位置信息，得到无人船期望路径的位置与无人船的实际位置之间的路径误差；所述路径误差，包括：横向路径误差和纵向路径误差；
所述制导向量场模块，用于根据所述无人船期望路径的位置信息与无人船的实际位置信息，得到无人船制导航向；
所述路径参数更新模块，用于根据预先设定的期望速度及所述纵向路径误差，得到更新后的路径参数并发送所述参考路径模块；
所述制导前向速度模块，用于通过所述期望速度、纵向路径误差，得到无人船制导前向速度。
CN202110443952.0A 2021-04-23 2021-04-23 一种无人船向量场路径跟踪控制器及设计方法 Active CN113219970B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110443952.0A CN113219970B (zh) 2021-04-23 2021-04-23 一种无人船向量场路径跟踪控制器及设计方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110443952.0A CN113219970B (zh) 2021-04-23 2021-04-23 一种无人船向量场路径跟踪控制器及设计方法

Publications (2)

Publication Number Publication Date
CN113219970A true CN113219970A (zh) 2021-08-06
CN113219970B CN113219970B (zh) 2023-11-03

Family

ID=77088565

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110443952.0A Active CN113219970B (zh) 2021-04-23 2021-04-23 一种无人船向量场路径跟踪控制器及设计方法

Country Status (1)

Country Link
CN (1) CN113219970B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113581388A (zh) * 2021-08-30 2021-11-02 广东工业大学 一种环保作业的无人艇控制方法及应用其的无人艇系统
CN115494848A (zh) * 2022-09-30 2022-12-20 大连海事大学 一种规避动静态障碍物的无人船路径跟踪视距制导方法及系统

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105045284A (zh) * 2015-09-21 2015-11-11 北京天航华创科技股份有限公司 一种抗干扰无人飞行器路径跟踪控制方法
KR20160047026A (ko) * 2014-10-21 2016-05-02 서울대학교산학협력단 곡선의 미분 기하에 기반한 3차원 비선형 경로 추종 유도 시스템 및 방법
CN106444822A (zh) * 2016-03-30 2017-02-22 北京航空航天大学 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法
EP3287862A1 (en) * 2016-08-25 2018-02-28 Imotec Holding B.V. Method for steering an underactuated ship
CN108303988A (zh) * 2018-03-28 2018-07-20 大连海事大学 一种无人船的目标识别追踪系统及其工作方法
CN207908979U (zh) * 2018-03-28 2018-09-25 大连海事大学 一种无人船的目标识别追踪系统
CN108803612A (zh) * 2018-06-27 2018-11-13 青岛黄海学院 一种海流影响下的无人巡检船直线航迹跟踪实现方法
CN109358499A (zh) * 2018-09-25 2019-02-19 大连海事大学 基于速度与航向双重制导的无人船精确路径跟踪控制方法
CN110032214A (zh) * 2019-04-17 2019-07-19 中国人民解放军海军航空大学 基于矢量场的快速Standoff目标跟踪方法
CN112612268A (zh) * 2020-12-10 2021-04-06 武汉轻工大学 路径跟踪的控制方法、装置、设备及存储介质

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20160047026A (ko) * 2014-10-21 2016-05-02 서울대학교산학협력단 곡선의 미분 기하에 기반한 3차원 비선형 경로 추종 유도 시스템 및 방법
CN105045284A (zh) * 2015-09-21 2015-11-11 北京天航华创科技股份有限公司 一种抗干扰无人飞行器路径跟踪控制方法
CN106444822A (zh) * 2016-03-30 2017-02-22 北京航空航天大学 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法
EP3287862A1 (en) * 2016-08-25 2018-02-28 Imotec Holding B.V. Method for steering an underactuated ship
CN108303988A (zh) * 2018-03-28 2018-07-20 大连海事大学 一种无人船的目标识别追踪系统及其工作方法
CN207908979U (zh) * 2018-03-28 2018-09-25 大连海事大学 一种无人船的目标识别追踪系统
CN108803612A (zh) * 2018-06-27 2018-11-13 青岛黄海学院 一种海流影响下的无人巡检船直线航迹跟踪实现方法
CN109358499A (zh) * 2018-09-25 2019-02-19 大连海事大学 基于速度与航向双重制导的无人船精确路径跟踪控制方法
CN110032214A (zh) * 2019-04-17 2019-07-19 中国人民解放军海军航空大学 基于矢量场的快速Standoff目标跟踪方法
CN112612268A (zh) * 2020-12-10 2021-04-06 武汉轻工大学 路径跟踪的控制方法、装置、设备及存储介质

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
ZHI LI: "Vector field path following control for unmanned surface vehicles", 《OCEANS》, pages 1 - 9 *
赵述龙: "固定翼无人机曲线路径跟踪的积分向量场方法", 《国防科技大学学报》, vol. 40, no. 2, pages 119 - 124 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113581388A (zh) * 2021-08-30 2021-11-02 广东工业大学 一种环保作业的无人艇控制方法及应用其的无人艇系统
CN115494848A (zh) * 2022-09-30 2022-12-20 大连海事大学 一种规避动静态障碍物的无人船路径跟踪视距制导方法及系统
CN115494848B (zh) * 2022-09-30 2024-05-03 大连海事大学 一种规避动静态障碍物的无人船路径跟踪视距制导方法及系统

Also Published As

Publication number Publication date
CN113219970B (zh) 2023-11-03

Similar Documents

Publication Publication Date Title
CN111487966B (zh) 一种基于航路点的水面无人艇自适应路径跟踪控制方法
CN108073175B (zh) 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法
CN113219970A (zh) 一种无人船向量场路径跟踪控制器及设计方法
US6246929B1 (en) Enhanced stall and recovery control system
CN110716566B (zh) 一种欠驱动无人艇的有限时间轨迹跟踪控制方法
CN111352341B (zh) 一种船舶航行控制在线自适应调节系统及方法
Yang et al. An improved stanley guidance law for large curvature path following of unmanned surface vehicle
EP4068042B1 (en) Recovery control method and apparatus for rocket, electronic device and storage medium
CN104765370A (zh) 有环境干扰下考虑侧滑角的uuv航迹视线导引法
CN106444822A (zh) 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法
CN112987771B (zh) 基于多端口输出误差触发机制的机帆船路径跟踪控制方法
CN115390564A (zh) 用于欠驱动水面无人船舶的编队控制方法、介质及设备
CN115113524A (zh) 一种基于干预lvs制导的asv多端口事件触发路径跟踪控制方法
Repoulias et al. Trajectory planning and tracking control of underactuated AUVs
CN114527744B (zh) 基于天牛须搜索优化的无人帆船路径跟踪制导方法
CN115079698A (zh) 欺骗攻击任务下的无人水面船路径跟踪时间触发控制方法
CN113110527B (zh) 一种自主水下航行器有限时间路径跟踪的级联控制方法
CN113359737A (zh) 一种考虑队形伸缩的船舶编队自适应事件触发控制方法
CN111650932B (zh) 无人艇折线航迹跟踪控制方法、控制器以及无人艇
CN116301058B (zh) 一种无人飞行反馈非线性偏航控制方法、系统和设备
JP2008213682A (ja) 船舶用自動操舵装置
JP2021167131A (ja) 船体位置保持装置
JP2021167132A (ja) 船体位置保持装置
CN112764432B (zh) 一种无人艇航迹跟踪系统及方法
CN114047743A (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
GR01 Patent grant
GR01 Patent grant