CN103968838B - 一种基于极坐标系的auv曲线运动状态下的协同定位方法 - Google Patents
一种基于极坐标系的auv曲线运动状态下的协同定位方法 Download PDFInfo
- Publication number
- CN103968838B CN103968838B CN201410195910.XA CN201410195910A CN103968838B CN 103968838 B CN103968838 B CN 103968838B CN 201410195910 A CN201410195910 A CN 201410195910A CN 103968838 B CN103968838 B CN 103968838B
- Authority
- CN
- China
- Prior art keywords
- auv
- sub
- theta
- matrix
- coordinate system
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 12
- 238000005259 measurement Methods 0.000 claims abstract description 47
- 239000011159 matrix material Substances 0.000 claims description 44
- 238000005530 etching Methods 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 10
- 238000005070 sampling Methods 0.000 claims description 4
- 230000004927 fusion Effects 0.000 abstract description 2
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 5
- 238000001914 filtration Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000002844 melting Methods 0.000 description 1
- 230000008018 melting Effects 0.000 description 1
- 230000001568 sexual effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/203—Specially adapted for sailing ships
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明提供的是一种基于极坐标系的AUV曲线运动状态下的协同定位方法。其中主AUV装备精度较高的惯性测量单元,而子AUV装备较低精度的IMU。首先,子AUV通过融合自身的惯性测量单元测量载体运动信息,并测定相对于主AUV的距离和方位信息,最后利用扩展卡尔曼滤波来实现协同定位。本发明与传统的基于笛卡尔坐标系的算法相比,在AUV做曲线运动时具有较高的定位精度。
Description
技术领域
本发明涉及的是一种在曲线运动状态下基于极坐标系的AUV曲线运动状态下的协同定位方法。
背景技术
未来是海洋文明的世纪,海洋领域的探索将成为世界的发展趋势,因此水面船艇作业、应用的研究具有广阔的前景。自主水下载体(Autonomous Underwater Vehicle,AUV)实际上是一种水下无人平台,以其体积小、机动性强和成本低等优势成为研究热点;可以执行各种导航和水下地理勘察等复杂任务[1]。随着人类进一步开发认识海洋,AUV研究、应用的理论价值和实际意义更为凸显。AUV与常规的船艇比较,易于操作、灵活快捷,可以经受住各种复杂环境的考验。AUV在允许侦测区域进行隐蔽及公开作业,要充分利用传感器信息,这就需要多AUV进行协同定位。目前,大多数的AUV协同定位***都是基于笛卡尔坐标系建立的,且其运动状态大都为匀速直航,而极坐标系是针对曲线运动的,所以提出了一种基于极坐标系的协同定位算法,另外由于在AUV作曲线运动时,单纯的距离信息不能够很好的描述AUV的运动状态,因此提出了一种以距离加方位信息作为观测量的协同导航定位算法并进行了可观性分析。
发明内容
本发明的目的在于提供一种提高精度的基于极坐标系的AUV曲线运动状态下的新协同定位方法。
本发明的目的是这样实现的:
步骤一:主、子AUV开始协同导航,实时采集子AUV惯性测量单元测得的加速度和角速度信息,并积分得到子AUV的速度和航向信息;
步骤二:采集子AUV相对于主AUV的距离和方位信息;
采集的子AUV与主AUV之间的相对距离为:
其中:R为主AUV和子AUV之间的相对距离;r1和θ1为主AUV在极坐标系下的半径和极角;r和θ为子AUV在极坐标系下的半径和极角;
采集的子AUV与主AUV之间的相对方位角为:
当rcosθ-r1cosθ1≤0时,有:
其中:φ为子AUV和主AUV之间的相对方位角;为子AUV的航向角;
当rcosθ-r1cosθ1>0时,有:
步骤三:结合步骤一中得到的子AUV的速度和航向信息,以及步骤二中得到的子AUV相对于主AUV的距离和方位信息,利用扩展卡尔曼滤波器,对子AUV的位置进行估计,实现子AUV的导航定位;
所涉及的***状态向量为:
其中:为主AUV的航向角;
所涉及的***离散状态方程为:
其中:和分别为k,k-1时刻的状态预测值和状态估计值;Uk-1为k-1时刻的***输入;Tk-1为k-1时刻对应的输入矩阵;Φk,k-1为状态转移矩阵;Gk-1为k-1时刻***的噪声驱动矩阵;W(t)为噪声矩阵:
***的输入向量:
Uk-1=[vk-1 ωk-1]T
对应的输入矩阵:
***的噪声矩阵:
其中:δr1,k-1,δθ1,k-1,分别对应于k-1时刻主AUV在极坐标下的半径,极角和航向误差,δrk-1,δθk-1,分别对应于k-1时刻子AUV在极坐标下的半径,极角和航向误差;
***的状态转移矩阵为:
其中:T为采样周期;
所涉及的***量测方程为:
其中:Zk为k时刻***的量测向量;Hk为k时刻***的量测矩阵;Vk为量测噪声;
***的量测向量为:
Zk=[Rk φk]T,
当rcosθ-r1cosθ1≤0时,量测矩阵为:
当rcosθ-r1cosθ1>0时,量测矩阵为:
本发明的有益效果在于:
(1)与传统的基于笛卡尔坐标系下的***动力学模型相比,极坐标系下的***动力学模型更适用于AUV作曲线运动的状态下。
(2)与传统的仅用相对距离信息作为观测量的算法相比,采用距离加方位信息作为观测量时能够更好的反映曲线运动下AUV的运动状态,从而使得定位结果更精确。
(3)采用李导数对***的可观测性进行了分析,为协同定位提供了先决条件,进而有助于定位精度的进一步提高。
附图说明
图1是本发明的方法流程图;
图2是AUV的估计模型;
图3是主AUV和子AUV的真实运动轨迹;
图4是基于传统算法时的子AUV定位误差曲线;
图5是基于传统算法时的子AUV的位置估计曲线;
图6是基于传统算法时的子AUV的位置估计曲线的末端放大图;
图7是基于新算法时的子AUV定位误差曲线;
图8是基于新算法时的子AUV的位置估计曲线;
图9是基于新算法时的子AUV的位置估计曲线的末端放大图。
具体实施方式
下面将结合附图对本发明作进一步的详细说明。
基于极坐标系的AUV曲线运动状态下的新协同定位算法,包括以下几个步骤:
步骤一:采集惯性测量单元(Inertial Measurement Unit,IMU)测量的加速度、和角速度信息。
步骤二:利用IMU测得的加速度信息和角速度信息积分得到载体AUV的速度和航向信息,并利用该信息建立传统的笛卡尔坐标系下AUV的***方程。
步骤三:利用极坐标系和步骤二的笛卡尔坐标系之间的转换关系将步骤二中AUV的***方程转换到极坐标下。
步骤四:采集子AUV相对于主AUV的距离和方位信息。
步骤五:基于步骤三和步骤四建立扩展卡尔曼滤波(Extend Kalman Filter,EKF)的状态方程和量测方程,对子AUV的位置进行估计,以实现定位。
利用IMU测得的加速度信息和角速度信息积分得到载体AUV的速度和航向信息,并利用该信息建立传统的笛卡尔坐标系下AUV的***方程为:
其中:vi和ωi分别为第i个水下自主载体(Autonomous Underwater Vehicle,AUV)的速度和加速度,为第i个AUV航向角,为第i个AUV航向角的一阶导数。由于AUV作曲线运动,则ωi≠0。
利用极坐标系和步骤二的笛卡尔坐标系之间的转换关系将步骤二中AUV的***方程转换到极坐标下为:
其中:ri和θi分别为第i个AUV在极坐标系下的半径和极角。
采集的子AUV相对于主AUV的距离和方位信息为:
(1)以两个AUV的协同导航定位***为例,采集的子AUV与主AUV之间的相对距离为:
其中:R为主AUV和子AUV之间的相对距离;r1和θ1为主AUV在极坐标系下的半径和极角;r和θ为子AUV在极坐标系下的半径和极角。
(2)采集的子AUV与主AUV之间的相对方位角为:
当rcosθ-r1cosθ1≤0时,有:
其中:φ为子AUV和主AUV之间的相对方位角;为子AUV的航向角。
当rcosθ-r1cosθ1>0时,有:
基于步骤三和步骤四建立EKF的状态方程和量测方程包括:
(1)EKF算法的状态方程:
***的状态变量为:
其中:为主AUV的航向角。
***的离散状态方程为:
其中:和分别为k,k-1时刻的状态预测值和状态估计值;Uk-1为k-1时刻的***输入;Tk-1为k-1时刻对应的输入矩阵;Φk,k-1为状态转移矩阵;Gk-1为k-1时刻***的噪声驱动矩阵;W(t)为噪声矩阵。
***的输入向量:
Uk-1=[vk-1 ωk-1]T
对应的输入矩阵:
***的噪声矩阵:
其中:δr1,k-1,δθ1,k-1,分别对应于k-1时刻主AUV在极坐标下的半径,极角和航向误差,δrk-1,δθk-1,分别对应于k-1时刻子AUV在极坐标下的半径,极角和航向误差。
***的状态转移矩阵为:
其中:T为采样周期。
(2)EKF算法的离散量测方程:
其中:Zk为k时刻***的量测向量;Hk为k时刻***的量测矩阵;Vk为量测噪声。
***的量测向量为:
Zk=[Rk φk]T
当rcosθ-r1cosθ1≤0时,量测矩阵为:
当rcosθ-r1cosθ1>0时,量测矩阵为:
通过EKF算法对子AUV的位置进行估计,以实现定位。
本发明提供的是一种基于极坐标系的自主水下载体(Autonomous UnderwaterVehicle,AUV)曲线运动状态下的新的协同定位算法。其中主AUV装备精度较高的惯性测量单元(Inertial Measurement Unit,IMU),而子AUV装备较低精度的IMU。首先子AUV通过融合自身的IMU测量信息以及相对于主AUV的距离和方位信息并利用扩展卡尔曼滤波(ExtendKalman Filter,EKF)来实现协同定位。然后对从可观测性分析的角度进一步说明了该协同定位***性能的改善。最后从仿真角度验证了该协同定位算法的有效性并获得了较高的定位性能。本发明与传统的基于笛卡尔坐标系的算法相比,具有较高的定位精度,同时比航位推算算法和只融合距离测量信息的算法的精度较。
本发明的目的是提供一种针对AUV的曲线运动状态提供一种基于极坐标系的协同定位算法。首先在普通模型的基础上建立极坐标下的***动力学模型;然后建立主AUV和子AUV之间的相对距离模型和相对方位角模型;在上述基础上利用卡尔曼滤波对***子AUV进行定位;最后利用李导数对该非线性***进行了可观测性分析,分析了本发明的优势。
本发明包括以下几个步骤:
步骤一:采集惯性测量单元(Inertial Measurement Unit,IMU)测量的加速度和速度信息;
步骤二、建立传统的笛卡尔坐标系下AUV的***动力学方程;
步骤三、利用极坐标系和传统的笛卡尔坐标系之间的转换关系建立极坐标系下AUV的***动力学方程;
步骤四、采集需要与子AUV自身测量信息进行融合的相对与主AUV距离和方位信息;
步骤五、选取状态变量建立扩展卡尔曼滤波(Extend Kalman Filter,EKF)的状态方程和量测方程,对子AUV的位置进行估计,以实现定位;
步骤六、根据极坐标系下建立的***状态方程和量测方程,利用李导数对该非线性***进行可观测性分析。
本发明的一种基于极坐标系的AUV曲线运动状态下的新协同定位算法,流程图如图1所示,包括以下几个步骤:
步骤一:采集惯性测量单元(Inertial Measurement Unit,IMU)测量的加速度、速度和角速度信息。
步骤二:建立传统的笛卡尔坐标系下第i个AUV的***动力学方程为:
其中:vi和ωi分别为第i个水下自主载体(Autonomous Underwater Vehicle,AUV)的速度和加速度,为第i个AUV航向角,为第i个AUV航向角的一阶导数。由于AUV作曲线运动,则ωi≠0。
步骤三:利用极坐标系和传统的笛卡尔坐标系之间的转换关系建立极坐标系下第i个AUV的***动力学方程为:
其中:ri和θi分别为第i个AUV在极坐标系下的半径和极角。
步骤四:建立需要与子AUV自身测量信息进行融合的相对与主AUV距离和方位模型包括:
(1)以两个AUV的协同导航定位***为例,建立子AUV与主AUV之间的相对距离模型为:
其中:R为主AUV和子AUV之间的相对距离;r1和θ1为主AUV在极坐标系下的半径和极角;r和θ为子AUV在极坐标系下的半径和极角。
(2)根据图2可建立子AUV与主AUV之间的相对方位角模型为:
当rcosθ-r1cosθ1≤0时,有:
其中:φ为子AUV和主AUV之间的相对方位角;为子AUV的航向角。
当rcosθ-r1cosθ1>0时,有:
步骤五:选取状态变量建立基于EKF滤波算法的***状态方程和量测方程。
(1)建立EKF算法的状态方程:
***的状态变量为:
其中:为主AUV的航向角。
***的离散状态方程为:
其中:和分别为k,k-1时刻的状态预测值和状态估计值;Uk-1为k-1时刻的***输入;Tk-1为k-1时刻对应的输入矩阵;Φk,k-1为状态转移矩阵;Gk-1为k-1时刻***的噪声驱动矩阵;W(t)为噪声矩阵。
***的输入向量:
Uk-1=[vk-1 ωk-1]T (8)
对应的输入矩阵:
***的噪声矩阵:
其中:δr1,k-1,δθ1,k-1,分别对应于k-1时刻主AUV在极坐标下的半径,极角和航向误差,δrk-1,δθk-1,分别对应于k-1时刻子AUV在极坐标下的半径,极角和航向误差。
***的状态转移矩阵为:
其中:T为采样周期。
(2)建立EKF算法的离散量测方程:
其中:Zk为k时刻***的量测向量;Hk为k时刻***的量测矩阵;Vk为量测噪声。
***的量测向量为:
Zk=[Rk φk]T (13)
当rcosθ-r1cosθ1≤0时,量测矩阵为:
当rcosθ-r1cosθ1>0时,量测矩阵为:
仿真时间2500秒,在相同的仿真条件下,分别对基于传统的笛卡尔坐标系和采用极坐标下的模型进行,为了更好的说明本发明的优势,在两种方法下分别对航推、基于位置观测信息的EKF算法和基于位置和方位角的EKF算法进行可比较。
实施效果:图3给出了主AUV,子AUV的真实轨迹;图4给出基于传统算法时的子AUV定位误差曲线,其中:EKF1表示观测信息为距离时在传统算法下的EKF估计轨迹,EKF2表示观测信息为距离加方位时在传统算法下的EKF估计轨迹,图4中的子图为基于EKF2算法的全局放大图;图5给出了基于传统算法时的子AUV的位置估计曲线,其中:EKF1表示观测信息为距离时在传统算法下的EKF估计误差,EKF2表示观测信息为距离加方位时在传统算法下的EKF估计误差,为了更加清楚明了的比较航推、EKF1和EKF2三种算法的定位结果,对其定位轨迹的末端进行放大,如图6所示;图7给出了基于本发明的子AUV定位误差曲线,其中:EKF1表示观测信息为距离时在本发明下的EKF估计轨迹,EKF2表示观测信息为距离加方位时在本发明下的EKF估计轨迹,图7中的子图为基于EKF2算法的全局放大图;图8给出了基于本发明的子AUV的位置估计曲线,其中:EKF1表示观测信息为距离时在本发明下的EKF估计误差,EKF2表示观测信息为距离加方位时在本发明下的EKF估计误差,为了更加清楚明了的比较航推、EKF1和EKF2三种算法的定位结果,对其定位轨迹的末端进行放大,如图9所示。通过图4和图7可以看出,无论是在传统算法还是在本发明提出的算法下,本发明提出的距离加方位观测法都能够获得较高的精度,同时比较图4和图7可知,对与曲线运动来说,本发明提能够获得更高的精度。
步骤六:利用李导数对非线性***进行可观测性分析。
建立非线性的状态方程为:
当rcosθ-r1cosθ1≤0时,建立非线性的量测方程为:
可观测性矩阵为:
其中:a1=r-r1cos(θ-θ1);a2=rr1sin(θ-θ1);b2=-r2+rr1cos(θ-θ1)=-ra1;
当rcosθ-r1cosθ1>0时,建立非线性的量测方程为:
可观测性矩阵为:
其中:a1=r-r1cos(θ-θ1);a2=rr1sin(θ-θ1);b2=r2-rr1cos(θ-θ1)=ra1;
通过分析可知,当r=r1,θ=θ1,即主AUV和子AUV的位置重合时,***整体不可观;当主AUV和子AUV之间的相对距离不变时,距离观测子块即O1不可观;当主AUV和子AUV之间的相对方位角不变时,距离观测子块即O2不可观;当主AUV和子AUV之间的相对距离和相对方位角都不变时,整个***不可观,所以为了提高***的定位精度,保证***的可观测性,应该保证主AUV和子AUV之间的相对距离或相对方位角为变化的。
从以上实施例不难看出,相对于传统的在笛卡尔坐标系下的协同定位算法,本发明提供方法能够获得更高的精度。
Claims (1)
1.一种基于极坐标系的AUV曲线运动状态下的协同定位方法,其特征在于,包括以下步骤:
步骤一:主、子AUV开始协同导航,实时采集子AUV惯性测量单元测得的加速度和角速度信息,并积分得到子AUV的速度和航向信息;利用子AUV的速度和航向信息建立传统的笛卡尔坐标系下AUV的***方程:
其中:vi和ωi分别为第i个AUV的速度和加速度,为第i个AUV航向角,为第i个AUV航向角的一阶导数;由于AUV作曲线运动,则ωi≠0;
步骤二:利用极坐标系和笛卡尔坐标系之间的转换关系将AUV的***方程转换到极坐标下,采集子AUV相对于主AUV的距离和方位信息;
其中:ri和θi分别为第i个AUV在极坐标系下的半径和极角;
采集的子AUV与主AUV之间的相对距离为:
其中:R为主AUV和子AUV之间的相对距离;r1和θ1为主AUV在极坐标系下的半径和极角;r和θ为子AUV在极坐标系下的半径和极角;
采集的子AUV与主AUV之间的相对方位角为:
当rcosθ-r1cosθ1≤0时,有:
其中:φ为子AUV和主AUV之间的相对方位角;为子AUV的航向角;
当rcosθ-r1cosθ1>0时,有:
步骤三:结合步骤一中得到的子AUV的速度和航向信息,以及步骤二中得到的子AUV相对于主AUV的距离和方位信息,利用扩展卡尔曼滤波器,对子AUV的位置进行估计,实现子AUV的导航定位;
所涉及的***状态向量为:
其中:为主AUV的航向角;
所涉及的***离散状态方程为:
其中:和分别为k,k-1时刻的状态预测值和状态估计值;Uk-1为k-1时刻的***输入;Tk-1为k-1时刻对应的输入矩阵;Φk,k-1为状态转移矩阵;Gk-1为k-1时刻***的噪声驱动矩阵;W(t)为噪声矩阵:
***的输入向量:
Uk-1=[vk-1 ωk-1]T
对应的输入矩阵:
***的噪声矩阵:
其中:分别对应于k-1时刻主AUV在极坐标下的半径,极角和航向误差,分别对应于k-1时刻子AUV在极坐标下的半径,极角和航向误差;
***的状态转移矩阵为:
其中:T为采样周期;
所涉及的***量测方程为:
其中:Zk为k时刻***的量测向量;Hk为k时刻***的量测矩阵;Vk为量测噪声;
***的量测向量为:
Zk=[Rk φk]T
当rcosθ-r1cosθ1≤0时,量测矩阵为:
当rcosθ-r1cosθ1>0时,量测矩阵为:
步骤四:利用李导数对非线性***进行可观测性分析;
建立非线性的状态方程为:
当rcosθ-r1cosθ1≤0时,建立非线性的量测方程为:
可观测性矩阵为:
其中:a1=r-r1cos(θ-θ1);a2=rr1sin(θ-θ1);b2=-r2+rr1cos(θ-θ1)=-ra1;
当rcosθ-r1cosθ1>0时,建立非线性的量测方程为:
可观测性矩阵为:
其中:a1=r-r1cos(θ-θ1);a2=rr1sin(θ-θ1);b2=r2-rr1cos(θ-θ1)=ra1;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410195910.XA CN103968838B (zh) | 2014-05-09 | 2014-05-09 | 一种基于极坐标系的auv曲线运动状态下的协同定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410195910.XA CN103968838B (zh) | 2014-05-09 | 2014-05-09 | 一种基于极坐标系的auv曲线运动状态下的协同定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103968838A CN103968838A (zh) | 2014-08-06 |
CN103968838B true CN103968838B (zh) | 2017-05-24 |
Family
ID=51238631
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410195910.XA Expired - Fee Related CN103968838B (zh) | 2014-05-09 | 2014-05-09 | 一种基于极坐标系的auv曲线运动状态下的协同定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103968838B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105319534B (zh) * | 2015-11-09 | 2018-08-17 | 哈尔滨工程大学 | 一种基于水声双程测距的多auv协同定位方法 |
CN105510878B (zh) * | 2015-11-27 | 2017-10-10 | 西北工业大学 | 一种分频段处理的多水下自主航行器被动相互定位方法 |
CN106403902B (zh) * | 2016-08-31 | 2019-01-04 | 武汉大学 | 一种星地协同的光学卫星在轨实时几何定位方法及*** |
CN107990896B (zh) * | 2016-10-26 | 2021-06-01 | 中国科学院沈阳自动化研究所 | 一种基于xyz格式地图的路径生成方法 |
CN108872975B (zh) * | 2017-05-15 | 2022-08-16 | 蔚来(安徽)控股有限公司 | 用于目标跟踪的车载毫米波雷达滤波估计方法、装置及存储介质 |
CN110186461B (zh) * | 2019-06-27 | 2021-02-19 | 武汉科技大学 | 一种基于重力梯度信息测距的协同导航方法 |
CN111220158B (zh) * | 2020-01-15 | 2022-09-09 | 哈尔滨工程大学 | 一种基于时间方位历程图的线谱目标运动参数估计方法 |
CN114281455A (zh) * | 2021-12-21 | 2022-04-05 | 深圳市智慧海洋科技有限公司 | 水下定位显示方法、装置、监测设备及*** |
CN115031726A (zh) * | 2022-03-29 | 2022-09-09 | 哈尔滨工程大学 | 一种数据融合导航定位方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101393025A (zh) * | 2008-11-06 | 2009-03-25 | 哈尔滨工程大学 | Auv组合导航***无迹切换方法 |
CN103090864A (zh) * | 2013-02-05 | 2013-05-08 | 哈尔滨工程大学 | 一种基于通信延时补偿的多水面无人艇协同定位方法 |
CN103336267A (zh) * | 2013-07-02 | 2013-10-02 | 哈尔滨工程大学 | 一种基于水声通信延迟的主从式多uuv协同定位方法 |
-
2014
- 2014-05-09 CN CN201410195910.XA patent/CN103968838B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101393025A (zh) * | 2008-11-06 | 2009-03-25 | 哈尔滨工程大学 | Auv组合导航***无迹切换方法 |
CN103090864A (zh) * | 2013-02-05 | 2013-05-08 | 哈尔滨工程大学 | 一种基于通信延时补偿的多水面无人艇协同定位方法 |
CN103336267A (zh) * | 2013-07-02 | 2013-10-02 | 哈尔滨工程大学 | 一种基于水声通信延迟的主从式多uuv协同定位方法 |
Non-Patent Citations (7)
Title |
---|
Application for Autonomous Underwater Vehicle Initial Alignment with Divided Difference Filter;Guiling Zhao,et al;《International Conference on Information and Automation》;20100623;第1352-1356页 * |
Optimal decision making for Cooperative Localization of MAUVs;Yao Yao, et al;《International Conference on Mechatronics and Automation》;20090812;第1134-1139页 * |
一种基于极坐标的无源定位与跟踪稳定算法研究;龚享铱;《信号处理》;20050831;第21卷(第4期);第402-405页 * |
一种基于量测伪距的EKF移动长基线AUV协同导航方法;刘明雍,黄博,蔡挺;《鱼雷技术》;20121231;第20卷(第6期);第432-436页 * |
基于距离量测的主从式AUV协同定位方位;张永清等;《火力与指挥控制》;20111130;第36卷(第11期);第206-208页 * |
房新鹏等.基于距离量测的主从式AUV协同定位.《西北工业大学学报》.2012,第30卷(第4期),第547-552页. * |
高伟,刘亚龙,徐博.基于双领航者的多AUV协同导航***可观测性分析.《***工程与电子技术》.2013,第35卷(第11期),第2370-2375页. * |
Also Published As
Publication number | Publication date |
---|---|
CN103968838A (zh) | 2014-08-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103968838B (zh) | 一种基于极坐标系的auv曲线运动状态下的协同定位方法 | |
CN105823480B (zh) | 基于单信标的水下移动目标定位算法 | |
CN110006433A (zh) | 海底油气管检测机器人的组合导航定位***及方法 | |
CN104880191B (zh) | 一种基于太阳矢量的偏振辅助导航方法 | |
CN106979780B (zh) | 一种无人车实时姿态测量方法 | |
CN103017755B (zh) | 一种水下导航姿态测量方法 | |
Song et al. | Neural-network-based AUV navigation for fast-changing environments | |
CN104280025B (zh) | 基于无色卡尔曼滤波的深海机器人超短基线组合导航方法 | |
CN104075715A (zh) | 一种结合地形和环境特征的水下导航定位方法 | |
CN106679662B (zh) | 一种基于tma技术的水下机器人单信标组合导航方法 | |
CN102818567A (zh) | 集合卡尔曼滤波-粒子滤波相结合的auv组合导航方法 | |
CN105547290B (zh) | 一种基于超短基线定位***的从潜器导航方法 | |
CN107990891A (zh) | 基于长基线和信标在线标定的水下机器人组合导航方法 | |
CN102162733A (zh) | 一种基于svm的auv舰位推算导航误差实时修正方法 | |
Pedro et al. | Underwater single-beacon localization: Optimal trajectory planning and minimum-energy estimation | |
Wang et al. | Multipath parallel ICCP underwater terrain matching algorithm based on multibeam bathymetric data | |
CN104949687A (zh) | 一种长时间导航***全参数精度评估方法 | |
CN113433553A (zh) | 一种水下机器人多源声学信息融合精确导航方法 | |
CN107014374B (zh) | 一种基于互补滤波的水下滑翔器节能算法 | |
Allotta et al. | Localization algorithm for a fleet of three AUVs by INS, DVL and range measurements | |
CN105606093A (zh) | 基于重力实时补偿的惯性导航方法及装置 | |
CN109813316A (zh) | 一种基于地形辅助的水下载体紧组合导航方法 | |
CN103245793B (zh) | 一种组合导航洋流速度测量方法 | |
CN105808911A (zh) | 一种深海潜水器导航方法 | |
CN103616026A (zh) | 一种基于h∞滤波的auv操纵模型辅助捷联惯导组合导航方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170524 |
|
CF01 | Termination of patent right due to non-payment of annual fee |