CN113219970B - 一种无人船向量场路径跟踪控制器及设计方法 - Google Patents
一种无人船向量场路径跟踪控制器及设计方法 Download PDFInfo
- Publication number
- CN113219970B CN113219970B CN202110443952.0A CN202110443952A CN113219970B CN 113219970 B CN113219970 B CN 113219970B CN 202110443952 A CN202110443952 A CN 202110443952A CN 113219970 B CN113219970 B CN 113219970B
- Authority
- CN
- China
- Prior art keywords
- path
- unmanned ship
- guidance
- vector field
- module
- 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.)
- Active
Links
- 239000013598 vector Substances 0.000 title claims abstract description 88
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000013461 design Methods 0.000 title claims abstract description 10
- 230000009471 action Effects 0.000 claims abstract description 5
- 101150080778 INPP5D gene Proteins 0.000 claims description 219
- 239000011159 matrix material Substances 0.000 claims description 16
- 238000004364 calculation method Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 claims description 4
- 230000005669 field effect Effects 0.000 claims description 3
- 230000000694 effects Effects 0.000 abstract description 7
- 230000007246 mechanism Effects 0.000 abstract description 4
- 230000001052 transient effect Effects 0.000 abstract description 4
- 238000004088 simulation Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 7
- 238000012360 testing method Methods 0.000 description 6
- 230000007547 defect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 239000002699 waste material Substances 0.000 description 1
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
技术领域
本发明涉及无人船控制领域,尤其涉及一种无人船向量场路径跟踪控制器及设计方法。
背景技术
因海洋环境复杂多变且恶劣,海风与洋流等因素对船舶运动影响巨大,无人船的运动控制是无人船舶应用的一个难题,如何获得高效且可靠的无人船的路径跟踪控制器是科研人员致力于解决的问题。从控制器设计方面来看,现有无人船路径控制方法存在以下不足:
第一,在船舶路径跟踪的现有控制方法中未考虑无人船暂态性能,无法在无人船从一个稳定态到另一个稳定态的运动期间进行有效的船舶运动控制,导致跟踪路线不够光滑,在无人船路径跟踪控制中容易产生较大的超调和暂态振荡,致使无人船运动控制效率低下。
第二,在无人船路径跟踪现有的控制方法中如视距制导方法,其在控制无人船路径跟踪中容易产生较大的纵向跟踪误差,导致无人船实际航迹不能有效的跟踪到参考航迹,并且控制无人船跟踪时给定航迹时控制输入的不合理,造成了能源的浪费。
发明内容
本发明提供一种无人船向量场路径跟踪控制器及设计方法,以克服上述技术问题。
本发明一种无人船向量场路径跟踪控制器设计方法,包括:
建立无人船运动学模型;
根据设定的期望路径得到无人船期望路径的参数化信息;
根据设定的期望路径的参数化信息得到制导向量场信息;
根据所述无人船期望路径的给定位置信息与无人船的实际位置信息,得到无人船期望路径的位置与无人船的实际位置之间的路径误差;所述路径误差,包括:横向路径误差和纵向路径误差;
根据所述制导向量场信息与无人船的实际位置信息,得到无人船制导航向;
根据预先设定的期望速度及所述纵向路径误差,得到更新后的路径参数,并根据更新后的路径参数,得到更新后的所述无人船期望路径的位置信息;并根据所述更新后的所述无人船期望路径的位置信息,得到更新后的路径误差和无人船制导航向;
根据所述期望速度和更新后的纵向路径误差,得到无人船制导前向速度;
在向量场作用下,无人船通过所述更新后的无人船制导航向和无人船制导前向速度,沿期望路径运动。
进一步地,所述建立无人船运动学模型,包括:
所述无人船运动学模型,表示为:
式中,分别代表欠驱动无人船在地球坐标系下的x轴、y轴上的位置以及艏摇角;/>分别代表欠驱动无人船在船体坐标系下的纵荡速度、横漂速度和艏摇角速度。
进一步地,所述根据设定的期望路径得到无人船期望路径的参数化信息,包括:
通过式(2)得到所述无人船期望路径的参数化信息pd,pd=[X Y]T;
式中,X为欠驱动无人船所要跟踪的参考路径的横坐标,Y为欠驱动无人船所要跟踪的参考路径的纵坐标;函数f1与函数f2为将参考路径参数化的函数;θ为路径参数。
进一步地,所述根据所述无人船期望路径的给定位置信息与无人船的实际位置信息得到无人船期望路径的位置与无人船的实际位置之间的路径误差,包括:
由式(3)得到无人船期望路径的位置的切线角度为:
得到旋转矩阵表示为:
无人船的实际位置表示为:
p=[x y]T (5)
根据无人船期望路径的位置与无人船的实际位置得到的路径误差的矩阵表示为:
e=RT(p-pd) (6)
式中,p为无人船的实际位置,e为路径误差矩阵;f′1(θ)为f1(θ)对θ的偏导数,f′2(θ)为f2(θ)对θ的偏导数,偏导数公式为与/> RT为旋转矩阵R的转置;atan2为计算f′1(θ)+f′2(θ)i的辅角。
进一步地,所述根据所述制导向量场信息与无人船的实际位置信息,得到无人船制导航向,包括:
制导向量场表示为:
式中,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)计算路径参数θ的导数表示为:
式中,vs为预先设定的期望速度,k3为正的常数,tanh为双曲正切函数,e(1)为通过误差矩阵得到的第一维路径误差,即纵向路径误差。
进一步地,所述根据所述期望速度和更新后的纵向路径误差,得到无人船制导前向速度,包括:
通过式(10)计算无人船制导前向速度ud,表示为:
式中,k4为正的常数。
一种无人船向量场路径跟踪控制器,用于在向量场作用下,得到无人船制导航向和制导前向速度,并发送至无人船,使得无人船沿期望路径运动,包括:参考路径模块、路径误差模块、制导向量场模块、路径参数更新模块及制导前向速度模块;所述参考路径模块的输入端与所述路径参数更新模块相连,输出端分别与所述路径误差模块和制导向量场模块相连;所述路径误差模块的输入端与所述参考路径模块和无人船相连,输出端与所述路径参数更新模块和所述制导前向速度模块相连;所述制导向量场模块的输入端与所述参考路径模块和无人船相连,输出端与无人船相连;所述路径参数更新模块的输入端与路径误差模块的输出端相连,输出端与所述参考路径模块的输入端相连;所述制导前向速度模块的输入端与所述路径误差模块相连,输出端与无人船相连;所述参考路径模块,用于根据所述路径参数更新模块输入的路径参数,得到无人船期望路径的位置信息;所述路径误差模块,用于根据所述无人船期望路径的位置信息与无人船的实际位置信息,得到无人船期望路径的位置与无人船的实际位置之间的路径误差;所述路径误差,包括:横向路径误差和纵向路径误差;所述制导向量场模块,用于根据所述无人船期望路径的位置信息与无人船的实际位置信息,得到无人船制导航向;所述路径参数更新模块,用于根据预先设定的期望速度及所述纵向路径误差,得到更新后的路径参数并发送所述参考路径模块;所述制导前向速度模块,用于通过所述期望速度、纵向路径误差,得到无人船制导前向速度。
本发明采用向量场方法,在期望路径周围生成空间矢量。基于产生的向量场空间矢量方向,给出了无人船制导航向信号。根据无人船位置及路径参数点位置信息,得到了无人船制导前向速度信号。在向量场作用下,无人船能够光滑的沿着场线运动,最终收敛到期望路径。本发明考虑了无人船的暂态控制性能,使无人船路径跟踪路线更加光滑,减小了无人船运动中的风险,降低了执行机构的压力,能够有效的降低船舶执行机构的成本,让船舶的设计、生产更加容易。采用向量场的制导方法,可以得到更小的纵向跟踪误差收敛效果,提高了无人船路径跟踪性能。另外,在路径跟踪控制过程中所需的控制输入更合理,在无人船应用中可以更加节省能源。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作以简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为一种无人船向量场路径跟踪控制器结构示意图;
图2为仿真试验中的欠驱动无人船路径跟踪图;
图3为仿真试验中的欠驱动无人船路径跟踪误差图;
图4为仿真试验中的路径跟踪向量场;
图5为仿真试验中的欠驱动无人船路径参数更新图;
图6为仿真试验中的欠驱动无人船航向跟踪效果图;
图7为仿真试验中的欠驱动无人船航速跟踪效果图;
图8为一种无人船向量场路径跟踪控制器设计方法流程图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图8所示,本实施例提供了一种无人船向量场路径跟踪控制器设计方法,包括:
101、建立无人船运动学模型;
具体而言,无人船运动学模型,表示为:
式中,分别代表欠驱动无人船在地球坐标系下的x轴、y轴上的位置以及艏摇角;/>分别代表欠驱动无人船在船体坐标系下的纵荡速度、横漂速度和艏摇角速度。
102、根据设定的期望路径得到无人船期望路径的参数化信息;
具体而言,设定的参数如下:
k1=1,k2=1,vS=1,k3=10,k4=5
初始路径参数为:
f1(θ)=0.5θ,f2(θ)=0.5θ
通过式(2)得到无人船期望路径的参数化信息pd,pd=[X Y]T;
式中,X为欠驱动无人船所要跟踪的参考路径的横坐标,Y为欠驱动无人船所要跟踪的参考路径的纵坐标;函数f1与函数f2为将参考路径参数化的函数;θ为路径参数。
103、根据设定的期望路径的参数化信息得到制导向量场信息;
具体而言,制导向量场表示为:
式中,F为二维向量场函数,φ1(x,y,θ)=x-f1(θ),φ2(x,y,θ)=y-f2(θ),k1,k2均为正常数,φ1、φ2是向量场里的参数信息,没有具体意义;
104、根据无人船期望路径的给定位置信息与无人船的实际位置信息,得到无人船期望路径的位置与无人船的实际位置之间的路径误差;路径误差,包括:横向路径误差和纵向路径误差;
具体而言,由式(3)得到无人船期望路径的位置的切线角度为:
得到旋转矩阵表示为:
无人船的实际位置表示为:
p=[x y]T (6)
根据无人船期望路径的位置与无人船的实际位置得到的路径误差的矩阵表示为:
e=RT(p-pd) (7)
式中,p为无人船的实际位置,e为路径误差矩阵;f′1(θ)为f1(θ)对θ的偏导数,f′2(θ)为f2(θ)对θ的偏导数,偏导数公式为与/>RT为旋转矩阵R的转置;atan2为计算f′1(θ)+f′2(θ)i的辅角。路径误差的矩阵包括二维数据,即横向路径误差和纵向路径误差。
105、根据制导向量场信息与无人船的实际位置信息,得到无人船制导航向;
具体而言,通过式(8)计算求得无人船制导航向ψd表示为:
ψd=atan2(F(2),F(1)) (8)
式中,F(1)代表制导向量场的第一维,F(2)代表制导向量场的第二维。
106、根据预先设定的期望速度及纵向路径误差,得到更新后的路径参数,并根据更新后的路径参数,得到更新后的无人船期望路径的位置信息;并根据更新后的无人船期望路径的位置信息,得到更新后的路径误差和无人船制导航向;
具体而言,通过式(9)计算路径参数θ的导数表示为:
式中,vs为预先设定的期望速度,k3为正的常数,tanh为双曲正切函数,e(1)为通过误差矩阵得到的第一维路径误差,即纵向路径误差。
得到路径参数的导数后,将更新后的路径参数θ代入式(2)中重新计算无人船给定路径的位置信息,然后再通过式(3)-(8)计算得到更新后的路径误差和无人船制导航向。
107、根据期望速度和更新后的纵向路径误差,得到无人船制导前向速度;
具体而言,通过式(10)计算无人船前向速度ud,表示为:
式中,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 (7)
1.一种无人船向量场路径跟踪控制器设计方法,其特征在于,包括:
建立无人船运动学模型;
根据设定的期望路径得到无人船期望路径的参数化信息;
根据设定的期望路径的参数化信息得到制导向量场信息;
根据所述无人船期望路径的给定位置信息与无人船的实际位置信息,得到无人船期望路径的位置与无人船的实际位置之间的路径误差;所述路径误差,包括:横向路径误差和纵向路径误差;
根据所述制导向量场信息与无人船的实际位置信息,得到无人船制导航向;
根据预先设定的期望速度及所述纵向路径误差,得到更新后的路径参数,并根据更新后的路径参数,得到更新后的所述无人船期望路径的位置信息;
并根据所述更新后的所述无人船期望路径的位置信息,得到更新后的路径误差和无人船制导航向;
所述根据所述制导向量场信息与无人船的实际位置信息,得到无人船制导航向,包括:
制导向量场表示为:
式中,F为二维向量场函数,φ1(x,y,θ)=x-f1(θ),φ2(x,y,θ)=y-f2(θ),分别代表欠驱动无人船在地球坐标系下的x轴、y轴上的位置以及艏摇角,θ为路径参数,函数f1与函数f2为将参考路径参数化的函数,f1(θ)为f1(θ)对θ的偏导数,f′2(θ)为f2(θ)对θ的偏导数,偏导数公式为/> 与/>k1,k2均为正常数,φ1、φ2是向量场里的参数信息,没有具体意义;
通过式(8)计算求得无人船制导航向ψd表示为:
ψd=atan2(F(2),F(1)) (8)
式中,F(1)代表制导向量场的第一维,F(2)代表制导向量场的第二维;
根据所述期望速度和更新后的纵向路径误差,得到无人船制导前向速度;
在向量场作用下,无人船通过所述更新后的无人船制导航向和无人船制导前向速度,沿期望路径运动。
2.根据权利要求1所述的一种无人船向量场路径跟踪控制器设计方法,其特征在于,所述建立无人船运动学模型,包括:
所述无人船运动学模型,表示为:
式中,分别代表欠驱动无人船在地球坐标系下的x轴、y轴上的位置以及艏摇角;/>分别代表欠驱动无人船在船体坐标系下的纵荡速度、横漂速度和艏摇角速度。
3.根据权利要求2所述的一种无人船向量场路径跟踪控制器设计方法,其特征在于,所述根据设定的期望路径得到无人船期望路径的参数化信息,包括:
通过式(2)得到所述无人船期望路径的参数化信息pd,pd=[X Y]T;
式中,X为欠驱动无人船所要跟踪的参考路径的横坐标,Y为欠驱动无人船所要跟踪的参考路径的纵坐标;函数f1与函数f2为将参考路径参数化的函数;θ为路径参数。
4.根据权利要求3所述的一种无人船向量场路径跟踪控制器设计方法,其特征在于,所述根据所述无人船期望路径的给定位置信息与无人船的实际位置信息,得到无人船期望路径的位置与无人船的实际位置之间的路径误差,包括:
由式(3)得到无人船期望路径的位置的切线角度为:
得到旋转矩阵表示为:
无人船的实际位置表示为:
p=[x y]T (5)
根据无人船期望路径的位置与无人船的实际位置得到的路径误差的矩阵表示为:
e=RT(p-pd) (6)
式中,p为无人船的实际位置,e为路径误差矩阵;f′1(θ)为f1(θ)对θ的偏导数,f′2(θ)为f2(θ)对θ的偏导数,偏导数公式为与/> RT为旋转矩阵R的转置;atan2为计算f′1(θ)+f′2(θ)i的辅角。
5.根据权利要求4所述的一种无人船向量场路径跟踪控制器设计方法,其特征在于,所述根据预先设定的期望速度及所述纵向路径误差,得到更新后的路径参数,包括:
通过式(9)计算路径参数θ的导数表示为:
式中,vs为预先设定的期望速度,k3为正的常数,tanh为双曲正切函数,e(1)为通过误差矩阵得到的第一维路径误差,即纵向路径误差。
6.根据权利要求5所述的一种无人船向量场路径跟踪控制器设计方法,其特征在于,所述根据所述期望速度和更新后的纵向路径误差,得到无人船制导前向速度,包括:
通过式(10)计算无人船制导前向速度ud,表示为:
式中,k4为正的常数。
7.一种无人船向量场路径跟踪控制器,用于在向量场作用下,得到无人船制导航向和前向速度,并发送至无人船,使得无人船沿期望路径运动,其特征在于,包括:
参考路径模块、路径误差模块、制导向量场模块、路径参数更新模块及制导前向速度模块;
所述参考路径模块的输入端与所述路径参数更新模块相连,输出端分别与所述路径误差模块和制导向量场模块相连;所述路径误差模块的输入端与所述参考路径模块和无人船相连,输出端与所述路径参数更新模块和所述制导前向速度模块相连;所述制导向量场模块的输入端与所述参考路径模块和无人船相连,输出端与无人船相连;所述路径参数更新模块的输入端与路径误差模块的输出端相连,输出端与所述参考路径模块的输入端相连;所述制导前向速度模块的输入端与所述路径误差模块相连,输出端与无人船相连;
所述参考路径模块,用于根据所述路径参数更新模块输入的路径参数,得到无人船期望路径的位置信息;
所述路径误差模块,用于根据所述无人船期望路径的位置信息与无人船的实际位置信息,得到无人船期望路径的位置与无人船的实际位置之间的路径误差;所述路径误差,包括:横向路径误差和纵向路径误差;
所述制导向量场模块,用于根据所述无人船期望路径的位置信息与无人船的实际位置信息,得到无人船制导航向;
所述根据所述制导向量场信息与无人船的实际位置信息,得到无人船制导航向,包括:
制导向量场表示为:
式中,F为二维向量场函数,φ1(x,y,θ)=x-f1(θ),φ2(x,y,θ)=y-f2(θ),分别代表欠驱动无人船在地球坐标系下的x轴、y轴上的位置以及艏摇角,θ为路径参数,函数f1与函数f2为将参考路径参数化的函数,f′1(θ)为f1(θ)对θ的偏导数,f′2(θ)为f2(θ)对θ的偏导数,偏导数公式为/> 与/>k1,k2均为正常数,φ1、φ2是向量场里的参数信息,没有具体意义;
通过式(8)计算求得无人船制导航向ψd表示为:
ψd=atan2(F(2),F(1)) (8)
式中,F(1)代表制导向量场的第一维,F(2)代表制导向量场的第二维;
所述路径参数更新模块,用于根据预先设定的期望速度及所述纵向路径误差,得到更新后的路径参数并发送所述参考路径模块;
所述制导前向速度模块,用于通过所述期望速度、纵向路径误差,得到无人船制导前向速度。
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 CN113219970A (zh) | 2021-08-06 |
CN113219970B true 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) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113581388B (zh) * | 2021-08-30 | 2022-05-20 | 广东工业大学 | 一种环保作业的无人艇控制方法及应用其的无人艇系统 |
CN115494848B (zh) * | 2022-09-30 | 2024-05-03 | 大连海事大学 | 一种规避动静态障碍物的无人船路径跟踪视距制导方法及系统 |
Citations (10)
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 | 武汉轻工大学 | 路径跟踪的控制方法、装置、设备及存储介质 |
-
2021
- 2021-04-23 CN CN202110443952.0A patent/CN113219970B/zh active Active
Patent Citations (10)
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)
Title |
---|
Vector field path following control for unmanned surface vehicles;Zhi Li;《OCEANS》;第1-9页 * |
固定翼无人机曲线路径跟踪的积分向量场方法;赵述龙;《国防科技大学学报》;第40卷(第2期);第119-124页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113219970A (zh) | 2021-08-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113219970B (zh) | 一种无人船向量场路径跟踪控制器及设计方法 | |
CN111580523B (zh) | 一种基于侧滑角补偿的无人艇路径跟踪自抗扰控制方法 | |
CN106444806B (zh) | 基于生物速度调节的欠驱动auv三维轨迹跟踪控制方法 | |
CN111487966B (zh) | 一种基于航路点的水面无人艇自适应路径跟踪控制方法 | |
CN109976349B (zh) | 一种含约束无人船的路径跟踪制导与控制结构的设计方法 | |
CN110609556A (zh) | 一种基于los导航法的多无人艇协同控制方法 | |
CN103576693A (zh) | 基于二阶滤波器的水下机器人三维路径跟踪控制方法 | |
CN108460210B (zh) | 一种基于噪残差和协方差匹配的动力定位系统噪声特性实时估计方法 | |
Yang et al. | An improved stanley guidance law for large curvature path following of unmanned surface vehicle | |
CN113219978B (zh) | 一种基于零阶保持器的船舶路径跟踪事件触发控制方法 | |
CN108333934A (zh) | 基于侧滑补偿的气垫船路径跟踪的自适应los导引方法 | |
CN113625544A (zh) | 一种波浪滑翔器的内外环pid路径跟踪控制方法 | |
CN112180972A (zh) | 基于前轮转弯技术的无人机航线确定方法 | |
CN112051742A (zh) | 一种基于mpc的全驱动船舶航迹跟踪方法 | |
CN111798702A (zh) | 无人艇路径跟踪控制方法、系统、存储介质及终端 | |
CN114967702A (zh) | 一种无人艇控制系统及路径跟踪方法 | |
CN111176292B (zh) | 一种基于侧边距的波浪滑翔器路径跟踪控制方法 | |
CN113485389A (zh) | 一种基于自适应预测的水下机器人三维轨迹跟踪控制方法 | |
CN113359737A (zh) | 一种考虑队形伸缩的船舶编队自适应事件触发控制方法 | |
CN113296505B (zh) | 一种基于速变los的无人船多模式路径跟踪控制方法 | |
CN115859652A (zh) | 一种基于改进金鹰优化算法的全垫升气垫船矢量推力层级分配方法 | |
CN116027796A (zh) | 一种多自治水下机器人编队控制系统及方法 | |
CN111830832B (zh) | 仿生滑翔机器海豚平面路径跟踪方法及系统 | |
CN114047743A (zh) | 一种带预测的无人艇目标跟踪控制方法与系统 | |
CN116300981A (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 |