CN102519450A - 一种用于水下滑翔器的组合导航装置及方法 - Google Patents
一种用于水下滑翔器的组合导航装置及方法 Download PDFInfo
- Publication number
- CN102519450A CN102519450A CN2011104121143A CN201110412114A CN102519450A CN 102519450 A CN102519450 A CN 102519450A CN 2011104121143 A CN2011104121143 A CN 2011104121143A CN 201110412114 A CN201110412114 A CN 201110412114A CN 102519450 A CN102519450 A CN 102519450A
- Authority
- CN
- China
- Prior art keywords
- underwater glider
- information
- electronic compass
- navigation
- mems
- 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
Images
Landscapes
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公布了一种用于水下滑翔器的组合导航装置及方法,装置包括电子罗盘、微机电***惯性测量单元、全球卫星***接收模块、数字信号处理处理模块。本发明采用MEMS陀螺、加速度计组成的姿态测量单元和电子罗盘集成为惯性组合导航与定位***来与控制***配合,使用DSP技术作为导航解算部件,经过在全温范围内对各传感器进行降噪、温度补偿、非线性校正、交叉耦合补偿及航位推算等多种算法,完成水下滑翔体的自主准确定位。本发明的优点在于体积小、集成度高、功耗低、长航时、成本低等,能迅速准确地得到水下滑翔器当前位姿信息,使它保持本体平衡,同时为其提供航迹和位置参数。
Description
技术领域
本发明涉及一种用于水下滑翔器的组合导航装置设计及方法,该装置具有体积小、低功耗、长航时等特点,可实现水下滑翔器的准确定位和自主导航。
背景技术
电子罗盘可分为平面电子罗盘和三维电子罗盘,比起平面罗盘,三维电子罗盘因其内部加入了倾角传感器,克服了平面电子罗盘在使用中的严格限制,即使罗盘发生了倾斜,航向数据依然准确无误。有的罗盘还内置了温度补偿,最大限度得减少倾斜角和指向角的温度漂移。电子罗盘技术在国外应用比较多,但是在水下应用还存在一些问题。
GPS技术在导航、定位、测速、定向方面有着广泛的应用,但由于其信号常被地形、地物遮挡,导致精度大大降低,甚至不能使用。尤其是在高楼林立城区和植被茂密的林区,GPS信号的有效性仅为60%。该技术在国内外应用都比较广泛,也比较成熟,但应用于海上潜水器的导航还没有成熟的应用方案。
以惯性导航为主与GPS、电子罗盘集成的组合导航***在国内外陆用、航空、航天以及水面载体有着广泛的应用,但水下滑翔器在水下工作时间很长,并且GPS信息在水下不能使用,单一惯性导航不能满足定位要求,且由于水下滑翔器对功耗、体积和精度要求较高,从而在水下滑翔器中组合导航***均未能得到较好应用。
如何使GPS、电子罗盘、捷联式惯性组合导航***能利用三者的优势,使***整体性能达到最优,并能满足水下滑翔器长航时、低功耗、小体积的要求,这种***在国内、外均无报道。
发明内容
本发明的技术解决问题是:克服现有技术的不足,设计了一种新的水下滑翔器的组合导航装置及方法,其算法克服了传统组合导航***由于误差随时间累积而不能准确长时间定位的欠缺,并采取智能导航工作模式切换、多源***自适应匹配、滤波和智能导航定位优化算法,提供了可靠性更高也更精确的定位服务。再加上硬件设计和软件优化,使得设备体积更小、功耗更低、航时更长,完成水下潜水器的自主导航和定位。
本发明的技术解决方案为:一种用于水下滑翔器的组合导航装置,包括电子罗盘、微机电***惯性测量单元(MEMS-IMU)、全球定位***(GPS)接收模块、数字信号处理(DSP)处理模块;电子罗盘测量方位角得到航向信息;微机电***惯性测量单元(MEMS-IMU)测量姿态和航向变化,并借助电子罗盘航向信息进行校正;全球定位***(GPS)接收模块则完成对水下滑翔器的水面定位、微机电***惯性测量单元(MEMS-IMU)的标定及校正;数字信号处理(DSP)处理模块完成对导航***中各个模块数据的转化、处理,并将航向位置等数据输出到水下滑翔器中心计算机,实现自主导航与定位。
所述电子罗盘采用型号为ADIS16405,其内包括三轴陀螺,三轴加速度计,三轴磁力计。
所述数字信号处理(DSP)处理模块采用型号为TMS320C5505。
所述方法如下:采用电子罗盘测量方位角得到航向信息;采用微机电***惯性测量单元(MEMS-IMU)测量姿态和航向变化,并借助电子罗盘航向信息进行校正;采用全球定位***(GPS)接收模块则完成对水下滑翔器的水面定位、微机电***惯性测量单元(MEMS-IMU)的标定及校正;采用数字信号处理(DSP)处理模块完成对导航***中各个模块数据的转化、处理,并将航向位置等数据输出到水下滑翔器中心计算机,实现自主导航与定位。
所述电子罗盘是由三维磁阻传感器、双轴倾角传感器和微控制单元(MCU)组成;三维磁阻传感器用来测量地球磁场;倾角传感器是在罗盘随着潜水体的倾斜而处于非水平状态时,对罗盘进行倾角补偿,保证了数据依然准确无误;微控制单元(MCU)处理磁力仪和倾角传感器的信号以及数据输出和软铁、硬铁补偿。
一种用于水下滑翔器的组合导航装置的方法,算法包括以下:
(1)初始时刻,GPS对导航测量单元包括三维电子罗盘、三轴加速度计和三轴陀螺进行初始校正,得到初始信息;电子罗盘提供载体的初始航向信息,通过传递对准给捷联惯性导航***以获得初始的失准角信息,而微机电***惯性测量单元测得的角速率和加速度信息由捷联惯性导航***导航姿态解算模块来处理,导航姿态解算***由角速率和加速度信息解算出载体的速度、位置及姿态信息;陀螺和加速度计分别用来测量载体的角运动和线运动信息,导航解算模块根据这些测量信息建立姿态阵解算的数学平台,从而解算出运动载体的航向、姿态、速度及位置;
(2)在长时间运行时,采用电子罗盘的航向角信息来对MEME-SINS输出的信息进行校正,相应的差值作为无迹卡尔曼滤波器的观测量,经无迹卡尔曼滤波估计出的惯导参数误差反馈到捷联惯性导航***导航解算模块内,在力学编排方程中校正惯性传感器的输出,推算的速度和经纬度、建立的姿态矩阵数字平台,将校正后的参数代入下一次运算;经过反馈校正后,捷联惯性导航***输出的导航参数就是组合导航***的输出;
(3)针对水下滑翔器的具体情况,利用航位推算原理,分析航位推算的误差源,在其基础上推导航位推算误差方程,并应用航位推算误差方程对初始误差角、刻度因子和陀螺随机常值漂移进行补偿;对于电子罗盘,通过对软铁及硬铁干扰的分析和建模,提出应用分段补偿的方法对其进行误差补偿;
(4)水下滑翔器工作时间是以水下为主,隔段时间会上浮接收GPS信息,为了保证***低功耗,在水上水下采取不同的算法:水下采用AUKF算法;水上采用联邦滤波算法;
(5)采用水下滑翔器每次工作前首先进行静止零位误差校正;
滑翔体在水中滑翔后浮出水面,首先进行静止零位误差校正,再利用航位推算位置误差来计算初始航向误差角的方法,对动态粗对准的初始航向角进行补偿,完成动态精对准过程;
(6)在陀螺、加速度计和电子罗盘等多传感器数据中,采用新息法来剔除野值。
本发明与现有技术相比的优点在于:
(1)应用于水下滑翔器基于电子罗盘、MEMS捷联惯性***与GPS的***集成技术,实现较简单,体积较小、成本较低、易于优化;
(2)本发明可智能切换导航工作模式和信息融合算法,采用组合***的低功耗设计技术,使水下滑翔器更具有自主性、更合理地利用导航信息资源,适应环境能力强;
(3)基于联邦无迹卡尔曼滤波器与自适应无迹卡尔曼滤波器的导航和定位算法,使得***具有长航时性、高可靠性和高精度。
附图说明
图1为一种用于水下滑翔器的组合导航***原理示意图;
图2为捷联式惯性导航***原理图;
图3为航位推算原理图;
图4为理想原始测量数据获取图;
具体实施方案
下面结合附图对发明的技术方案进行详细说明:
图1是水下滑翔器的组合导航***原理示意图,选用的新型IMU单元将三轴陀螺,三轴加速度计,三轴高性能磁力计集成与一体,该单元体积小,集成度高,功耗低,带有自校正和标定功能。在水下滑翔器放入水中之前,要首先用静止零位误差校正的方法对陀螺产生零位误差进行校正。电子罗盘除了自带的误差补偿外,还应利用GPS信息和分段补偿的方法对其进行误差补偿。这样就使导航测量单元(包括三维电子罗盘、三轴加速度计和三轴陀螺)得到精确的初始信息。图4是理想原始测量数据信息获取路径,在经过对惯性器件标定并获取理想原始信息的基础上,设计基于捷联状态下的适合水下滑翔器运动环境的姿态测量算法。
当滑翔器进入水下前行时,因水下的环境相对稳定,前行速度均匀,利用海流数据库得出海流速度,推算出恒定的外在干扰以用于后续的航位推算。水下只有电子罗盘和MEMS-IMU单元进行工作,电子罗盘提供载体的初始航向信息,通过传递对准给捷联惯性导航***以获得初始的失准角信息,而MEMS测得的角速率和加速度信息由SINS导航姿态解算模块来处理,导航姿态解算***由角速率和加速度信息解算出载体的速度、位置和姿态信息。陀螺和加速度计分别用来测量载体的角运动和线运动信息,导航解算模块根据这些测量信息建立姿态阵解算的数学平台,从而解算出运动载体的航向、姿态、速度及位置。由于惯性导航仪因陀螺的漂移存在随时间积累的误差,故在长时间运行时,采用电子罗盘的航向角信息来对MEMS-SINS输出的信息进行校正,相应的差值作为卡尔曼滤波器的观测量,经卡尔曼滤波估计出的惯导***导航参数误差反馈到SINS导航解算模块内,在力学编排方程中校正惯性传感器的输出、推算的速度和经纬度、建立的姿态矩阵数字平台,将校正后的参数代入下一次运算。因此,经过反馈校正后,惯导***输出的导航参数就是组合导航***的输出。
在水下只有MEMS-IMU和电子罗盘的作用,采用自适应UKF方式来进行滤波,但当滑翔器经过24小时浮到水面,接收到的GPS信号对MEMS-IMU进行校正,由于导航传感器的增加,就需采用基于UKF的联邦滤波算法处理多传感器的信息融合来提高导航精度。这时导航***处在动态环境下,要在短时间和复杂环境下对捷联惯组进行动态高精度初始对准,利用GPS信息对MEMS捷联惯性导航***予以重新对准和校正的同时,还要利用航位推算位置误差来计算初始航向误差角的方法,对动态粗对准的初始航向角进行补偿,通过信息融合方法,完成动态精对准过程。在水下到水上,再到水下的过程中,由于传感器的数量变化导致不同信息量的融合,为了降低功耗,提高***的处理效率,采用切换式组合方式进行航位推算,即GPS模式和DR模式。
对于陀螺、加速度计和电子罗盘等多传感器信号数据中出现的野值,采用新息法来剔除这些野值,这种算法不再依赖于先验的传感器特性,而是通过每次滤波迭代的时候进行判断,为了滤波的连续性,必须在野值被剔除后进行补值,利用对当前新息值加权的方法进行补值,减小新息对滤波精度的影响。
本发明具体如下一种用于水下滑翔器的组合导航装置及方法,其特点在于:由GPS接收模块、MEMS-IMU单元及电子罗盘组合成的导航***,根据不同环境自主重构组合方法,并融入最优算法,充分利用有限的导航数据实现高精度、高可靠性的水下滑翔体定位与导航,具体步骤如下:
(1)算法方面具体为:
(a)航位推算在MEMS捷联姿态算法对准的基础上,结合电子罗盘信息、GPS接收机输出信息、海流数据等进行推算,它们当中任何一个精度出现误差都会影响到航位推算的精度,这其中以MEMS陀螺和电子罗盘的影响最大,除航位推算***外,海流、潮汐和风是影响航位推算的三个重要的因素。
(b)海流数据库的应用:海流主要包括洋流、潮汐或潮流、风、涌、浪等。在近海航行或远海航行时,掌握大洋海流的运动规律,准确估计其流向和流速是提高定位精度、减少事故、节省能源的重要手段。为了准确地计算或者估算海流的大小,还需要通过对一些固定目标进行观测,对数据加以修正。
(c)切换式组合的应用:采用切换式组合方式的航位推算方案,切换式组合方案有两种工作状态:GPS模式和航位推算(DR)模式,***工作在何种模式取决于GPS信号的有效性和DOP精度因子。当滑翔器浮到水面时,***工作在GPS模式,同时利用GPS的输出数据,刷新DR***的推算位置,对航位进行校正;一旦滑翔器潜入水中,GPS定位数据失效或DOP增大到预定的门限,则切换到DR模式。
(d)如图3,假设载体在ti-1时刻的位置为(xi-1,yi-1,zi-1),行驶了Δt(ti-ti-1)时间,在ti时刻到达位置(xi,yi,zi),在ti时刻方位角为Ai,倾斜角为Ii,坐标位置可以表示为
vi=vi-1+Vv
在图3中的非水平段,位置除了有x和y方向上的变化,还有z方向的变化,在水平段位置只有x和y方向上的变化。由于滑翔器是缓慢匀速前行,再结合海底环境,可以认为是相对稳定的环境下前行,所以可以将速度v看成恒值,根据水下海流速度确定水下滑翔器的滑翔速度。前面(1)的(b)中提到了建立海流的数据库,这样就可假定在水下前行受到的阻力也是恒定值,采用一些白噪声作为随机干扰Vv,推算出vi。由以上可以得出位置和速度信息。
(e)由导航传感器本身的元件误差和外界环境及算法引起的***误差是船位推算的误差源。在元件误差中,对陀螺影响较大的误差主要是陀螺的常值误差和陀螺漂移误差,在水下采用将电子罗盘和MEMS捷联惯性导航***输出的两个航向信息进行融合,用电子罗盘的信息估计陀螺误差,不断修正MEMS捷联惯性导航***输出的航向。
(f)电子罗盘的航向输出极易受外界干扰磁场的影响而使精度降低,本发明选用的新型组合导航单元内含了三维电子罗盘,其微处理器中内置了误差补偿算法,可以对电子罗盘受到的软、硬磁干扰进行补偿,但效果有限。为了提高电子罗盘的定向精度,在使用前进行误差补偿。因电子罗盘误差方程在整量程拟合曲线时,尾端出现较大误差,所以将整个区域划分为两部分,前部分应用八位置最小二乘法进行误差补偿;后部分不考虑高次谐波项再构造另一误差模型方程,在该部分取若干采样点,将采样点代入误差方程,利用最小二乘法解算出误差补偿系数,再将误差补偿系数代入模型方程可得到磁航向角。
(g)在实际水下导航过程中,由于数学模型本身的不确定性,再加上环境噪声的影响,预测出来的结果带有误差。为了减小误差,使得结果尽可能地接近真实值,需要进行补偿。在传统的卡尔曼滤波器的基础上提出将自适应滤波和无迹卡尔曼滤波器(UKF)相结合的自适应UKF(AUKF)算法。采用方差调整的原则,将存在偏差的协方差矩阵进行自适应调整,以合理调整在滤波解中的作用。合理的自适应因子能平衡动力学模型信息与观测信息的权比,而且能够控制动力学模型误差对导航参数解的影响。由于预测残差能反映动力学模型的误差量级。若观测信息可靠,动力学模型也可靠,则由动力学模型预测的状态参数,并由状态参数与观测信息求得的预测残差应该很小;反之,若观测信息可靠,且预测残差很大,则表明动力学模型误差较大。如此可以依据预测残差构造判别统计量。自适应因子能够很好地抑制初始值偏差和动力学模型异常扰动误差对导航解的影响,所以将自适应因子引入到UKF算法能够很好地提高滤波器的性能。
(h)在水下只有MEMS-IMU和电子罗盘的作用,采用上述方式来滤波,但当滑翔器浮到水面,接收GPS信号进行信息校正时,由于导航传感器的增加,这时需采用新的滤波算法处理多传感器的信息融合来提高导航精度。组合导航***测量信息有冗余,当某个敏感器性能下降,测量噪声增大时,联邦滤波算法通过调整动态分配因子,降低该子滤波器的置信度,从而保证主滤波器的高精度估计结果,确保了导航***的精度。同时将UKF方法应用到联邦滤波中,由于UKF避免了线性化引入的截断误差,所以基于UKF的联邦滤波算法在观测信息较少以及***初始估计偏差较大时,仍能保持比传统的EKF方法更高的精度,具有更好的鲁棒性。
(i)因每次的***启动而使陀螺产生零位误差,采用水下滑翔器每次工作前首先进行静止零位误差校正的方法。算法如下:
滑翔器在水中潜行24小时后浮到水面,这时导航***处在动态环境下,要在短时间和复杂环境下对捷联惯组进行动态高精度初始对准,利用GPS信息对MEMS捷联惯性导航***予以重新对准和校正的同时,还要利用航位推算位置误差来计算初始航向误差角的方法,对动态粗对准的初始航向角进行补偿,通过信息融合方法,完成动态精对准过程。动态精对准原理如下:
已知坐标系下两点P1(x1,y1)、P2(x2,y2),则两者间夹角θ可通过下式得到
动态精对准时,两点分别为航位推算的位置点,当捷联惯组安装误差进行补偿后,忽略陀螺的漂移,则通过下式就可得到粗对准后的初始航向误差角εU,从而完成整个动态对准。
动态精对准的过程是:首先载体在起始点进行快速粗对准,然后航行一段距离,利用当前点的精确位置信息将航向推算误差进行修正,对初始航向角进行补偿,并和GPS与MEMS捷联惯性***组合滤波输出结果进行信息融合,完成精对准过程。
(j)对于陀螺、加速度计和电子罗盘等多传感器信号数据中,会存在一些野值,若不剔除这些野值,将严重影响导航计算精度,甚至使滤波发散。斑点型野值的出现和元件所处的电磁环境、元件精度密切相关,在水下定位***中,电磁环境和温度相对稳定,故处理野值的主要方向在处理孤立点野值,这里采用新息法来剔除野值。利用新息序列进行野值判断的好处在于不再依赖于先验的传感器特性,而是通过每次滤波迭代的时候进行判断,这种方法的实时性高,同时为了滤波的连续性,必须在野值被剔除后进行补值,利用对当前新息值加权的方法进行补值,减小新息对滤波精度的影响。具体的做法是:在采集到相应的传感器数据后,先用新息法剔除传感器输出信号的野值,相对于最小二乘法在线处理野值方法在野值点附近仍然有波动,但是波动值相对较小,并且修复时间很短;然后采用基于无迹Kalman滤波的方法进行位姿的最优推算。
(2)在性能和处理速度满足要求的情况下,为将功耗降到最低,硬件做了如下设计:
(a)选用了在业界功耗最低的TMS320C5000系列的TMS320C5505芯片(以下简称C5505),该芯片具有超低功耗、高性能、是一款高性价比芯片。在相同情况下执行一段代码,程序在片内的ROM运行要比在SARAM中运行节省10%的能量,执行存放在片内存储器的用户代码所耗能量要比执行存在片外的存储器低,C5505内含DARAM、SARAM、ROM等存储单元,加上其内集成了丰富的外设接口,在和***电路连接时,能省去驱动电路,这些都可以大大简化电路和减小能耗。片内经过优化的FFT协处理器可用于加快分析速度,同时还能将深度休眠模式下的内核功耗降低超低水平。
(b)设计电路时,对于那些不用但允许被悬空的DSP管脚,可通过合适的上拉或下拉将其置于确定的电平可减少由于状态不确定而导致的漏电流损耗能量。
(c)***电路的设计,要尽可能地选用低功耗的***器件。在该电路中主要的***器件就是陀螺、加速度计和电子罗盘,而本发明选用将三轴陀螺,三轴加速度计,三轴高性能磁力计三者集成一体的ADIS16405,该器件体积小,性能好,消除了电子罗盘受MEMS-IMU电磁干扰的影响,对两者进行了校正和标定,使性能更优。它将能优化动态性能的数据调节功能与业界最好的iMEMS技术结合。每种传感器都有自己的动态补偿,能在-40℃~+85℃温度范围内提供准确的传感测量值。
(3)在性能和处理速度满足要求的情况下,为将功耗降到最低,软件做了如下设计:
(a)在不需要DSP的全部运算能力时,可以适当地降低C5505的***时钟频率使DSP适速运行以降低***功耗。如不需要DSP的最高MIPS运算能力时,适当降低***的时钟频率能有效地降低***功耗。
(b)软件设置时,尽可能的使用IDLE和IDLE2指令。IDLE指令将CPU内部操作挂起,但是仍保留内部各部件逻辑的时钟,运行串口等片内外设继续工作。在相同的***时钟下,执行IDLE2指令所需电流更小;若关闭内部部件的输入时钟时执行IDLE2指令,这时电流值会更低,CPU所消耗的电能将大大降低。另外,对于一些具体编程,也可以通过代码处理降低功耗。例如,诸如NOP这类简单的指令,使用RTP(重复指令)将节省电流消耗。同时在软件设计时尽可能地将所要操作的数据存储在同一个数据块中来降低***功耗。
(c)为了减少存储器中的代码量和所取指令的数量,应该优化软件提升性能。使代码更紧凑,这样有助于更好地利用缓存和内部指令缓冲器,而且运行速度更快,故能减少***处于激活模式的时间。
(d)软件设计时从一启动***开始,让不使用的模块处于空闲状态,外设功耗只限于那些在指定时间才需要的I/O口。启动之后,在后台执行一个循环程序来检测哪些功能不需要,然后把它们关断。这时芯片的睡眠模式可以把空闲器件内核及芯片的功耗降至最低。
(e)外设模块的时钟可以通过软件关闭或者打开,关闭不需要或者暂时不用的外设,将不访问的存储器和空闲时的DSP置于低功耗或睡眠模式。编写压缩指令减少代码的大小及访问频率,对SDRAM的访问要尽量采用连续大块的访问方式。另外,对于完成功能后暂时不用的信号管脚,在使用完之后将其关闭。
本发明说明书中未作详细描述的内容属于本领域专业技术人员共知的现有技术。
Claims (6)
1.一种用于水下滑翔器的组合导航装置,其特征在于包括电子罗盘、微机电***惯性测量单元(MEMS-IMU)、全球定位***(GPS)接收模块、数字信号处理(DSP)处理模块;电子罗盘测量方位角得到航向信息;微机电***惯性测量单元(MEMS-IMU)测量姿态和航向变化,并借助电子罗盘航向信息进行校正;全球定位***(GPS)接收模块则完成对水下滑翔器的水面定位、微机电***惯性测量单元(MEMS-IMU)的标定及校正;数字信号处理(DSP)处理模块完成对导航***中各个模块数据的转化、处理,并将航向位置等数据输出到水下滑翔器中心计算机,实现自主导航与定位。
2.根据权利要求1所述的一种用于水下滑翔器的组合导航装置,其特征在于所述电子罗盘采用型号为ADIS16405,其内包括三轴陀螺,三轴加速度计,三轴磁力计。
3.根据权利要求1所述的一种用于水下滑翔器的组合导航装置,其特征在于所述数字信号处理(DSP)处理模块采用型号为TMS320C5505。
4.一种如权利要求1所述的一种用于水下滑翔器的组合导航装置的方法,其特征在于所述方法如下:采用电子罗盘测量方位角得到航向信息;采用微机电***惯性测量单元(MEMS-IMU)测量姿态和航向变化,并借助电子罗盘航向信息进行校正;采用全球定位***(GPS)接收模块则完成对水下滑翔器的水面定位、微机电***惯性测量单元(MEMS-IMU)的标定及校正;采用数字信号处理(DSP)处理模块完成对导航***中各个模块数据的转化、处理,并将航向位置等数据输出到水下滑翔器中心计算机,实现自主导航与定位。
5.根据权利要求4所述的一种用于水下滑翔器的组合导航装置的方法,其特征在于所述电子罗盘是由三维磁阻传感器、双轴倾角传感器和微控制单元(MCU)组成;三维磁阻传感器用来测量地球磁场;倾角传感器是在罗盘随着潜水体的倾斜而处于非水平状态时,对罗盘进行倾角补偿,保证了数据依然准确无误;微控制单元(MCU)处理磁力仪和倾角传感器的信号以及数据输出和软铁、硬铁补偿。
6.根据权利要求4所述的一种用于水下滑翔器的组合导航装置的方法,其特征在于,算法包括以下:
(1)初始时刻,GPS对导航测量单元包括三维电子罗盘、三轴加速度计和三轴陀螺进行初始校正,得到初始信息;电子罗盘提供载体的初始航向信息,通过传递对准给捷联惯性导航***以获得初始的失准角信息,而微机电***惯性测量单元测得的角速率和加速度信息由捷联惯性导航***导航姿态解算模块来处理,导航姿态解算***由角速率和加速度信息解算出载体的速度、位置及姿态信息;陀螺和加速度计分别用来测量载体的角运动和线运动信息,导航解算模块根据这些测量信息建立姿态阵解算的数学平台,从而解算出运动载体的航向、姿态、速度及位置;
(2)在长时间运行时,采用电子罗盘的航向角信息来对MEME-SINS输出的信息进行校正,相应的差值作为无迹卡尔曼滤波器的观测量,经无迹卡尔曼滤波估计出的惯导参数误差反馈到捷联惯性导航***导航解算模块内,在力学编排方程中校正惯性传感器的输出,推算的速度和经纬度、建立的姿态矩阵数字平台,将校正后的参数代入下一次运算;经过反馈校正后,捷联惯性导航***输出的导航参数就是组合导航***的输出;
(3)针对水下滑翔器的具体情况,利用航位推算原理,分析航位推算的误差源,在其基础上推导航位推算误差方程,并应用航位推算误差方程对初始误差角、刻度因子和陀螺随机常值漂移进行补偿;对于电子罗盘,通过对软铁及硬铁干扰的分析和建模,提出应用分段补偿的方法对其进行误差补偿;
(4)水下滑翔器工作时间是以水下为主,隔段时间会上浮接收GPS信息,为了保证***低功耗,在水上水下采取不同的算法:水下采用AUKF算法;水上采用联邦滤波算法;
(5)采用水下滑翔器每次工作前首先进行静止零位误差校正;
滑翔体在水中滑翔后浮出水面,首先进行静止零位误差校正,再利用航位推算位置误差来计算初始航向误差角的方法,对动态粗对准的初始航向角进行补偿,完成动态精对准过程;
(6)在陀螺、加速度计和电子罗盘等多传感器数据中,采用新息法来剔除野值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110412114.3A CN102519450B (zh) | 2011-12-12 | 2011-12-12 | 一种用于水下滑翔器的组合导航装置及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110412114.3A CN102519450B (zh) | 2011-12-12 | 2011-12-12 | 一种用于水下滑翔器的组合导航装置及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102519450A true CN102519450A (zh) | 2012-06-27 |
CN102519450B CN102519450B (zh) | 2014-07-02 |
Family
ID=46290453
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110412114.3A Active CN102519450B (zh) | 2011-12-12 | 2011-12-12 | 一种用于水下滑翔器的组合导航装置及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102519450B (zh) |
Cited By (53)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102853836A (zh) * | 2012-09-10 | 2013-01-02 | 电子科技大学 | 一种基于航迹质量的反馈加权融合方法 |
CN102980577A (zh) * | 2012-12-05 | 2013-03-20 | 南京理工大学 | 一种微型捷联航姿***及其工作方法 |
CN103017755A (zh) * | 2012-11-26 | 2013-04-03 | 哈尔滨工程大学 | 一种水下导航姿态测量方法 |
CN103192957A (zh) * | 2013-02-04 | 2013-07-10 | 中国科学院自动化研究所北仑科学艺术实验中心 | 一种船舶姿态显示装置及控制方法 |
CN103192958A (zh) * | 2013-02-04 | 2013-07-10 | 中国科学院自动化研究所北仑科学艺术实验中心 | 船舶姿态显示装置及控制方法 |
CN103245964A (zh) * | 2013-04-09 | 2013-08-14 | 哈尔滨工程大学 | 一种船舶姿态复合检测装置及其检测方法 |
CN103253357A (zh) * | 2013-02-04 | 2013-08-21 | 中国科学院自动化研究所北仑科学艺术实验中心 | 一种船舶姿态显示装置的控制方法 |
CN103575296A (zh) * | 2013-10-08 | 2014-02-12 | 北京理工大学 | 一种双轴旋转惯导***自标定方法 |
CN103630123A (zh) * | 2013-10-29 | 2014-03-12 | 中国船舶重工集团公司第七〇七研究所 | 一种波浪传感器 |
CN104237920A (zh) * | 2013-06-20 | 2014-12-24 | 英特尔公司 | 高反射环境中的交通工具定位 |
CN104280025A (zh) * | 2013-07-08 | 2015-01-14 | 中国科学院沈阳自动化研究所 | 基于无色卡尔曼滤波的深海机器人超短基线组合导航方法 |
CN104406592A (zh) * | 2014-11-28 | 2015-03-11 | 东南大学 | 一种用于水下滑翔器的导航***及姿态角校正和回溯解耦方法 |
CN104613979A (zh) * | 2013-11-05 | 2015-05-13 | 中国科学院沈阳自动化研究所 | 一种用于标定auv自主导航传感器参数的装置和方法 |
WO2015070451A1 (zh) * | 2013-11-18 | 2015-05-21 | 宇龙计算机通信科技(深圳)有限公司 | 电子罗盘校准方法和终端 |
CN105083124A (zh) * | 2015-09-17 | 2015-11-25 | 郭金林 | 一种一体化动态倒车轨迹视像生成方法及*** |
CN105667743A (zh) * | 2015-12-30 | 2016-06-15 | 中国船舶重工集团公司第七○二研究所 | 一种水下滑翔器的控制方法 |
CN105865452A (zh) * | 2016-04-29 | 2016-08-17 | 浙江国自机器人技术有限公司 | 一种基于间接卡尔曼滤波的移动平台位姿估计方法 |
TWI551845B (zh) * | 2014-03-31 | 2016-10-01 | 英特爾股份有限公司 | 用於電子裝置的慣性測量單元及其電腦程式產品 |
WO2017016413A1 (zh) * | 2015-07-24 | 2017-02-02 | 大连海事大学 | 一种具有自动方向修正功能的水下航行器 |
CN106403937A (zh) * | 2016-07-07 | 2017-02-15 | 上海机电工程研究所 | 提高动基座对准精度的导航信息滤波方法 |
CN106500721A (zh) * | 2016-09-27 | 2017-03-15 | 哈尔滨工程大学 | 一种水下机器人双冗余姿态检测*** |
CN106767792A (zh) * | 2017-01-16 | 2017-05-31 | 东南大学 | 一种水下滑翔器导航***及高精度姿态估计方法 |
CN106990787A (zh) * | 2017-05-16 | 2017-07-28 | 哈尔滨工程大学 | 一种上下体艏向信息融合的波浪滑翔器航点跟踪方法 |
CN107272713A (zh) * | 2016-10-20 | 2017-10-20 | 天津科技大学 | 一种水下机器人不确定流场环境自适应控制*** |
CN104280026B (zh) * | 2013-07-08 | 2017-11-14 | 中国科学院沈阳自动化研究所 | 基于aukf的深海机器人长基线组合导航方法 |
CN107656530A (zh) * | 2016-07-26 | 2018-02-02 | 深圳华清精密科技有限公司 | 变参数开架式海洋水下机器人的轨迹跟踪控制方法、装置和*** |
CN107943859A (zh) * | 2017-11-07 | 2018-04-20 | 千寻位置网络有限公司 | 海量传感器数据收集处理及反馈的***和方法 |
CN108106615A (zh) * | 2017-12-08 | 2018-06-01 | 中船重工西安东仪科工集团有限公司 | 一种可设定初始航向的水下mems航向陀螺 |
CN108344413A (zh) * | 2018-02-07 | 2018-07-31 | 东南大学 | 一种水下滑翔器导航***及其低精度与高精度转换方法 |
CN108562284A (zh) * | 2018-01-25 | 2018-09-21 | 陕西土豆数据科技有限公司 | 一种免转台的多旋翼飞行器的罗盘标定方法 |
CN108693547A (zh) * | 2018-06-05 | 2018-10-23 | 河海大学 | 一种用于水下深潜器的导航***及精准三点定位方法 |
CN108955676A (zh) * | 2018-08-01 | 2018-12-07 | 东南大学 | 深海潜器导航***和用于深海潜器状态切换的数据融合方法 |
CN109253726A (zh) * | 2018-06-22 | 2019-01-22 | 东南大学 | 一种水下滑翔器导航定位***及上浮精度校正方法 |
CN109443347A (zh) * | 2017-07-31 | 2019-03-08 | 意法半导体股份有限公司 | 用于陆地车辆导航的***以及对应的方法 |
CN109506624A (zh) * | 2018-10-31 | 2019-03-22 | 台州职业技术学院 | 一种基于移动机器人的分布式视觉定位***及方法 |
CN109572937A (zh) * | 2018-12-18 | 2019-04-05 | 中国船舶重工集团公司第七0研究所 | 一种深海可控浮标 |
CN109974715A (zh) * | 2019-04-30 | 2019-07-05 | 中国矿业大学(北京) | 捷联惯导和光斑识别组合的掘进机自主导航***及方法 |
CN107167126B (zh) * | 2017-03-31 | 2019-09-20 | 大鹏高科(武汉)智能装备有限公司 | 一种自主式水下机器人组合导航方法和*** |
CN110274591A (zh) * | 2019-06-20 | 2019-09-24 | 东南大学 | 深潜载人潜水器adcp辅助sins导航方法 |
CN110335385A (zh) * | 2019-06-18 | 2019-10-15 | 广东汇泰龙科技股份有限公司 | 一种智能门锁的低功耗实现方法和*** |
CN110376628A (zh) * | 2019-07-12 | 2019-10-25 | 深圳市金溢科技股份有限公司 | 车载终端及基于lte-v的车载通信方法 |
CN110388942A (zh) * | 2019-08-28 | 2019-10-29 | 北京机械设备研究所 | 一种基于角度和速度增量的车载姿态精对准*** |
CN110388941A (zh) * | 2019-08-28 | 2019-10-29 | 北京机械设备研究所 | 一种基于自适应滤波的车辆姿态对准方法 |
CN110823213A (zh) * | 2018-08-14 | 2020-02-21 | 北京自动化控制设备研究所 | 一种提高sins/dr组合导航***相对航向角精度的方法 |
CN110865371A (zh) * | 2019-11-29 | 2020-03-06 | 河海大学 | 一种用于水下探地雷达装置 |
CN110926497A (zh) * | 2019-04-08 | 2020-03-27 | 青岛中海潮科技有限公司 | 水下运载器惯导误差预测、浮起校正自动规划方法、装置 |
CN111025269A (zh) * | 2019-12-19 | 2020-04-17 | 哈尔滨工程大学 | 一种水下机器人传感器安装偏差估计方法 |
CN111366962A (zh) * | 2020-03-12 | 2020-07-03 | 国家深海基地管理中心 | 一种深远海低成本长航时协同导航定位*** |
CN111781626A (zh) * | 2020-08-09 | 2020-10-16 | 湖南星至导航科技有限公司 | 多功能导航***与方法 |
CN112179374A (zh) * | 2019-07-02 | 2021-01-05 | 通用电气航空***有限责任公司 | 操作运载工具的方法 |
CN113093296A (zh) * | 2021-04-15 | 2021-07-09 | 成都纵横自动化技术股份有限公司 | 一种航磁测量方法及相关组件 |
US20220400320A1 (en) * | 2021-06-14 | 2022-12-15 | Andrew Bennett | Mobile ocean exploration platform |
CN118034070A (zh) * | 2024-04-15 | 2024-05-14 | 青岛杰瑞工控技术有限公司 | 海洋监测设备参数结合机械结构的主被动校准补偿方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2001051890A1 (en) * | 2000-01-12 | 2001-07-19 | American Gnc Corporation | Micro inertial measurement unit |
CN101000244A (zh) * | 2007-01-05 | 2007-07-18 | 北京航空航天大学 | 一种高集成度mimu/gps/微磁罗盘/气压高度计组合导航*** |
CN101270993A (zh) * | 2007-12-12 | 2008-09-24 | 北京航空航天大学 | 一种远程高精度自主组合导航定位方法 |
CN101867868A (zh) * | 2010-03-26 | 2010-10-20 | 东南大学 | 一种组合导航装置和实施方法 |
CN101865693A (zh) * | 2010-06-03 | 2010-10-20 | 天津职业技术师范大学 | 航空用多传感器组合导航*** |
CN101907462A (zh) * | 2010-06-25 | 2010-12-08 | 南京信息工程大学 | 小型水下航行器组合导航装置及位置校正方法 |
-
2011
- 2011-12-12 CN CN201110412114.3A patent/CN102519450B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2001051890A1 (en) * | 2000-01-12 | 2001-07-19 | American Gnc Corporation | Micro inertial measurement unit |
CN101000244A (zh) * | 2007-01-05 | 2007-07-18 | 北京航空航天大学 | 一种高集成度mimu/gps/微磁罗盘/气压高度计组合导航*** |
CN101270993A (zh) * | 2007-12-12 | 2008-09-24 | 北京航空航天大学 | 一种远程高精度自主组合导航定位方法 |
CN101867868A (zh) * | 2010-03-26 | 2010-10-20 | 东南大学 | 一种组合导航装置和实施方法 |
CN101865693A (zh) * | 2010-06-03 | 2010-10-20 | 天津职业技术师范大学 | 航空用多传感器组合导航*** |
CN101907462A (zh) * | 2010-06-25 | 2010-12-08 | 南京信息工程大学 | 小型水下航行器组合导航装置及位置校正方法 |
Non-Patent Citations (4)
Title |
---|
杜继永等: "基于低成本MEMS器件的捷联航姿***设计", 《传感技术学报》, vol. 23, no. 11, 30 November 2010 (2010-11-30) * |
秦勇等: "基于椭圆拟合误差补偿算法的数字磁罗盘", 《吉林大学学报(工学版)》, vol. 39, no. 2, 31 March 2009 (2009-03-31) * |
陈颖莹: "德州仪器为ECG和EEG量身打造全面集成的模拟前端", 《电子技术应用》, no. 5, 31 May 2010 (2010-05-31) * |
黄海洋: "水下滑翔机GPS/SINS组合导航***研究", 《中国优秀硕士学位论文全文数据库信息科技辑》, no. 11, 15 November 2009 (2009-11-15) * |
Cited By (78)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102853836B (zh) * | 2012-09-10 | 2015-04-22 | 电子科技大学 | 一种基于航迹质量的反馈加权融合方法 |
CN102853836A (zh) * | 2012-09-10 | 2013-01-02 | 电子科技大学 | 一种基于航迹质量的反馈加权融合方法 |
CN103017755B (zh) * | 2012-11-26 | 2016-01-27 | 哈尔滨工程大学 | 一种水下导航姿态测量方法 |
CN103017755A (zh) * | 2012-11-26 | 2013-04-03 | 哈尔滨工程大学 | 一种水下导航姿态测量方法 |
CN102980577A (zh) * | 2012-12-05 | 2013-03-20 | 南京理工大学 | 一种微型捷联航姿***及其工作方法 |
CN102980577B (zh) * | 2012-12-05 | 2015-07-08 | 南京理工大学 | 一种微型捷联航姿***及其工作方法 |
CN103192957A (zh) * | 2013-02-04 | 2013-07-10 | 中国科学院自动化研究所北仑科学艺术实验中心 | 一种船舶姿态显示装置及控制方法 |
CN103192957B (zh) * | 2013-02-04 | 2015-07-08 | 中国科学院自动化研究所北仑科学艺术实验中心 | 一种船舶姿态显示装置的控制方法 |
CN103192958A (zh) * | 2013-02-04 | 2013-07-10 | 中国科学院自动化研究所北仑科学艺术实验中心 | 船舶姿态显示装置及控制方法 |
CN103253357A (zh) * | 2013-02-04 | 2013-08-21 | 中国科学院自动化研究所北仑科学艺术实验中心 | 一种船舶姿态显示装置的控制方法 |
CN103245964A (zh) * | 2013-04-09 | 2013-08-14 | 哈尔滨工程大学 | 一种船舶姿态复合检测装置及其检测方法 |
CN104237920B (zh) * | 2013-06-20 | 2017-04-12 | 英特尔公司 | 高反射环境中的交通工具定位 |
CN104237920A (zh) * | 2013-06-20 | 2014-12-24 | 英特尔公司 | 高反射环境中的交通工具定位 |
CN104280026B (zh) * | 2013-07-08 | 2017-11-14 | 中国科学院沈阳自动化研究所 | 基于aukf的深海机器人长基线组合导航方法 |
CN104280025B (zh) * | 2013-07-08 | 2017-06-23 | 中国科学院沈阳自动化研究所 | 基于无色卡尔曼滤波的深海机器人超短基线组合导航方法 |
CN104280025A (zh) * | 2013-07-08 | 2015-01-14 | 中国科学院沈阳自动化研究所 | 基于无色卡尔曼滤波的深海机器人超短基线组合导航方法 |
CN103575296B (zh) * | 2013-10-08 | 2016-04-20 | 北京理工大学 | 一种双轴旋转惯导***自标定方法 |
CN103575296A (zh) * | 2013-10-08 | 2014-02-12 | 北京理工大学 | 一种双轴旋转惯导***自标定方法 |
CN103630123B (zh) * | 2013-10-29 | 2016-09-14 | 中国船舶重工集团公司第七0七研究所 | 一种波浪传感器 |
CN103630123A (zh) * | 2013-10-29 | 2014-03-12 | 中国船舶重工集团公司第七〇七研究所 | 一种波浪传感器 |
CN104613979A (zh) * | 2013-11-05 | 2015-05-13 | 中国科学院沈阳自动化研究所 | 一种用于标定auv自主导航传感器参数的装置和方法 |
WO2015070451A1 (zh) * | 2013-11-18 | 2015-05-21 | 宇龙计算机通信科技(深圳)有限公司 | 电子罗盘校准方法和终端 |
TWI551845B (zh) * | 2014-03-31 | 2016-10-01 | 英特爾股份有限公司 | 用於電子裝置的慣性測量單元及其電腦程式產品 |
CN104406592A (zh) * | 2014-11-28 | 2015-03-11 | 东南大学 | 一种用于水下滑翔器的导航***及姿态角校正和回溯解耦方法 |
CN104406592B (zh) * | 2014-11-28 | 2017-06-06 | 东南大学 | 一种用于水下滑翔器的导航***及姿态角校正和回溯解耦方法 |
WO2017016413A1 (zh) * | 2015-07-24 | 2017-02-02 | 大连海事大学 | 一种具有自动方向修正功能的水下航行器 |
CN105083124B (zh) * | 2015-09-17 | 2018-03-06 | 郭金林 | 一种一体化动态倒车轨迹视像生成方法及*** |
CN105083124A (zh) * | 2015-09-17 | 2015-11-25 | 郭金林 | 一种一体化动态倒车轨迹视像生成方法及*** |
CN105667743A (zh) * | 2015-12-30 | 2016-06-15 | 中国船舶重工集团公司第七○二研究所 | 一种水下滑翔器的控制方法 |
CN105865452B (zh) * | 2016-04-29 | 2018-10-02 | 浙江国自机器人技术有限公司 | 一种基于间接卡尔曼滤波的移动平台位姿估计方法 |
CN105865452A (zh) * | 2016-04-29 | 2016-08-17 | 浙江国自机器人技术有限公司 | 一种基于间接卡尔曼滤波的移动平台位姿估计方法 |
CN106403937A (zh) * | 2016-07-07 | 2017-02-15 | 上海机电工程研究所 | 提高动基座对准精度的导航信息滤波方法 |
CN107656530A (zh) * | 2016-07-26 | 2018-02-02 | 深圳华清精密科技有限公司 | 变参数开架式海洋水下机器人的轨迹跟踪控制方法、装置和*** |
CN106500721A (zh) * | 2016-09-27 | 2017-03-15 | 哈尔滨工程大学 | 一种水下机器人双冗余姿态检测*** |
CN107272713A (zh) * | 2016-10-20 | 2017-10-20 | 天津科技大学 | 一种水下机器人不确定流场环境自适应控制*** |
CN106767792A (zh) * | 2017-01-16 | 2017-05-31 | 东南大学 | 一种水下滑翔器导航***及高精度姿态估计方法 |
CN107167126B (zh) * | 2017-03-31 | 2019-09-20 | 大鹏高科(武汉)智能装备有限公司 | 一种自主式水下机器人组合导航方法和*** |
CN106990787A (zh) * | 2017-05-16 | 2017-07-28 | 哈尔滨工程大学 | 一种上下体艏向信息融合的波浪滑翔器航点跟踪方法 |
CN106990787B (zh) * | 2017-05-16 | 2020-09-25 | 哈尔滨工程大学 | 一种上下体艏向信息融合的波浪滑翔器航点跟踪方法 |
CN109443347A (zh) * | 2017-07-31 | 2019-03-08 | 意法半导体股份有限公司 | 用于陆地车辆导航的***以及对应的方法 |
CN107943859A (zh) * | 2017-11-07 | 2018-04-20 | 千寻位置网络有限公司 | 海量传感器数据收集处理及反馈的***和方法 |
CN107943859B (zh) * | 2017-11-07 | 2021-07-30 | 千寻位置网络有限公司 | 海量传感器数据收集处理及反馈的***和方法 |
CN108106615B (zh) * | 2017-12-08 | 2023-07-28 | 中船重工西安东仪科工集团有限公司 | 一种可设定初始航向的水下mems航向陀螺 |
CN108106615A (zh) * | 2017-12-08 | 2018-06-01 | 中船重工西安东仪科工集团有限公司 | 一种可设定初始航向的水下mems航向陀螺 |
CN108562284A (zh) * | 2018-01-25 | 2018-09-21 | 陕西土豆数据科技有限公司 | 一种免转台的多旋翼飞行器的罗盘标定方法 |
CN108344413A (zh) * | 2018-02-07 | 2018-07-31 | 东南大学 | 一种水下滑翔器导航***及其低精度与高精度转换方法 |
CN108693547A (zh) * | 2018-06-05 | 2018-10-23 | 河海大学 | 一种用于水下深潜器的导航***及精准三点定位方法 |
CN109253726A (zh) * | 2018-06-22 | 2019-01-22 | 东南大学 | 一种水下滑翔器导航定位***及上浮精度校正方法 |
US11927446B2 (en) | 2018-06-22 | 2024-03-12 | Southeast University | Navigation and positioning system for underwater glider and up floating error correction method |
WO2019242336A1 (zh) * | 2018-06-22 | 2019-12-26 | 东南大学 | 一种水下滑翔器导航定位***及上浮精度校正方法 |
CN108955676B (zh) * | 2018-08-01 | 2021-04-27 | 东南大学 | 深海潜器导航***和用于深海潜器状态切换的数据融合方法 |
CN108955676A (zh) * | 2018-08-01 | 2018-12-07 | 东南大学 | 深海潜器导航***和用于深海潜器状态切换的数据融合方法 |
CN110823213B (zh) * | 2018-08-14 | 2022-07-08 | 北京自动化控制设备研究所 | 一种提高sins/dr组合导航***相对航向角精度的方法 |
CN110823213A (zh) * | 2018-08-14 | 2020-02-21 | 北京自动化控制设备研究所 | 一种提高sins/dr组合导航***相对航向角精度的方法 |
CN109506624B (zh) * | 2018-10-31 | 2021-11-02 | 台州职业技术学院 | 一种基于移动机器人的分布式视觉定位***及方法 |
CN109506624A (zh) * | 2018-10-31 | 2019-03-22 | 台州职业技术学院 | 一种基于移动机器人的分布式视觉定位***及方法 |
CN109572937A (zh) * | 2018-12-18 | 2019-04-05 | 中国船舶重工集团公司第七0研究所 | 一种深海可控浮标 |
CN110926497A (zh) * | 2019-04-08 | 2020-03-27 | 青岛中海潮科技有限公司 | 水下运载器惯导误差预测、浮起校正自动规划方法、装置 |
CN109974715A (zh) * | 2019-04-30 | 2019-07-05 | 中国矿业大学(北京) | 捷联惯导和光斑识别组合的掘进机自主导航***及方法 |
CN109974715B (zh) * | 2019-04-30 | 2020-12-08 | 中国矿业大学(北京) | 捷联惯导和光斑识别组合的掘进机自主导航***及方法 |
CN110335385A (zh) * | 2019-06-18 | 2019-10-15 | 广东汇泰龙科技股份有限公司 | 一种智能门锁的低功耗实现方法和*** |
CN110274591A (zh) * | 2019-06-20 | 2019-09-24 | 东南大学 | 深潜载人潜水器adcp辅助sins导航方法 |
CN112179374A (zh) * | 2019-07-02 | 2021-01-05 | 通用电气航空***有限责任公司 | 操作运载工具的方法 |
CN110376628A (zh) * | 2019-07-12 | 2019-10-25 | 深圳市金溢科技股份有限公司 | 车载终端及基于lte-v的车载通信方法 |
CN110388941A (zh) * | 2019-08-28 | 2019-10-29 | 北京机械设备研究所 | 一种基于自适应滤波的车辆姿态对准方法 |
CN110388942A (zh) * | 2019-08-28 | 2019-10-29 | 北京机械设备研究所 | 一种基于角度和速度增量的车载姿态精对准*** |
CN110388942B (zh) * | 2019-08-28 | 2021-09-10 | 北京机械设备研究所 | 一种基于角度和速度增量的车载姿态精对准*** |
CN110388941B (zh) * | 2019-08-28 | 2021-09-10 | 北京机械设备研究所 | 一种基于自适应滤波的车辆姿态对准方法 |
CN110865371A (zh) * | 2019-11-29 | 2020-03-06 | 河海大学 | 一种用于水下探地雷达装置 |
CN111025269B (zh) * | 2019-12-19 | 2022-11-15 | 哈尔滨工程大学 | 一种水下机器人传感器安装偏差估计方法 |
CN111025269A (zh) * | 2019-12-19 | 2020-04-17 | 哈尔滨工程大学 | 一种水下机器人传感器安装偏差估计方法 |
CN111366962A (zh) * | 2020-03-12 | 2020-07-03 | 国家深海基地管理中心 | 一种深远海低成本长航时协同导航定位*** |
CN111781626B (zh) * | 2020-08-09 | 2023-08-18 | 湖南星至导航科技有限公司 | 多功能导航***与方法 |
CN111781626A (zh) * | 2020-08-09 | 2020-10-16 | 湖南星至导航科技有限公司 | 多功能导航***与方法 |
CN113093296A (zh) * | 2021-04-15 | 2021-07-09 | 成都纵横自动化技术股份有限公司 | 一种航磁测量方法及相关组件 |
CN113093296B (zh) * | 2021-04-15 | 2023-09-05 | 成都纵横自动化技术股份有限公司 | 一种航磁测量方法及相关组件 |
US20220400320A1 (en) * | 2021-06-14 | 2022-12-15 | Andrew Bennett | Mobile ocean exploration platform |
CN118034070A (zh) * | 2024-04-15 | 2024-05-14 | 青岛杰瑞工控技术有限公司 | 海洋监测设备参数结合机械结构的主被动校准补偿方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102519450B (zh) | 2014-07-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102519450B (zh) | 一种用于水下滑翔器的组合导航装置及方法 | |
CN102829777B (zh) | 自主式水下机器人组合导航***及方法 | |
CN201266089Y (zh) | Ins/gps组合导航*** | |
Georgy et al. | Low-cost three-dimensional navigation solution for RISS/GPS integration using mixture particle filter | |
CN105043415B (zh) | 基于四元数模型的惯性系自对准方法 | |
CN105891863B (zh) | 一种基于高度约束的扩展卡尔曼滤波定位方法 | |
CN101920762B (zh) | 一种基于噪声矩阵实时修正的船舶动力定位方法 | |
Wang et al. | A GNSS/INS integrated navigation algorithm based on Kalman filter | |
Huang et al. | Attitude estimation fusing quasi-Newton and cubature Kalman filtering for inertial navigation system aided with magnetic sensors | |
CN104697520A (zh) | 一体化无陀螺捷联惯导***与gps***组合导航方法 | |
CN103292812A (zh) | 一种微惯性sins/gps组合导航***的自适应滤波方法 | |
CN109375646A (zh) | 基于fmsrupf算法的auv对接回收自主导航方法 | |
CN104406592A (zh) | 一种用于水下滑翔器的导航***及姿态角校正和回溯解耦方法 | |
CN207816290U (zh) | 航姿测量装置 | |
AU2020104248A4 (en) | Integrated gps and inertial navigation system for industrial robots | |
CN104634348A (zh) | 组合导航中的姿态角计算方法 | |
Zhou et al. | Geomagnetic matching algorithm based on the probabilistic neural network | |
Yuan et al. | Reaearch on underwater integrated navigation system based on SINS/DVL/magnetometer/depth-sensor | |
CN112947068B (zh) | 一种自主水下航行器一体化声学定位与跟踪控制方法 | |
DeVon et al. | Innovation-based fusion of multiple satellite positioning systems for minimizing uncertainty | |
CN206905769U (zh) | 地下空间惯性测量与无线传感器组合定位*** | |
CN110764126A (zh) | 一种gps信息缺失情况下的无人车导航方法及*** | |
Wu et al. | Rapid Initial Heading Alignment Using Single-Antenna GNSS and a Low-Grade IMU | |
Meng et al. | A GNSS/INS integrated navigation compensation method based on CNN-GRU+ IRAKF hybrid model during GNSS outages | |
CN103940416A (zh) | 一种电磁计程仪辅助的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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |