CN115727837A - 基于航姿和dvl的小型auv导航定位的方法及装置 - Google Patents
基于航姿和dvl的小型auv导航定位的方法及装置 Download PDFInfo
- Publication number
- CN115727837A CN115727837A CN202211361743.2A CN202211361743A CN115727837A CN 115727837 A CN115727837 A CN 115727837A CN 202211361743 A CN202211361743 A CN 202211361743A CN 115727837 A CN115727837 A CN 115727837A
- Authority
- CN
- China
- Prior art keywords
- auv
- small
- dvl
- small auv
- resolving
- 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
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/30—Assessment of water resources
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种基于航姿和DVL的小型AUV导航定位的方法及装置,所述方法包括:基于多普勒计程仪(DVL)的标定参数,对DVL载体系下速度进行修正;将所述修正后的速度转换为地理系下的速度;设置所述小型AUV的导航系统的解算周期为DVL的测速周期;基于所述解算周期、当前解算周期的上一解算周期确定的所述小型AUV的位置信息、以及所述地理系下的速度对所述小型AUV的位置信息进行实时推算,实时确定所述小型AUV的位置信息;基于所述小型AUV是否获得GPS定位信息确定所述小型AUV的位置信息。本发明的方法,综合考虑了小型AUV的俯仰角、横滚角、航向角等信息,考虑了速度矢量在三维空间中的旋转,水下导航定位精度高。
Description
技术领域
本发明涉及导航技术领域,具体涉及一种基于航姿和DVL的小型AUV导航定位的方法及装置。
背景技术
自主式水下无人潜航器(autonomous underwater vehicle,AUV),由于其体积小、使用成本低、智能化自主作业、保障维护方便、隐蔽性好等诸多优点,在海洋开发等领域正发挥着越来越重要的作用。随着AUV应用领域的逐渐扩展,对导航系统的要求也越来越高,需要具备远航程和长航时的高精度导航定位能力。因为高精度导航定位,决定着AUV能否安全作业及返回,以及水下目标定位、海底地形测绘、水下定点布放等作业结果的准确性。目前,AUV大多使用由FINS、GPS和DVL构成的组合导航系统。但成本过于高昂,且尺寸重量和功耗较大,不能很好满足小型AUV对导航设备的需要。同时,有关小型AUV水下导航定位的文献提到基于航姿和DVL的方式,但其仅使用了航向角和DVL三轴速度的方式,未考虑航行体的水平航行姿态(俯仰角、横滚角)对速度矢量在空间旋转中的作用。
针对上述不足,为了能够以较低的成本,本发明基于磁罗盘(或AHRS)和高精度DVL来实现水下导航定位,为小型AUV获得较高精度的水下导航定位能力。
发明内容
有鉴于此,本发明提供了一种基于航姿和DVL的小型AUV导航定位的方法及装置,能够解决现有的AUV普遍采用的GPS/INS/DVL组合导航系统,存在设备尺寸重量过大无法在小型AUV上安装、功耗较大、成本过高、系统标校复杂,以及仅采用航向角和DVL的方式未考虑速度矢量在空间中的旋转等技术问题。
为了解决上述技术问题,本发明是这样实现的。
一种基于航姿和DVL的小型AUV导航定位的方法,包括:
步骤S1:基于多普勒计程仪(DVL)的标定参数,对DVL载体系下速度进行修正,修正后的速度记为vb;所述DVL配置于所述小型AUV中;
步骤S2:将所述修正后的速度转换为地理系下的速度;
步骤S3:设置所述小型AUV的导航系统的解算周期为DVL的测速周期;基于所述解算周期、当前解算周期的上一解算周期确定的所述小型AUV的位置信息、以及所述地理系下的速度对所述小型AUV的位置信息进行实时推算,实时确定所述小型AUV的位置信息;若当前解算周期为第一个解算周期,所述上一解算周期确定的所述小型AUV的位置信息为导航系统启动时刻的GPS定位信息;
步骤S4:实时检测所述小型AUV是否获得GPS定位信息,若是,基于GPS定位信息更新当前解算周期确定的所述小型AUV的位置信息;否则,将实时推算的所述小型AUV的位置信息作为当前解算周期确定的所述小型AUV的位置信息。
优选地,所述步骤S1,其中,所述多普勒计程仪(DVL)的标定参数的确定方式包括:
步骤S11:所述DVL初次使用时,标定参数[ε,k]的初始值为[0,1];其中,ε为磁罗盘/或AHRS和DVL的两者载体坐标系间航向安装夹角,k为所述DVL的标度因数;
步骤S12:使所述小型AUV在水域开展一段水下航行,在所述小型AUV入水前设置所述导航系统不再使用GPS定位信息来刷新导航系统的经纬度;获取num组所述小型AUV在入水前和出水后的同步数据,每组同步数据包括两对数据,每对代表同一位置处所述小型AUV的GPS定位信息和所述小型AUV推算的位置信息;两对数据代表的位置彼此不同,一对代表所述小型AUV入水前的同步数据,另一对代表所述小型AUV出水后的同步数据;
步骤S13:对num组中的每一组所述小型AUV的同步数据,均执行以下操作:
获取当前组中所述小型AUV的GPS定位信息(LA,λA)及(LB,λB),获取当前组中所述小型AUV的经解算获得的位置信息(LA1,λA1)及(LC,λC),其中(LA,λA)与(LA1,λA1)对应入水前的同一位置,(LB,λB)与(LC,λC)对应出水后的同一位置,LA为AUV入水前GPS纬度,λA为AUV入水前GPS经度,LA1为AUV入水前所述小型AUV的经解算获得的纬度,λA1为AUV入水前所述小型AUV的经解算获得的经度;LB为AUV出水后GPS纬度,λB为AUV出水后GPS经度,LC为AUV出水后所述小型AUV的经解算获得的纬度,λC为AUV出水后所述小型AUV的经解算获得的经度;
则基于该组所述小型AUV的同步数据,确定标定参数[ε,k]:
ε=atan(dN_GNSS/dE_GNSS)-atan(dN_dvl/dE_dvl) (2)
其中:
dN_dvl=(LC-LA1)·Re
dN_GNSS=(LB-LA)·Re
其中,Re为地球半径,dN_dvl、dE_dvl分别为第一位置与第二位置对应的所述小型AUV解算的位置之间的北向距离和东向距离;dN_GNSS、dE_GNSS分别为第一位置与第二位置之间的GPS定位的实际的北向距离和东向距离;第一位置是所述小型AUV入水前的位置,第二位置是所述小型AUV入水潜行后露出水面的位置;
步骤S14:对num组中每个组确定出的标定参数[ε,k],去掉最大的ε值及最小的ε值,余下的ε值求和后取平均,作为最终的ε值;去掉最大的k值及最小的k值,余下的k值求和后取平均,作为最终的k值;将最终的ε值及最终的k值作为所述多普勒计程仪(DVL)的标定参数[ε,k]。
优选地,所述步骤S1,包括:
b′系为DVL载体坐标系。
优选地,所述步骤S2,包括:
将修正后的速度vb转换为n系下的速度vn,n系为导航坐标系:
si=sin(ψ)sj=sin(θ)sk=sin(φ) (4)
ci=cos(ψ)cj=cos(θ)ck=cos(φ) (5)
其中:ψ为实时航向角,θ为实时俯仰角,φ为实时横滚角,均由电子磁罗盘或AHRS实时给出。
优选地,所述步骤S3,包括:
设所述小型AUV的导航系统的解算周期为Δt,Δt为所述小型AUV的姿态和DVL两者中更新慢的更新周期;
实时推算的所述小型AUV的位置信息为:
其中,Lt-1为上一解算周期确定的所述小型AUV的纬度、λt-1为上一解算周期确定的所述小型AUV的经度,ht-1为上一解算周期确定的所述小型AUV的海拔高度;Lt为当前解算周期确定的所述小型AUV的纬度、λt为当前解算周期确定的所述小型AUV的经度,ht为当前解算周期确定的所述小型AUV的海拔高度,RM为当前位置处的地球卯酉圈半径,为当前DVL转换为地理系下北向速度,RN为当前位置处的地球子午圈半径,为当前DVL转换为地理系下东向速度,为当前DVL转换为地理系下天向速度。
本发明所提供的一种基于航姿和DVL的小型AUV导航定位的装置,所述装置包括:
修正模块:配置为基于多普勒计程仪(DVL)的标定参数,对DVL载体系下速度进行修正,修正后的速度记为vb;所述DVL配置于所述小型AUV中;
转换模块:配置为将所述修正后的速度转换为地理系下的速度;
解算模块:配置为设置所述小型AUV的导航系统的解算周期为DVL的测速周期;基于所述解算周期、当前解算周期的上一解算周期确定的所述小型AUV的位置信息、以及所述地理系下的速度对所述小型AUV的位置信息进行实时推算,实时确定所述小型AUV的位置信息;若当前解算周期为第一个解算周期,所述上一解算周期确定的所述小型AUV的位置信息为导航系统启动时刻的GPS定位信息;
更新模块:配置为实时检测所述小型AUV是否获得GPS定位信息,若是,基于GPS定位信息更新当前解算周期确定的所述小型AUV的位置信息;否则,将实时推算的所述小型AUV的位置信息作为当前解算周期确定的所述小型AUV的位置信息。
本发明所提供的一种计算机可读存储介质,所述存储介质中存储有多条指令;所述多条指令,用于由处理器加载并执行如前所述方法。
本发明所提供的一种电子设备,其特征在于,所述电子设备,包括:
处理器,用于执行多条指令;
存储器,用于存储多条指令;
其中,所述多条指令,用于由所述存储器存储,并由所述处理器加载并执行如前所述方法。
有益效果:
(1)本发明适用于小型AUV,成本低、功耗小。
(2)本发明导航系统标校简便,易于实施。
(3)本发明综合考虑了小型AUV的俯仰角、横滚角、航向角等信息,考虑了速度矢量在三维空间中的旋转,水下导航定位精度高。
附图说明
图1为本发明提供的基于航姿和DVL的小型AUV导航定位的方法流程示意图;
图2为本发明提供的基于航姿和DVL的小型AUV导航定位的原理示意图;
图3为本发明提供的基于航姿和DVL的小型AUV导航定位的方法的标定原理示意图;
图4为本发明提供的基于航姿和DVL的小型AUV导航定位的装置结构示意图。
具体实施方式
下面结合附图和实施例,对本发明进行详细描述。
定义:
所涉及的坐标系定义如下:
b系:惯性测量单元坐标系(右-前-上);
b′系:DVL载体坐标系(右-前-上);
n系:导航坐标系(东-北-天);
e系:地球坐标系,oxe轴在赤道平面内且指向本初子午线,oze轴平行于地球自转轴,oye由右手坐标系确定。
如图1-2所示,本发明提出了一种基于航姿和DVL的小型AUV导航定位的方法,包括如下步骤:
步骤S1:基于多普勒计程仪(DVL)的标定参数,对DVL载体系下速度进行修正,修正后的速度记为vb;所述DVL配置于所述小型AUV中;
步骤S2:将所述修正后的速度转换为地理系下的速度;
步骤S3:设置所述小型AUV的导航系统的解算周期为DVL的测速周期;基于所述解算周期、当前解算周期的上一解算周期确定的所述小型AUV的位置信息、以及所述地理系下的速度对所述小型AUV的位置信息进行实时推算,实时确定所述小型AUV的位置信息;若当前解算周期为第一个解算周期,所述前一解算周期确定的所述小型AUV的位置信息为导航系统启动时刻的GPS定位信息;
步骤S4:实时检测所述小型AUV是否获得GPS定位信息,若是,基于GPS定位信息更新当前解算周期确定的所述小型AUV的位置信息;否则,将实时推算的所述小型AUV的位置信息作为当前解算周期确定的所述小型AUV的位置信息。
进一步地,将所述当前解算周期确定的所述小型AUV的位置信息作为部署于所述小型AUV的导航系统的经纬度信息。
本发明中,当所述小型AUV在码头、甲板或水面时,即所述小型AUV未潜入水下时,能够获得GPS定位信息。所述小型AUV潜入水下时,不能获得GPS定位信息,此时,能够获得DVL的测速信息,进而计算当前解算周期的所述小型AUV的位置信息。本发明中,所述小型AUV开机后一旦获得GPS定位信息,则部署于所述小型AUV的导航系统开始运行,当所述小型AUV处于码头、甲板或水面时,一旦实时收到GPS定位信息,则对导航系统的经纬度进行更新。当所述小型AUV上浮出水后,接收GPS并实时刷新导航系统的经纬度。
如图3所示,所述步骤S1,其中,所述多普勒计程仪(DVL)的标定参数的确定方式包括:
步骤S11:所述DVL初次使用时,标定参数[ε,k]的初始值为[0,1];其中,ε为磁罗盘/或AHRS和DVL的两者载体坐标系间航向安装夹角,k为所述DVL的标度因数;
步骤S12:使所述小型AUV水域开展一段水下航行,在所述小型AUV入水前设置所述导航系统不再使用GPS定位信息来刷新导航系统的经纬度;获取num组所述小型AUV在入水前和出水后的同步数据,每组同步数据包括两对数据,每对代表同一位置处所述小型AUV的GPS定位信息和所述小型AUV推算的位置信息,两对数据代表的位置彼此不同,一对代表所述小型AUV入水前的同步数据,另一对代表所述小型AUV出水后的同步数据;
本实施例中,所述同步数据是通过驱动所述小型AUV潜行一段距离,并使之露出水面获得的。例如,所述小型AUV潜行时,所述小型AUV基于标定参数[ε,k]的初始值及DVL实时测速信息对所述小型AUV的位置信息进行解算。在所述小型AUV入水前设置导航系统不再使用GPS定位信息来刷新导航系统的经纬度,之后记录并获取此时解算出的所述小型AUV的位置信息和此时所述小型AUV的GPS定位信息;记录的所述小型AUV的位置信息和此时所述小型AUV的GPS定位信息形成一对数据。所述小型AUV在水下潜行一段距离后,在所述小型AUV露出水面后,记录并获取此时解算出的所述小型AUV的位置信息和此时所述小型AUV的GPS定位信息;记录的所述小型AUV的位置信息和此时所述小型AUV的GPS定位信息形成一对数据。这两对数据形成了一组所述小型AUV的同步数据。
步骤S13:对num组中的每一组所述小型AUV的同步数据,均执行以下操作:
获取当前组中所述小型AUV的GPS定位信息(LA,λA)及(LB,λB),获取当前组中所述小型AUV的经解算获得的位置信息(LA1,λA1)及(LC,λC),其中(LA,λA)与(LA1,λA1)对应入水前的同一位置,(LB,λB)与(LC,λC)对应出水后的同一位置,LA为AUV入水前GPS纬度,λA为AUV入水前GPS经度,LA1为AUV入水前所述小型AUV的经解算获得的纬度,λA1为AUV入水前所述小型AUV的经解算获得的经度;LB为AUV出水后GPS纬度,λB为AUV出水后GPS经度,LC为AUV出水后所述小型AUV的经解算获得的纬度,λC为AUV出水后所述小型AUV的经解算获得的经度;
本实施例中,所述小型AUV的经解算获得的经度、纬度能够确定一个位置信息,第一位置是所述小型AUV入水前的位置,因此,GPS定位的位置与所述小型AUV解算的位置都对应同一位置点。第二位置是所述小型AUV入水潜行后露出水面的位置,因此,GPS定位的位置是该第二位置的实际位置,所述小型AUV解算的位置与该第二位置的实际位置可能存在一定的偏差。
则基于该组所述小型AUV的同步数据,确定标定参数[ε,k]:
ε=atan(dN_GNSS/dE_GNSS)-atan(dN_dvl/dE_dvl) (2)
其中:
dN_dvl=(LC-LA1)·Re
dN_GNSS=(LB-LA)·Re
其中,Re为地球半径,dN_dvl、dE_dvl分别为第一位置与第二位置对应的所述小型AUV解算的位置(LC,λC)之间的北向距离和东向距离;dN_GNSS、dE_GNSS分别为第一位置与第二位置之间的GPS定位的实际的北向距离和东向距离;第一位置是所述小型AUV入水前的位置,第二位置是所述小型AUV入水潜行后露出水面的位置。
步骤S14:对num组中每个组确定出的标定参数[ε,k],去掉最大的ε值及最小的ε值,余下的ε值求和后取平均,作为最终的ε值;去掉最大的k值及最小的k值,余下的k值求和后取平均,作为最终的k值;将最终的ε值及最终的k值作为所述多普勒计程仪(DVL)的标定参数[ε,k]。
进一步地,可以将所述多普勒计程仪(DVL)的标定参数[ε,k]写入FLASH。
所述步骤S1:基于多普勒计程仪(DVL)的标定参数[ε,k]对DVL载体系下的所述小型AUV的速度进行修正,修正后的速度记为vb,包括:
所述步骤S2:将所述修正后的速度转换为地理系下的速度,包括:
将修正后的速度vb转换为n系下的速度vn:
si=sin(ψ)sj=sin(θ)sk=sin(φ) (4)
ci=cos(ψ)cj=cos(θ)ck=cos(φ) (5)
其中:ψ为实时航向角,θ为实时俯仰角,φ为实时横滚角,均由电子磁罗盘或AHRS实时给出。
所述步骤S3:设置所述小型AUV的导航系统的解算周期为DVL测速周期,基于所述解算周期、当前解算周期的上一解算周期确定的所述小型AUV的位置信息、以及所述地理系下的速度对所述小型AUV的位置信息进行实时推算,实时确定所述小型AUV的位置信息;若当前解算周期为第一个解算周期,所述前一解算周期确定的所述小型AUV的位置信息为导航系统启动时刻的GPS定位信息,包括:
设所述小型AUV的导航系统的解算周期为Δt,Δt为所述小型AUV的姿态和DVL两者中更新慢的更新周期(一般为DVL更新周期);
实时推算的所述小型AUV的位置信息为:
其中,Lt-1为上一解算周期确定的所述小型AUV的纬度、λt-1为上一解算周期确定的所述小型AUV的经度,ht-1为上一解算周期确定的所述小型AUV的海拔高度;Lt为当前解算周期确定的所述小型AUV的纬度、λt为当前解算周期确定的所述小型AUV的经度,ht为当前解算周期确定的所述小型AUV的海拔高度,RM为当前位置处的地球卯酉圈半径,为当前DVL转换为地理系下北向速度,RN为当前位置处的地球子午圈半径,为当前DVL转换为地理系下东向速度,为当前DVL转换为地理系下天向速度。
本发明中,步骤S1,对所述多普勒计程仪(DVL)的标定参数进行确定的过程中,涉及对所述小型AUV的位置信息进行解算,其解算方式与本发明的步骤S1至步骤S4相同,其中,步骤S1中的基于多普勒计程仪(DVL)的标定参数取值为[0,1],在此不再赘述。
本发明还提供了一种基于航姿和DVL的小型AUV导航定位的装置,如图4所示,该装置包括:
修正模块:配置为基于多普勒计程仪(DVL)的标定参数,对DVL载体系下速度进行修正,修正后的速度记为vb;所述DVL配置于所述小型AUV中;
转换模块:配置为将所述修正后的速度转换为地理系下的速度;
解算模块:配置为设置所述小型AUV的导航系统的解算周期为DVL的测速周期;基于所述解算周期、当前解算周期的上一解算周期确定的所述小型AUV的位置信息、以及所述地理系下的速度对所述小型AUV的位置信息进行实时推算,实时确定所述小型AUV的位置信息;若当前解算周期为第一个解算周期,所述上一解算周期确定的所述小型AUV的位置信息为导航系统启动时刻的GPS定位信息;
更新模块:配置为实时检测所述小型AUV是否获得GPS定位信息,若是,基于GPS定位信息更新当前解算周期确定的所述小型AUV的位置信息;否则,将实时推算的所述小型AUV的位置信息作为当前解算周期确定的所述小型AUV的位置信息。
以上的具体实施例仅描述了本发明的设计原理,该描述中的部件形状,名称可以不同,不受限制。所以,本发明领域的技术人员可以对前述实施例记载的技术方案进行修改或等同替换;而这些修改和替换未脱离本发明创造宗旨和技术方案,均应属于本发明的保护范围。
Claims (8)
1.一种基于航姿和DVL的小型AUV导航定位的方法,其特征在于,所述方法包括如下步骤:
步骤S1:基于多普勒计程仪(DVL)的标定参数,对DVL载体系下速度进行修正,修正后的速度记为vb;所述DVL配置于所述小型AUV中;
步骤S2:将所述修正后的速度转换为地理系下的速度;
步骤S3:设置所述小型AUV的导航系统的解算周期为DVL的测速周期;基于所述解算周期、当前解算周期的上一解算周期确定的所述小型AUV的位置信息、以及所述地理系下的速度对所述小型AUV的位置信息进行实时推算,实时确定所述小型AUV的位置信息;若当前解算周期为第一个解算周期,所述上一解算周期确定的所述小型AUV的位置信息为导航系统启动时刻的GPS定位信息;
步骤S4:实时检测所述小型AUV是否获得GPS定位信息,若是,基于GPS定位信息更新当前解算周期确定的所述小型AUV的位置信息;否则,将实时推算的所述小型AUV的位置信息作为当前解算周期确定的所述小型AUV的位置信息。
2.如权利要求1所述的方法,其特征在于,所述步骤S1,其中,所述多普勒计程仪(DVL)的标定参数的确定方式包括:
步骤S11:所述DVL初次使用时,标定参数[ε,k]的初始值为[0,1];其中,ε为磁罗盘/或AHRS和DVL的两者载体坐标系间航向安装夹角,k为所述DVL的标度因数;
步骤S12:使所述小型AUV在水域开展一段水下航行,在所述小型AUV入水前设置所述导航系统不再使用GPS定位信息来刷新导航系统的经纬度;获取num组所述小型AUV在入水前和出水后的同步数据,每组同步数据包括两对数据,每对代表同一位置处所述小型AUV的GPS定位信息和所述小型AUV推算的位置信息;两对数据代表的位置彼此不同,一对代表所述小型AUV入水前的同步数据,另一对代表所述小型AUV出水后的同步数据;
步骤S13:对num组中的每一组所述小型AUV的同步数据,均执行以下操作:
获取当前组中所述小型AUV的GPS定位信息(LA,λA)及(LB,λB),获取当前组中所述小型AUV的经解算获得的位置信息(LA1,λA1)及(LC,λC),其中(LA,λA)与(LA1,λA1)对应入水前的同一位置,(LB,λB)与(LC,λC)对应出水后的同一位置,LA为AUV入水前GPS纬度,λA为AUV入水前GPS经度,LA1为AUV入水前所述小型AUV的经解算获得的纬度,λA1为AUV入水前所述小型AUV的经解算获得的经度;LB为AUV出水后GPS纬度,λB为AUV出水后GPS经度,LC为AUV出水后所述小型AUV的经解算获得的纬度,λC为AUV出水后所述小型AUV的经解算获得的经度;
则基于该组所述小型AUV的同步数据,确定标定参数[ε,k]:
ε=atan(dN_GNSS/dE_GNSS)-atan(dN_dvl/dE_dvl) (2)
其中:
dN_dvl=(LC-LA1)·Re
dN_GNSS=(LB-LA)·Re
其中,Re为地球半径,dN_dvl、dE_dvl分别为第一位置与第二位置对应的所述小型AUV解算的位置之间的北向距离和东向距离;dN_GNSS、dE_GNSS分别为第一位置与第二位置之间的GPS定位的实际的北向距离和东向距离;第一位置是所述小型AUV入水前的位置,第二位置是所述小型AUV入水潜行后露出水面的位置;
步骤S14:对num组中每个组确定出的标定参数[ε,k],去掉最大的ε值及最小的ε值,余下的ε值求和后取平均,作为最终的ε值;去掉最大的k值及最小的k值,余下的k值求和后取平均,作为最终的k值;将最终的ε值及最终的k值作为所述多普勒计程仪(DVL)的标定参数[ε,k]。
5.如权利要求4所述的方法,其特征在于,所述步骤S3,包括:
设所述小型AUV的导航系统的解算周期为Δt,Δt为所述小型AUV的姿态和DVL两者中更新慢的更新周期;
实时推算的所述小型AUV的位置信息为:
6.一种基于航姿和DVL的小型AUV导航定位的装置,其特征在于,所述装置包括:
修正模块:配置为基于多普勒计程仪(DVL)的标定参数,对DVL载体系下速度进行修正,修正后的速度记为vb;所述DVL配置于所述小型AUV中;
转换模块:配置为将所述修正后的速度转换为地理系下的速度;
解算模块:配置为设置所述小型AUV的导航系统的解算周期为DVL的测速周期;基于所述解算周期、当前解算周期的上一解算周期确定的所述小型AUV的位置信息、以及所述地理系下的速度对所述小型AUV的位置信息进行实时推算,实时确定所述小型AUV的位置信息;若当前解算周期为第一个解算周期,所述上一解算周期确定的所述小型AUV的位置信息为导航系统启动时刻的GPS定位信息;
更新模块:配置为实时检测所述小型AUV是否获得GPS定位信息,若是,基于GPS定位信息更新当前解算周期确定的所述小型AUV的位置信息;否则,将实时推算的所述小型AUV的位置信息作为当前解算周期确定的所述小型AUV的位置信息。
7.一种计算机可读存储介质,所述存储介质中存储有多条指令;所述多条指令,用于由处理器加载并执行如权利要求1-5中任一项所述方法。
8.一种电子设备,其特征在于,所述电子设备,包括:
处理器,用于执行多条指令;
存储器,用于存储多条指令;
其中,所述多条指令,用于由所述存储器存储,并由所述处理器加载并执行如权利要求1-5中任一项所述方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211361743.2A CN115727837A (zh) | 2022-11-02 | 2022-11-02 | 基于航姿和dvl的小型auv导航定位的方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211361743.2A CN115727837A (zh) | 2022-11-02 | 2022-11-02 | 基于航姿和dvl的小型auv导航定位的方法及装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115727837A true CN115727837A (zh) | 2023-03-03 |
Family
ID=85294439
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211361743.2A Pending CN115727837A (zh) | 2022-11-02 | 2022-11-02 | 基于航姿和dvl的小型auv导航定位的方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115727837A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117606491A (zh) * | 2024-01-24 | 2024-02-27 | 中国海洋大学 | 一种自主式水下航行器的组合定位导航方法及装置 |
-
2022
- 2022-11-02 CN CN202211361743.2A patent/CN115727837A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117606491A (zh) * | 2024-01-24 | 2024-02-27 | 中国海洋大学 | 一种自主式水下航行器的组合定位导航方法及装置 |
CN117606491B (zh) * | 2024-01-24 | 2024-04-26 | 中国海洋大学 | 一种自主式水下航行器的组合定位导航方法及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Specht et al. | Application of an autonomous/unmanned survey vessel (ASV/USV) in bathymetric measurements | |
CN109782323B (zh) | 一种深海水下自主航行器导航定位及校准方法 | |
CN110779521A (zh) | 一种多源融合的高精度定位方法与装置 | |
CN102829777A (zh) | 自主式水下机器人组合导航系统及方法 | |
CN109631884B (zh) | 一种基于单浮标的无源水下导航方法 | |
CN110806209A (zh) | 一种水下机器人多设备组合导航系统及方法 | |
JP7214896B2 (ja) | 水中天測航法ビーコン | |
JP6486234B2 (ja) | 測位装置及び測位方法 | |
CN115727837A (zh) | 基于航姿和dvl的小型auv导航定位的方法及装置 | |
CN104776847A (zh) | 一种适用于水下导航系统单点估计陀螺漂移的方法 | |
CN104061930A (zh) | 基于捷联惯性制导和多普勒计程仪的导航方法 | |
US10948292B2 (en) | Sensor error calculating device, attitude angle calculating apparatus, method of calculating sensor error and method of calculating attitude angle | |
CN115096302A (zh) | 捷联惯性基导航系统信息滤波鲁棒对准方法、系统及终端 | |
Godhavn | High quality heave measurements based on GPS RTK and accelerometer technology | |
CN112484721A (zh) | 一种水下移动平台导航方法以及水下移动平台导航装置 | |
CN115390012B (zh) | 用于hov精准定位的多应答器坐标测量方法、装置及系统 | |
RU198953U1 (ru) | Устройство определения параметров движения судна | |
CN115718312A (zh) | 用于小型auv的基于航姿和螺旋桨转速的水下导航定位方法 | |
CN114440925A (zh) | 一种auv组合导航系统忽略水平姿态的dvl标定方法 | |
CN103697887A (zh) | 基于捷联惯性制导和多普勒计程仪的优化导航方法 | |
CN110763228B (zh) | 基于海底油气管节点位置的组合导航系统误差修正方法 | |
CN110057383B (zh) | 一种auv推位导航系统杆臂误差标校方法 | |
CN112964250A (zh) | 基于北斗和降维imu数据的船舶运动姿态估计方法 | |
CN202928582U (zh) | 一种浮船式钻井平台姿态监控及定位装置 | |
McEwen et al. | Performance of an AUV navigation system at arctic latitudes |
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 |