AUV自主导航航位推算算法的分析研究

地球形状的不规则性,各种导航传感器本身的误差,以及仪器的安装偏差等,使得AUV(自治水下机器人)在进行远距离自主航行时,自主导航的精度大大下降。针对以上问题及实际工程需要,论文对AUV自主导航的航位推算算法做了进一步研究并加以改进,以提高其自主导航精度。最后,利用2004年中国科学院沈阳自动化所水下机器人研究中心进行AUV湖试所获得的数据,对文中提出的算法进行了验证。结果表明,AUV的自主导航精度得到大大提高,可以用于修正原来的自主导航算法。     

水下滑翔器运动控制与自主导航策略

水下滑翔器嵌入式控制系统采用Philips公司的LPC2478为主控芯片,搭载多路高精度传感器以及伺服执行系统。通过对水下滑翔器的结构分析,构建出水下滑翔器的动力学模型,采用神经网络PID控制算法调节动力学模型中的俯仰角和横滚角,实现水下滑翔器在水下运行时的姿态调节与航迹控制。引入高斯大地线算法,分析处理经纬度坐标与航向角数据,计算得到水下滑翔器的航行距离与航向角偏差数据,从而控制伺服系统实现导航控制。同时,鉴于水面环境与水下环境的差异,为提高水下滑翔器的导航精度,引入水下航位推算算法,推算出水下滑翔器在水下的航向与姿态角,提高其在水下运行的精确度。     

深海自治式水下航行器组合导航/定位误差分析与建模

在深海海洋油气资源勘探开发中,导航定位数据是各个测量参数的基准信息,测量载体的定位精度在一定程度上决定了其搭载的传感器探测精度。以COSL Explorer型深水自治式水下航行器为研究对象,分析其组合导航/定位系统的特点,得出包含超短基线水下定位、多普勒计程仪与惯性系统组合导航、海水中声速影响的深水自治式水下航行器导航/定位误差模型,并对该模型参数进行等误差剖面分析,得到该载体导航/定位误差分布趋势。并针对不同航速、不同定位斜距、不同时间间隔下的组合导航定位误差进行预报,为自主航行器在大海深、大范围工程勘察测量时参数设置提供理论依据。     

基于INS/DVL/GPS的UUV组合导航技术分析

水下组合导航是 UUV 完成长航时水下自主航行和任务的技术保障和基础,而基于 INS/DVL/GPS 的组合导航是当前 UUV 的主流组合导航方式,可解决导航误差随时间积累的难题,满足 UUV 长航时水下航行的要求。介绍了水下组合导航系统的结构和组成以及关键技术,并详细论述了初始对准算法、纯惯性解算算法、组合导航算法、DVL 标定算法和校准算法。     

基于倒置声学基阵的INSUSBL组合导航算法研究

文中关注水下潜航器导航定位时,电磁波传播途径中能量衰减、惯导系统长航时积累误差以及提高水下潜航器定位精度等问题。基于倒置的超短基线声学基阵,分析声波往返传播时间(RTT)、平面波近似方法和USBL导航解算方法及其坐标转换过程,结合INS误差方程,建立INS/USBL松组合模型。为进一步提高系统精度、动态性能和抗干扰性,考察USBL的原始斜距、斜距差以及声学基阵的空间分布信息,提出基于USBL原始输出信息的INS/USBL紧耦合组合导航方法。通过MATLAB仿真对导航算法进行验证,结果表明两种算法能充分抑制纯惯导误差随时间积累问题,且有效地估计出姿态、速度和位置误差角;其中紧耦合方法状态估计误差最小,导航参数精度相对松组合提高30%以上,对于提高水下载体导航定位精度、海洋探测具有重大意义。     

基于ICCP匹配算法的海底地形匹配辅助导航

利用海底地形辅助导航是水下载体导航技术致力研究的新方向，采用ICCP算法作为对准匹配算法，利用实测地形数据和已知地形数据库，进行仿真计算，修正惯性导航系统累计误差，得到水下载体的最佳匹配位置，以提高水下载体的导航精度。     

重力辅助匹配惯性导航系统研究

常规的航位推算方法无法满足水下潜器长时间工作的导航要求,惯导设备的定位误差随时间积累,重力异常数据和重力梯度数据进行匹配辅助导航可以连续的对惯性导航系统积累误差进行校正。 文章介绍了利用重力辅助惯导的思想和原理,对重力辅助惯性导航进行了讨论,建立包含重力异常/ 重力梯度数据的 Kalman 滤波算法,并采用改进的 ICCP 算法对重力异常匹配导航进行了模拟试算,结果表明在现有的技术条件下,重力辅助匹配导航能够胜任水下航行的工作任务,保证长航时的水下定位精度。     

顾及声速误差的USBL/SINS紧组合导航算法研究

