基于罗经/DVL/USBL组合导航系统的DVL在线标定算法

针对ROV在大深度水下工作环境中由于DVL刻度因数误差和安装角度误差引起导航精度降低的问题,提出了一种基于罗经/DVL/USBL组合导航系统的DVL误差参数在线标定算法。分析并建立了DVL误差参数向组合导航定位误差的传播模型,将DVL的刻度因数误差和安装角度误差引入基于USBL位置观测的卡尔曼滤波组合导航迭代中,使ROV在获得组合导航输出的同时实现DVL的在线标定。仿真与海试结果表明,所提出的算法能够在输出高精度组合导航位置的同时进行DVL的有效标定,在理想条件下,组合导航终点定位误差仿真结果能够达到0.01%航程,具有较高的导航定位精度、DVL误差参数估计精度和算法稳定性。     

基于IEKF的SINS/USBL组合导航系统安装偏差标定算法

在捷联惯性导航与超短基线组合导航系统中,SINS和USBL存在安装偏差,如不加以补偿将影响组合导航精度。针对此问题,提出了基于迭代扩展卡尔曼滤波（IEKF）的SINS/USBL组合导航系统安装偏差标定算法。首先,根据安装偏差角建立关于量测的非线性函数;然后,引入IEKF算法对安装偏差进行标定。同时为了验证IEKF标定算法的优越性,与递推最小二乘（RLS）和扩展卡尔曼滤波（EKF）算法标定结果进行了对比,并完成了车载半实物仿真试验。试验结果表明,基于IEKF的标定算法在50次蒙特卡罗仿真试验条件下三轴标定精度分别较RLS和EKF提高了16.44%和2.60%、157.69%和1.17%、7.50%和0.41%。     

基于北斗差分定位的炮载惯导外场标定

针对炮载惯导设备在外场标定过程中依赖固定基准点的问题,提出了一种基于卫星差分定位的误差标定新方法。该方法将北斗天线的安装误差、惯性器件的失准角以及安装误差等角度误差统一归为非对准误差。首先利用北斗测姿技术提供姿态基准,粗标出上述误差;精标阶段采用卫星差分技术来提供高精度位置信息,完成误差角的精确标定。多组标定结果与传统工厂标定方法结果相差均在0.3mil以内,达到了较高的精度。该方法不仅回避了对固定基准点的依赖,而且避免了滤波带来的繁琐过程,即能保证长时导航的精度,又提高了标定的实时性。     

一种动基座传递对准算法性能评估的工程方法

在东北天地理坐标系下,推导了捷联惯导动基座传递对准模型.在此基础上,提出了一种在不具备精确标定设备的试验条件下,进行动基座传递对准算法性能评估的工程方法.该方法基于安装误差角滤波估计结果,对子惯导的初始姿态进行修正,并重新进行子惯导的导航解算;通过比较初始姿态修正前后子惯导的导航误差,对传递对准算法的性能进行定性分析.基于试验数据的处理结果表明,所建立的对准模型和采用的对准算法性能评估方法具有重要的工程应用价值.     

一种基于梯度下降四元数理论的DVL误差标定方法

针对如何快速精确标定出多普勒计程仪(DVL)的比例因子误差以及DVL和捷联惯导(SINS)之间的安装误差角的问题,提出了一种基于梯度下降四元数估计理论的位置观测DVL标定方法。以SINS/DVL/GNSS为组合导航方式,利用多普勒测速原理标定出比例因子误差,通过构造位置矢量观测方程,采用梯度下降四元数方法得到安装误差角的标定结果。通过仿真及试验验证了所提出方法的有效性,并与卡尔曼滤波标定算法进行了比较,结果表明:比例因子估计值误差的最终标定结果在0.06%以内,安装角估计误差最终标定结果在0.05°以内,具有较好的工程应用价值。     

航位推算组合导航系统在线标定技术

