CN110132308A - 一种基于姿态确定的usbl安装误差角标定方法 - Google Patents
一种基于姿态确定的usbl安装误差角标定方法 Download PDFInfo
- Publication number
- CN110132308A CN110132308A CN201910447543.0A CN201910447543A CN110132308A CN 110132308 A CN110132308 A CN 110132308A CN 201910447543 A CN201910447543 A CN 201910447543A CN 110132308 A CN110132308 A CN 110132308A
- Authority
- CN
- China
- Prior art keywords
- usbl
- error angle
- vector
- fix error
- sins
- 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
Links
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
- G01C21/165—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 combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/40—Correcting position, velocity or attitude
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
一种基于姿态确定的USBL安装误差角标定方法,超短基线定位系统在水下航行器定位中有着重要的应用。而USBL定位系统的安装误差角对USBL定位精度有重要影响。传统的标定方法对安装误差角的估计精度有限,且对路线要求较高。本申请SINS和USBL在应用过程中固联在一起时,USBL的安装误差角是固定不变的,然后利用姿态确定的思想来完成USBL安装误差角的标定。首先建立基于安装误差角矩阵的矢量观测模型,通过构造观测向量和参考向量,该方法可以实时标定SINS和USBL的安装误差角。该方法的优点在于:该方法能实时标定出USBL安装误差角,并且操作简单,对标定路线没有具体要求;USBL定位系统在水听器接收基阵坐标系下的定位精度越高,该方法的标定精度也就越高。
Description
技术领域
本发明涉及水下定位技术领域,特别是涉及一种基于姿态确定的USBL安装误差角标定方法。
背景技术
自主水下航行器(AUV)是人类进行海洋资源调查研究不可缺少的载体,水下定位技术是水下机器人水下作业的关键技术之一。海洋的介质环境决定了声音比光波和电磁波更适合作为水下定位技术的传播载体。在现有的水下声学定位技术中,USBL系统以其结构简单、操作方便、体积小等优点,在海洋资源调查和科研领域发挥着越来越重要的作用。
影响USBL定位系统定位精度的主要因素是系统误差、海洋环境参数引起的测量误差和接收阵列的安装误差。安装误差角是指水听器阵列架与惯性导航体架不一致造成的误差。超短基线接收基阵的安装误差是超短基线定位系统的主要误差源,在实际使用前必须对其进行精确标定。因此,研究超短定位系统安装误差角的标定方法,对于提高超短基线系统定位精度具有重要的意义。
虽然安装误差的标定对提高超短基线定位系统的定位精度起着重要作用,但安装误差角标定方法相关发表的文献却很少。2007年,哈尔滨工程大学郑翠娥提出了一种利用最小二乘法估计超短基线定位系统安装误差的标定方法,并进行了海上试验。然而,当该方法用最小二乘法求解安装误差角时,需要对矩阵进行求逆运算,这样会使得该算法存在奇异值的情况。2013年,Chen Hsin-Hung设计了一种迭代标定方法,通过分析三个角度值分别对USBL定位的影响来估计安装误差角。但这种标定方法原理过于理想,标定过程中对路线要求过于复杂。因此,本文提出的标定方法可以实时的标定出超短基线定位系统的安装误差角,且对标定路线没有要求。
发明内容
为了解决现有标定方法技术中标定精度的不足以及标定路线要求高的缺点,本发明提供一种基于姿态确定的USBL安装误差角标定方法,通过具有RTK定位精度的GPS位置来修正SINS的姿态误差,在事先通过LBL计算得到应答器位置的条件下,构造基于USBL安装误差角矩阵的矢量观测模型,利用姿态确定方法求解出USBL安装误差角,为达此目的,本发明提供一种基于姿态确定的USBL安装误差角标定方法,其具体步骤如下:
(1)超短基线系统由安装在AUV上的四个水听器组成的正方形基阵和布放在海底的应答器组成,换能器发送声波信号,应答器接收信号后经过一段延时发送应答信号,四个水听器接收到应答信号后,根据声波到达时间确定水听器与应答器间的斜距信息,以及声波与水听器基阵间的两个方位角信息;
(2)利用具有RTK固定解定位精度的GPS位置信息与捷联惯性导航系统SINS进行松组合算法,以此来修正SINS的姿态角误差,从而为USBL标定方法提供更加精确的姿态矩阵
(3)构造基于USBL安装误差角姿态矩阵的矢量观测模型,利用超短基线定位系统构造水声基阵坐标系下的位置矢量,利用SINS/RTK组合导航系统的位置和姿态构造载体系下的位置矢量;
(4)根据步骤(3)构造的基于USBL安装误差角姿态矩阵的矢量观测模型,利用姿态确定方法求解出USBL安装误差角对应的姿态四元数,从而完成USBL安装误差角的实时标定。
作为本发明进一步改进,所述步骤(2)中基于RTK固定解的SINS/GPS松组合导航方法的具体步骤为:
(21)状态量X由以下15个变量组成;
其中,φE,φN,φU是捷联惯导的三个失准角,δVE,δVN,δVU是东北天三个方向上的速度误差,δL,δλ,δh是捷联惯导的三个位置误差在导航系下的描述,εx,εy,εz是陀螺的三个轴向漂移,是加速度计三个轴向的零偏误差;
(22)系统状态方程为;
其中,X(t)为系统的状态向量,F(t)是惯导系统误差状态方程状态转移矩阵,W(t)是关于捷联惯导系统的噪声向量;
(23)以RTK位置与SINS位置差作为观测量,建立系统观测方程为;
Z(t)=PSINS-PGPS=H(t)X(t)+V(t)
其中,Z(t)为观测方程的量测向量,PSINS为SINS得到的位置,PGPS为RTK位置,H(t)为观测方程的量测矩阵,V(t)为观测方程的量测噪声向量;其中量测矩阵的具体表达式为;
H(t)=[03×3 03×3 I3×3 03×3 03×3]
其中I3x3表示3阶单位矩阵。
作为本发明进一步改进,所述步骤(3)中构造基于USBL安装误差角姿态矩阵的矢量观测模型的具体步骤为:
(31)超短基线坐标系记为a系,捷联惯导载体坐标系记为b系,ra表示应答器在超短基线坐标系下的相对位置,可以通过超短基线定位系统的斜距及方位角信息求解得到,具体计算公式为,
其中R表示应答器与水听器接收基阵之间的斜距信息,α,β分别为水听器与应答器之间的声波信号与超短基线坐标系x,y轴的方位角;
(32)利用不同时刻计算得到的ra(t)作差,得到应答器在a系下相对位置的变化量具体计算公式为:
(33)LBL计算得到的应答器在导航系下的位置为利用SINS位置和姿态,求解得到应答器在b系下的相对位置rb,具体计算方式为:
其中,表示b系与n系之间的姿态矩阵,表示SINS在导航系下的位置。
(34)建立rb与rb之间的关系表达式为:
其中,表示b系与a系之间的姿态矩阵,Lb表示超短基线坐标系原点与载体系原点之间的杆臂值在载体系下的投影;
(35)通过将不同时刻计算得到的rb(t)-Lb作差,得到应答器在b系下相对位置的变化量
(36)通过步骤(32)构造的水声基阵坐标系下的位置矢量及步骤(35)构造的载体坐标系下的位置矢量建立基于USBL安装误差角的矢量观测模型如下:
作为本发明进一步改进,所述步骤(4)中利用姿态确定方法求解USBL安装误差角对应的姿态四元数的具体步骤为:
(41)通过步骤(36)建立的基于USBL安装误差角的矢量观测模型,建立对应的基于USBL安装误差姿态四元数的矢量观测模型:
其中,为USBL安装误差角姿态矩阵对应的姿态四元数。表示四元数乘法运算。
(42)将观测矢量和参考矢量简记为并构造两个矩阵如下式:
(43)通过步骤(42)构造的两个矩阵,步骤(14)中的矢量观测模型转化为
上式中构造的观测矢量模型可以通过最小二乘约束求得
其中,则K矩阵最小特征值对应的特征向量即为USBL安装误差角姿态四元数
与现有技术相比,本发明具有如下优点:
(1)相比于传统标定方法的事后处理方式,本方法既可以通过事后处理的方式求解出安装误差角,也可以通过实时构造观测矢量及参考矢量来实时计算出USBL安装误差角。
(2)相比于传统方法中要求标定路线为圆形或者直线型路线,本方法求解安装误差角所需的观测矢量及参考矢量在任意轨迹条件下都能构造得到,因此,本方法在任意路线条件下都能完成超短基线安装误差角的标定。
(3)USBL定位系统计算得到的应答器在声学基阵坐标系下的定位精度越高,观测矢量构造的精度也就越高,则本方法标定的安装误差角精度越高。进一步地,USBL计算得到的载体在导航系下的定位精度也就越高。这是一个逐次递进的效果。
附图说明
图1为本发明的标定方法结构示意图;
图2为本发明中标定方法整体流程图。
具体实施方式
下面结合附图与具体实施方式对本发明作进一步详细描述:
本发明提供一种基于姿态确定的USBL安装误差角标定方法,通过具有RTK定位精度的GPS位置来修正SINS的姿态误差,在事先通过LBL计算得到应答器位置的条件下,构造基于USBL安装误差角矩阵的矢量观测模型,利用姿态确定方法求解出USBL安装误差角。
下面对本发明技术方案进行详细说明,但是本发明的保护范围不局限于所述实施例。
如图1所示,本发明由安装在AUV上的捷联惯导系统(SINS)和超短基线定位系统(USBL)组成,其中超短基线系统的水听器接收基阵和惯导系统固联在一起,应答器布放在海底。通过建立安装误差角姿态矩阵的矢量观测模型,并设计基于姿态确定的USBL安装误差角标定方法估计出USBL安装误差角,具体实现步骤如下。
(1)超短基线系统由安装在AUV上的四个水听器组成的正方形基阵和布放在海底的应答器组成。换能器发送声波信号,应答器接收信号后经过一段延时发送应答信号,四个水听器接收到应答信号后,根据声波到达时间确定水听器与应答器间的斜距信息,以及声波与水听器基阵间的两个方位角信息。
(2)利用具有RTK固定解定位精度的GPS位置信息与捷联惯性导航系统SINS进行松组合算法,以此来修正SINS的姿态角误差,从而为USBL标定方法提供更加精确的姿态矩阵
(3)构造基于USBL安装误差角姿态矩阵的矢量观测模型,利用超短基线定位系统构造水声基阵坐标系下的位置矢量,利用SINS/RTK组合导航系统的位置和姿态构造载体系下的位置矢量。。
(4)根据步骤(3)构造的基于USBL安装误差角姿态矩阵的矢量观测模型,利用姿态确定方法求解出USBL安装误差角对应的姿态四元数,从而完成USBL安装误差角的实时标定。
一、步骤(2)中基于RTK固定解的SINS/GPS松组合导航方法,具体实现方式如下:
(5)状态量X由以下15个变量组成
其中,φE,φN,φU是捷联惯导的三个失准角,δVE,δVN,δVU是东北天三个方向上的速度误差,δL,δλ,δh是捷联惯导的三个位置误差在导航系下的描述,εx,εy,εz是陀螺的三个轴向漂移,是加速度计三个轴向的零偏误差。
(6)系统状态方程为
其中,X(t)为系统的状态向量,F(t)是惯导系统误差状态方程状态转移矩阵,W(t)是关于捷联惯导系统的噪声向量。
(7)以RTK位置与SINS位置差作为观测量,建立系统观测方程为
Z(t)=PSINS-PGPS=H(t)X(t)+V(t)
其中,Z(t)为观测方程的量测向量,PSINS为SINS得到的位置,PGPS为RTK位置,H(t)为观测方程的量测矩阵,V(t)为观测方程的量测噪声向量;其中量测矩阵的具体表达式为
H(t)=[03×3 03×3 I3×3 03×3 03×3]
其中I3x3表示3阶单位矩阵。
(8)系统状态方程及量测方程的离散化
Xk=Φk,k-1Xk-1+Wk-1
Zk=HkXk+Vk
式中,Xk为k时刻的状态向量,也就是被估计矢量;Zk为k时刻的测量序列;Wk-1为k-1时刻的系统噪声;Vk为k时刻的测量噪声序列;Φk,k-1为k-1时刻到k时刻的一步状态转移矩阵;Hk为k时刻的测量矩阵,
(9)利用标准卡尔曼滤波方程计算状态的最优估计
状态一步预测向量
Xk/k-1=Φk,k-1Xk-1
状态估值计算
Xk=Xk/k-1+Kk(Zk-HkXk/k-1)
滤波增益Kk
一步预测均方误差矩阵Pk/k-1
其中Qk-1为系统噪声矩阵;
估计均方误差方程Pk
其中Rk为量测噪声矩阵;
(10)校正SINS
利用当前的误差最优估计可以立即校正SINS每次的由测量数据得到的状态量。
位置校正可以通过惯导系统对参数的估计值与估计误差简单相减来修正:
式中,Xc是校正后的状态量。
二、步骤(3)中建立构造基于USBL安装误差角姿态矩阵的矢量观测模型的具体步骤为:
(11)超短基线坐标系记为a系,捷联惯导载体坐标系记为b系。ra表示应答器在超短基线坐标系下的相对位置,可以通过超短基线定位系统的斜距及方位角信息求解得到,具体计算公式为,
其中R表示应答器与水听器接收基阵之间的斜距信息,α,β分别为水听器与应答器之间的声波信号与超短基线坐标系x,y轴的方位角。
(12)利用不同时刻计算得到的ra(t)作差,得到应答器在a系下相对位置的变化量具体计算公式为:
(13)LBL计算得到的应答器在导航系下的位置为利用SINS位置和姿态,求解得到应答器在b系下的相对位置rb,具体计算方式为:
其中,表示b系与n系之间的姿态矩阵,表示SINS在导航系下的位置。
(14)建立rb与rb之间的关系表达式为:
其中,表示b系与a系之间的姿态矩阵,Lb表示超短基线坐标系原点与载体系原点之间的杆臂值在载体系下的投影。
(15)通过将不同时刻计算得到的rb(t)-Lb作差,可以得到应答器在b系下相对位置的变化量
(16)通过步骤(12)构造的水声基阵坐标系下的位置矢量及步骤(15)构造的载体坐标系下的位置矢量建立基于USBL安装误差角的矢量观测模型如下:
三、步骤(4)中利用姿态确定方法求解USBL安装误差角对应的姿态四元数的具体步骤为:
(17)通过步骤(16)建立的基于USBL安装误差角的矢量观测模型,建立对应的基于USBL安装误差姿态四元数的矢量观测模型:
其中,为USBL安装误差角姿态矩阵对应的姿态四元数。表示四元数乘法运算。
(18)将位置矢量和位置矢量简记为并构造两个矩阵如下式:
(19)通过步骤(18)构造的两个矩阵,步骤(14)中的矢量观测模型转化为
上式中构造的观测矢量模型可以通过最小二乘约束求得
其中,则K矩阵最小特征值对应的特征向量即为USBL安装误差角姿态四元数
以上所述,仅是本发明的较佳实施例而已,并非是对本发明作任何其他形式的限制,而依据本发明的技术实质所作的任何修改或等同变化,仍属于本发明所要求保护的范围。
Claims (4)
1.一种基于姿态确定的USBL安装误差角标定方法,其特征在于,其具体步骤如下:
(1)超短基线系统由安装在AUV上的四个水听器组成的正方形基阵和布放在海底的应答器组成,换能器发送声波信号,应答器接收信号后经过一段延时发送应答信号,四个水听器接收到应答信号后,根据声波到达时间确定水听器与应答器间的斜距信息,以及声波与水听器基阵间的两个方位角信息;
(2)利用具有RTK固定解定位精度的GPS位置信息与捷联惯性导航系统SINS进行松组合算法,以此来修正SINS的姿态角误差,从而为USBL标定方法提供更加精确的姿态矩阵
(3)构造基于USBL安装误差角姿态矩阵的矢量观测模型,利用超短基线定位系统构造水声基阵坐标系下的位置矢量,利用SINS/RTK组合导航系统的位置和姿态构造载体系下的位置矢量;
(4)根据步骤(3)构造的基于USBL安装误差角姿态矩阵的矢量观测模型,利用姿态确定方法求解出USBL安装误差角对应的姿态四元数,从而完成USBL安装误差角的实时标定。
2.根据权利要求1所述的一种基于姿态确定的USBL安装误差角标定方法,其特征在于:所述步骤(2)中基于RTK固定解的SINS/GPS松组合导航方法的具体步骤为:
(21)状态量X由以下15个变量组成;
其中,φE,φN,φU是捷联惯导的三个失准角,δVE,δVN,δVU是东北天三个方向上的速度误差,δL,δλ,δh是捷联惯导的三个位置误差在导航系下的描述,εx,εy,εz是陀螺的三个轴向漂移,是加速度计三个轴向的零偏误差;
(22)系统状态方程为;
其中,X(t)为系统的状态向量,F(t)是惯导系统误差状态方程状态转移矩阵,W(t)是关于捷联惯导系统的噪声向量;
(23)以RTK位置与SINS位置差作为观测量,建立系统观测方程为;
Z(t)=PSINS-PGPS=H(t)X(t)+V(t)
其中,Z(t)为观测方程的量测向量,PSINS为SINS得到的位置,PGPS为RTK位置,H(t)为观测方程的量测矩阵,V(t)为观测方程的量测噪声向量;其中量测矩阵的具体表达式为;
H(t)=[03×3 03×3 I3×3 03×3 03×3]
其中I3x3表示3阶单位矩阵。
3.根据权利要求1所述的一种基于姿态确定的USBL安装误差角标定方法,其特征在于:所述步骤(3)中构造基于USBL安装误差角姿态矩阵的矢量观测模型的具体步骤为:
(31)超短基线坐标系记为a系,捷联惯导载体坐标系记为b系,ra表示应答器在超短基线坐标系下的相对位置,可以通过超短基线定位系统的斜距及方位角信息求解得到,具体计算公式为,
其中R表示应答器与水听器接收基阵之间的斜距信息,α,β分别为水听器与应答器之间的声波信号与超短基线坐标系x,y轴的方位角;
(32)利用不同时刻计算得到的ra(t)作差,得到应答器在a系下相对位置的变化量具体计算公式为:
(33)LBL计算得到的应答器在导航系下的位置为利用SINS位置和姿态,求解得到应答器在b系下的相对位置rb,具体计算方式为:
其中,表示b系与n系之间的姿态矩阵,表示SINS在导航系下的位置。
(34)建立rb与rb之间的关系表达式为:
其中,表示b系与a系之间的姿态矩阵,Lb表示超短基线坐标系原点与载体系原点之间的杆臂值在载体系下的投影;
(35)通过将不同时刻计算得到的rb(t)-Lb作差,得到应答器在b系下相对位置的变化量
(36)通过步骤(32)构造的水声基阵坐标系下的位置矢量及步骤(35)构造的载体坐标系下的位置矢量建立基于USBL安装误差角的矢量观测模型如下:
4.根据权利要求3所述的一种基于姿态确定的USBL安装误差角标定方法,其特征在于:所述步骤(4)中利用姿态确定方法求解USBL安装误差角对应的姿态四元数的具体步骤为:
(41)通过步骤(36)建立的基于USBL安装误差角的矢量观测模型,建立对应的基于USBL安装误差姿态四元数的矢量观测模型:
其中,为USBL安装误差角姿态矩阵对应的姿态四元数。表示四元数乘法运算。
(42)将观测矢量和参考矢量简记为并构造两个矩阵如下式:
(43)通过步骤(42)构造的两个矩阵,步骤(14)中的矢量观测模型转化为
上式中构造的观测矢量模型可以通过最小二乘约束求得
其中,则K矩阵最小特征值对应的特征向量即为USBL安装误差角姿态四元数
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910447543.0A CN110132308B (zh) | 2019-05-27 | 2019-05-27 | 一种基于姿态确定的usbl安装误差角标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910447543.0A CN110132308B (zh) | 2019-05-27 | 2019-05-27 | 一种基于姿态确定的usbl安装误差角标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110132308A true CN110132308A (zh) | 2019-08-16 |
CN110132308B CN110132308B (zh) | 2022-04-29 |
Family
ID=67582093
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910447543.0A Active CN110132308B (zh) | 2019-05-27 | 2019-05-27 | 一种基于姿态确定的usbl安装误差角标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110132308B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110568407A (zh) * | 2019-09-05 | 2019-12-13 | 武汉理工大学 | 一种基于超短基线和航位推算的水下导航定位方法 |
CN110673115A (zh) * | 2019-09-25 | 2020-01-10 | 杭州飞步科技有限公司 | 雷达与组合导航系统的联合标定方法、装置、设备及介质 |
CN113465599A (zh) * | 2021-06-04 | 2021-10-01 | 北京信息科技大学 | 定位定向方法、装置及系统 |
CN113670302A (zh) * | 2021-09-01 | 2021-11-19 | 东南大学 | 一种运动效应影响下的惯性/超短基线组合导航方法 |
CN114397644A (zh) * | 2021-12-23 | 2022-04-26 | 山东科技大学 | 一种基于四元数法的超短基线安装误差校准方法 |
CN114993242A (zh) * | 2022-06-17 | 2022-09-02 | 北京航空航天大学 | 一种基于加速度匹配的阵列式pos安装偏差角标定方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102169184A (zh) * | 2011-01-04 | 2011-08-31 | 北京航空航天大学 | 组合导航系统中测量双天线gps安装失准角的方法和装置 |
CN104457754A (zh) * | 2014-12-19 | 2015-03-25 | 东南大学 | 一种基于sins/lbl紧组合的auv水下导航定位方法 |
CN106483498A (zh) * | 2015-09-01 | 2017-03-08 | 北京自动化控制设备研究所 | 一种sinsusbl紧耦合算法 |
CN106767793A (zh) * | 2017-01-19 | 2017-05-31 | 东南大学 | 一种基于sins/usbl紧组合的auv水下导航定位方法 |
CN108413983A (zh) * | 2017-12-21 | 2018-08-17 | 中国船舶重工集团公司第七0七研究所 | 一种sins/usbl一体化定位系统安装误差标定的机械方法 |
CN109324330A (zh) * | 2018-09-18 | 2019-02-12 | 东南大学 | 基于混合无导数扩展卡尔曼滤波的usbl/sins紧组合导航定位方法 |
CN109737956A (zh) * | 2018-12-17 | 2019-05-10 | 东南大学 | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 |
-
2019
- 2019-05-27 CN CN201910447543.0A patent/CN110132308B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102169184A (zh) * | 2011-01-04 | 2011-08-31 | 北京航空航天大学 | 组合导航系统中测量双天线gps安装失准角的方法和装置 |
CN104457754A (zh) * | 2014-12-19 | 2015-03-25 | 东南大学 | 一种基于sins/lbl紧组合的auv水下导航定位方法 |
CN106483498A (zh) * | 2015-09-01 | 2017-03-08 | 北京自动化控制设备研究所 | 一种sinsusbl紧耦合算法 |
CN106767793A (zh) * | 2017-01-19 | 2017-05-31 | 东南大学 | 一种基于sins/usbl紧组合的auv水下导航定位方法 |
CN108413983A (zh) * | 2017-12-21 | 2018-08-17 | 中国船舶重工集团公司第七0七研究所 | 一种sins/usbl一体化定位系统安装误差标定的机械方法 |
CN109324330A (zh) * | 2018-09-18 | 2019-02-12 | 东南大学 | 基于混合无导数扩展卡尔曼滤波的usbl/sins紧组合导航定位方法 |
CN109737956A (zh) * | 2018-12-17 | 2019-05-10 | 东南大学 | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 |
Non-Patent Citations (1)
Title |
---|
张涛等: "基于SINS/LBL 紧组合的AUV 水下导航定位技术", 《中国惯性技术学报》 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110568407A (zh) * | 2019-09-05 | 2019-12-13 | 武汉理工大学 | 一种基于超短基线和航位推算的水下导航定位方法 |
CN110673115A (zh) * | 2019-09-25 | 2020-01-10 | 杭州飞步科技有限公司 | 雷达与组合导航系统的联合标定方法、装置、设备及介质 |
CN110673115B (zh) * | 2019-09-25 | 2021-11-23 | 杭州飞步科技有限公司 | 雷达与组合导航系统的联合标定方法、装置、设备及介质 |
CN113465599A (zh) * | 2021-06-04 | 2021-10-01 | 北京信息科技大学 | 定位定向方法、装置及系统 |
CN113465599B (zh) * | 2021-06-04 | 2023-08-01 | 北京信息科技大学 | 定位定向方法、装置及系统 |
CN113670302A (zh) * | 2021-09-01 | 2021-11-19 | 东南大学 | 一种运动效应影响下的惯性/超短基线组合导航方法 |
CN113670302B (zh) * | 2021-09-01 | 2023-12-05 | 东南大学 | 一种运动效应影响下的惯性/超短基线组合导航方法 |
CN114397644A (zh) * | 2021-12-23 | 2022-04-26 | 山东科技大学 | 一种基于四元数法的超短基线安装误差校准方法 |
CN114397644B (zh) * | 2021-12-23 | 2024-05-28 | 山东科技大学 | 一种基于四元数法的超短基线安装误差校准方法 |
CN114993242A (zh) * | 2022-06-17 | 2022-09-02 | 北京航空航天大学 | 一种基于加速度匹配的阵列式pos安装偏差角标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110132308B (zh) | 2022-04-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110132308A (zh) | 一种基于姿态确定的usbl安装误差角标定方法 | |
CN109324330B (zh) | 基于混合无导数扩展卡尔曼滤波的usbl/sins紧组合导航定位方法 | |
CN104316045B (zh) | 一种基于sins/lbl的auv水下交互辅助定位系统及定位方法 | |
CN109737956B (zh) | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 | |
WO2020062791A1 (zh) | 一种深海潜航器的sins/dvl水下抗晃动对准方法 | |
CN106767793A (zh) | 一种基于sins/usbl紧组合的auv水下导航定位方法 | |
CN110121662A (zh) | 海上gnss参考站装置、海上gnss定位系统以及生成海上定位参考数据的方法 | |
CN105547290B (zh) | 一种基于超短基线定位系统的从潜器导航方法 | |
CN110057365A (zh) | 一种大潜深auv下潜定位方法 | |
CN106643709B (zh) | 一种海上运载体的组合导航方法及装置 | |
CN111896962B (zh) | 一种海底应答器定位方法、系统、存储介质及应用 | |
CN105486313A (zh) | 一种基于usbl辅助低成本sins系统的定位方法 | |
CN103528536B (zh) | 一种基于光纤陀螺惯导系统的船体变形测量方法 | |
CN107748352B (zh) | 适用于浅水定位的超短基线装置及定位方法 | |
CN113311388B (zh) | 一种水下机器人的超短基线定位系统 | |
CN110703202B (zh) | 基于多声学波浪滑翔机和水面无人艇的水下脉冲声定位系统 | |
CN104197939A (zh) | 基于水下信息网络的多参考节点水下航行器组合导航方法 | |
CN111982105A (zh) | 一种基于sins/lbl紧组合的水下导航定位方法及系统 | |
CN110132281A (zh) | 一种基于询问应答模式的水下高速目标高精度自主声学导航方法 | |
Zhang et al. | A passive acoustic positioning algorithm based on virtual long baseline matrix window | |
CN113155134B (zh) | 一种基于惯性信息辅助的水声信道跟踪与预测方法 | |
CN115096302A (zh) | 捷联惯性基导航系统信息滤波鲁棒对准方法、系统及终端 | |
CN112684453B (zh) | 一种基于无人潜航器双基地声纳系统的定位误差修正方法 | |
Zhao et al. | The experimental study on GPS/INS/DVL integration for AUV | |
CN116358544A (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 |