采用水下超短基线定位系统和捷联惯导系统组合对水下潜器进行导航时,未知的声速误差会严重影响组合导航的精度。顾及超短基线定位系统的噪声水平、阵列上接收单元的误差特性以及和捷联惯导系统在导航性能的互补性,基于平面波近似原理,建立了SINS/USBL紧组合系统的状态方程和量测方程,并对未改正的声速误差在线估计,提出一种超短基线定位系统和捷联惯导系统紧组合算法。新算法可以将非高斯的未知声速误差进行建模后进行估计,有效提高了捷联惯导系统的误差估计性能。仿真实验结果表明,新算法能有效估计未知声速误差,滤波收敛后的精度明显优于松组合方案,具有很强的实用性。     

基于非线性滤波的水下地形辅助导航方法

为了解决水下航行器惯性导航误差随时间积累问题,利用地形辅助导航技术进行导航位置修正。由于水下地形的非线性,对基于扩展卡尔曼滤波(EKF)、无迹卡尔曼滤波(UKF)和粒子滤波(PF)3种非线性滤波方法的水下地形辅助导航算法进行研究。针对传统基于单波束声纳量测模型在小起伏地形区域导航精度低、易发散问题,从提高量测地形信息量角度,建立了基于多波束测深声纳的量测模型。使用多波束实测地形数据进行仿真试验,结果表明:无论在粗糙地形区域还是较平坦地形区域,多波束量测模型有效缓解了3种方法易发散问题,提高了导航精度。     

磁罗盘误差校准方法及其在海洋领域的应用

针对磁罗盘自身误差以及载体平台磁干扰导致磁罗盘测量精度不高的问题,提出了一种磁罗盘误差校准方法。通过对磁罗盘自身误差以及载体平台磁干扰产生的误差进行分析,建立了误差校准模型,并结合实际应用条件给出了磁罗盘平面校准方法和空间校准方法,采用最小二乘回归算法对模型求解,解决了磁罗盘现场校准问题。利用所研制的磁罗盘开展了施加磁干扰后的磁罗盘校准验证实验,并对校准前后的方位角精度进行了测试。试验结果表明：在施加磁干扰后方位角最大误差 12°的条件下,利用该方法校准后方位角最大误差仅为 0.2°, 说明了该方法的有效性。最后,介绍了磁罗盘在海洋领域常见的几种应用。     

一种基于超短基线定位的便携式AUV回坞导航方法

自主水下机器人(AUV)对接技术是目前水下机器人的研究热点,精确可靠的AUV的回坞导航是实现对接的关键技术。对于追求轻便的便携式AUV的对接系统,考虑到便携式AUV的搭载能力有限又需要足够的定位精度用于对接,提出了一种基于超短基线(USBL)定位的回坞导航方法,该方法让AUV只需装载电子罗盘和水声应答器就能完成精确的回坞定位。根据导航方法的特点,设计了一种改进的扩展卡尔曼滤波算法,其优点是能在处理滞后的USBL数据的同时动态估算海流、更新状态方程以消除海流造成的定位误差。通过湖试和大量仿真实验,验证了定位算法在海流影响下的定位性能。     

Simulation of an Inertial Acoustic Navigation System With Range Aiding for an Autonomous Underwater Vehicle

This paper presents an integrated navigation system for underwater vehicles to improve the performance of a conventional inertial acoustic navigation system by introducing range measurement. The integrated navigation system is based on a strapdown inertial navigation system (SDINS) accompanying range sensor, Doppler velocity log (DVL), magnetic compass, and depth sensor. Two measurement models of the range sensor are derived and augmented to the inertial acoustic navigation system, respectively. A multirate extended Kalman filter (EKF) is adopted to propagate the error covariance with the inertial sensors, where the filter updates the measurement errors and the error covariance and corrects the system states when the external measurements are available. This paper demonstrates the improvement on the robustness and convergence of the integrated navigation system with range aiding (RA). This paper used experimental data obtained from a rotating arm test with a fish model to simulate the navigational performance. Strong points of the navigation system are the elimination of initial position errors and the robustness on the dropout of acoustic signals. The convergence speed and conditions of the initial error removal are examined with Monte Carlo simulation. In addition, numerical simulations are conducted with the six-degrees-of-freedom (6-DOF) equations of motion of an autonomous underwater vehicle (AUV) in a boustrophedon survey mode to illustrate the effectiveness of the integrated navigation system.     

20kg级便携式自主水下机器人(AUV)设计与实现

便携式AUV具有结构紧凑、机动性好、制造和使用成本低等优点,本文设计AUV的底层控制系统和自主导航系统,并进行仿真验证和人工湖试验,结果证明底层控制系统具有很好的鲁棒性,基于AHRS、数字罗盘和GPS的惯性导航算法能够通过浅水节点潜航方式实现AUV自主导航。     

In Situ Alignment Calibration of Attitude and Doppler Sensors for Precision Underwater Vehicle Navigation: Theory and Experiment