在航位推算组合导航系统中,存在里程计安装偏差角误差和标度因数误差。推导了里程计安装偏差角误差和标度因数误差对航位推算速度和位置精度的影响,并提出了一种航位推算组合导航系统在线标定算法。该算法利用航位推算的速度与GPS的速度之差作为速度量测,航位推算的位置与GPS的位置之差作为位置量测,对航位推算组合导航系统的姿态误差、安装偏差角误差和标度因数误差进行有效估计,并通过仿真试验和车载试验对该算法的有效性进行了验证。试验结果表明,通过车载试验在线标定出的里程计各误差参数与里程计传统标定法标定的结果接近,且该算法计算量小,具有一定的工程应用价值。     

足绑式行人导航偏航角误差自观测算法（英文）

基于低成本MEMS惯性传感器的足绑式惯性导航系统(INS)和零速修正(ZUPT)算法广泛应用于行人导航中。由于MEMS惯性传感器零漂误差较大,零速修正时偏航角误差的可观测性差,INS偏航角误差不能被有效约束,成为行人导航的主要误差源。行人徒步行走特别是在室内楼道等结构化道路上行走时,行走的轨迹大多情况下可认为是近似直线,基于这个事实,提出了一种减小偏航角误差的算法,称为偏航角误差自观测(YESO)算法。当判定行人以近似直线徒步行走时,由行走轨迹计算出的航向角可近似认为是一个常值,那么由于各种误差引起该航向角发生变化时,可以将该变化量作为足绑式INS偏航角误差的观测量,进一步可利用卡尔曼滤波器估计出偏航角误差,对足绑式INS的偏航角进行校准。在室内楼道进行了约350 m的现场实验,实验验证了YESO算法的有效性。实验结果表明,当分别采用ZUPT和ZUPT+YSEO算法进行导航解算时,航向角误差从-29°减小到-2°,南北向最大位置误差从-35.5 m减小到-5.2 m。YESO算法的实现仅依靠系统自身的信息,没有增加额外的传感器,算法具有很好的工程实用价值并能方便地推广应用于车辆导航等领域。     

安装误差角引起的加速度计旋转误差建模

在导航过程中惯性平台绕方位轴旋转能够有效地调制陀螺的常值漂移,但加速度计安装坐标系和陀螺安装坐标系的不重合会导致加速度计零偏也被调制为一个变化量,因此需要建立其旋转误差模型进行补偿。针对平台惯导台体绕方位轴旋转时加速度计误差补偿的实际需要,建立加速度计由初始安装误差角引起的旋转误差模型。模型主要针对旋转过程中由初始安装误差角导致的加速度计和水平面之间的不重合度,模型包括角度叠加模型和单位矢量旋转模型。通过对两种模型仿真分析,表明角度叠加模型计算量小,并且能够满足实际误差补偿需要。     

极区飞行法向量惯性导航算法原理

为克服经典力学编排方案在高纬度地区无法定位定向的问题,提出了以地球坐标系为导航坐标系的法向量惯性导航力学编排方案。该方案采用法向量代替传统的经纬度坐标表示水平位置,适合于全球范围内进行导航。推导了法向量导航误差方程,可用于组合导航算法设计,从而对惯导误差进行校正,满足全天候长航时的导航要求。通过仿真验证了法向量导航算法误差特性,证明了该方案可以满足飞机在极区飞行时的需要,解释了飞跃极点时导航定位误差跳变的原因。     

USBL安装偏差联合模型构建与校准方法

超短基线声学定位系统（USBL）使用前必须要进行严格的角度安装偏差校准。通过研究安装偏差校准的数学模型和数值算法，提出一种USBL安装偏差联合模型构建与校准方法。首先结合克罗尼克积给出高斯-马尔科夫数学模型假设下的校准信标位置和姿态旋转矩阵参数估计联合解，然后基于姿态旋转矩阵的联合解和条件协因数矩阵解其固定解。同时联合模型还可以对换能器水平距离安装偏差、声速误差进行增广，提高了模型的适用性。南海实测试验结果表明，所提方法可以充分利用USBL方向信息和测距信息对校准信标和其他参数进行估计，相比传统两步法，所提方法求解的信标水平定位偏差由0.69 m减小至0.60 m，水平距离安装偏差由0.26 m减小至0.04 m，角度安装偏差由0.29°减小至0.25°。