This paper reports the development and experimental evaluation of two in situ least squares techniques for estimating the alignment matrix of Doppler sonars commonly used for precision navigation of oceanographic submersibles. Most previously reported methods addressed the problem of single degree-of-freedom heading alignment using bottom-lock Doppler sonar data and global positioning system (GPS) navigation data. This paper reports and evaluates two techniques for three degree-of-freedom calibration of attitude and Doppler sonar sensors using sensor data available to vehicles at full ocean depth. The first technique provides a general linear least squares estimate of the alignment matrix. The second technique results in a least squares alignment matrix estimate constrained to the group of rotation matrices. The performance of these estimates is evaluated with a laboratory remotely operated vehicle (ROV) and a field-deployed autonomous underwater vehicle (AUV). Experimental results are reported which demonstrate that Doppler navigation employing the reported alignment calibration techniques significantly improves navigation precision. The experiments show that the latter technique provides calibration estimates that improve Doppler navigation precision not only on the calibration data set itself, but also provide improved precision over a wide variety of vehicle trajectories other than the calibration data set.     

基于可重置联邦滤波器的水下运载体导航定位方法

单一导航系统无法满足水下运载体高精度、高可靠性的导航需求,文中根据常用水下导航系统的特点,提出基于可重置联邦滤波器的水下运载体导航定位方案,设计了以惯导系统(INS)为主参考系统,声学定位系统/深度计、多普勒计程仪(DVL)、罗经为子参考系统的联邦滤波器,并进行了仿真研究。结果表明文中设计的滤波器能有效融合各个传感器的导航信息,实现水下运载体高精度导航定位,并具有一定容错性。     

Absolute positioning of an autonomous underwater vehicle using GPS and acoustic measurements

Kinematic global positioning system (GPS) positioning and underwater acoustic ranging can combine to locate an autonomous underwater vehicle (AUV) with an accuracy of /spl plusmn/30cm (2-/spl sigma/) in the global International Terrestrial Reference Frame 2000 (ITRF2000). An array of three precision transponders, separated by approximately 700 m, was established on the seafloor in 300-m-deep waters off San Diego. Each transponder's horizontal position was determined with an accuracy of /spl plusmn/8 cm (2-/spl sigma/) by measuring two-way travel times with microsecond resolution between transponders and a shipboard transducer, positioned to /spl plusmn/10 cm (2-/spl sigma/) in ITRF2000 coordinates with GPS, as the ship circled each seafloor unit. Travel times measured from AUV to ship and from AUV to transponders to ship were differenced and combined with AUV depth from a pressure gauge to estimate ITRF2000 positions of the AUV to /spl plusmn/1 m (2-/spl sigma/). Simulations show that /spl plusmn/30 cm (2-/spl sigma/) absolute positioning of the AUV can be realized by replacing the time-difference approach with directly measured two-way travel times between AUV and seafloor transponders. Submeter absolute positioning of underwater vehicles in water depths up to several thousand meters is practical. The limiting factor is knowledge of near-surface sound speed which degrades the precision to which transponders can be located in the ITRF2000 frame.     

Survey of underwater robot positioning navigation

Underwater robot positioning and navigation achieve autonomous underwater robot movement based on the premise that positioning obtains the coordinates of the relative position of the underwater robot using a sensor, and navigation yields a known location to the destination path planning. Due to the location of an underwater robot and the complex and changing environment in which it operates, it is difficult to achieve precise positioning using the traditional positioning method. This paper systematically analyzes and summarizes several typical localization and navigation methods of underwater robots, such as multisensor information fusion technology, underwater acoustic localization and navigation methods, GPS buoy, underwater vision, SLAM and coordinate localization and navigation of multiple underwater robots. Multisensory information fusion technology integrates the advantages of the above methods, enhances the system stability and robustness, overcomes the disadvantages of traditional positioning and navigation, and enables the autonomous navigation and positioning of underwater robots. Underwater acoustics enable flexible and convenient positioning, whereas GPS can achieve high-precision and high-positioning navigation information, and visual positioning effectively overcomes the problem of error accumulation. Multirobot cooperative positioning resolves the problem of positioning failure caused by the collapse of a single system and completes complex tasks that cannot be completed by a single robot, thus enhancing the stability and robustness of the system. This paper systematically describes the realization of these methods, presents an actual analysis of their respective advantages and problems, and discusses the development of the field of research prospects and application prospects.     

Performance of an AUV navigation system at Arctic latitudes

In October 2001, the Monterey Bay Aquarium Research Institute (MBARI) operated an autonomous underwater vehicle (AUV) in the Arctic at latitudes exceeding 80/spl deg/. The navigation instruments consisted of a ring-laser gyro inertial navigation system (INS) coupled with a DVL and GPS, a separate fiber-optic-based gyro-compass, and a traditional flux-gate AHRS system. The instruments were tested on deck, in open water, and under ice. This paper describes the performance of these instruments at high latitudes.     

重力场辅助水下导航对惯导仪器的要求

水下重力测量的准确性是决定重力场辅助水下导航可行性的一个重要指标。从厄特弗斯改正公式出发，详细分析了纬度、航向、航速精度对厄特弗斯改正的影响方式和影响大小，并以当前海洋船测重力精度作为厄特弗斯改正的误差限定，分析了满足该条件下水下载体的航向、航速需要达到的精度指标，提出了利用惯性系统进行水下重力测量误差修正时对导航硬件的要求。