基于最近邻的协同定位模型研究

协同定位是多平台编队中的关键问题之一,是实现无人机、舰艇编队等定位控制的基础.从信息融合的角度研究了编队协同中的导航定位问题,提出了一种新的协同定位算法.推导了二维情况下,基于最近邻准则确定伪测量和相伴误差协方差矩阵的模型.仿真分析表明,该算法可以稳定地完成己平台运动要素的估计.     

着陆小行星的视线测量自主光学相对导航算法及其可观性分析

 以软着陆小行星为工程应用背景,提出了基于视线(LOS)测量的自主光学相对导航算法,并对导航算法的可观性进行了比较深入的分析研究。首先,基于透视投影模型的共线方程,给出了导航测量方程和测量敏感矩阵;接着,通过多个视线矢量的测量,应用高斯最小二乘微分修正(GLSDC)和龙贝格-马尔塔(LM)算法对探测器的位置和姿态参数进行了估计。然后,通过对误差方差阵逆矩阵秩的分析,比较详尽地分析了不同数量视线观测条件下导航算法的可观度和可观性。最后,通过数学仿真对所提出的自主导航算法的可行性进行了验证。     

基于相对导航的多平台INS误差联合修正方法

在机群协同编队飞行中,编队成员仅装载惯性导航系统(INS)的方式具有隐蔽、抗干扰等明显的优势,但随着航时的增加,INS误差将不断累积.使导航系统失效,为此,提出基于相对导航的多平台INS误差联合修正方法.首先,建立了编队成员相对导航运动模型及非线性观测模型,采用量测重构技术构造了伪线性观测模型并推导了观测噪声协方差矩阵...     

相对测量在编队卫星自主定轨中的应用

针对编队卫星自主定轨问题进行了研究,设计了一种完全不依赖于地面站和GPS系统的自主导航方案。利用星间测量信息进行卫星编队相对轨道状态的自主确定;并在利用磁强计进行卫星绝对轨道自主确定的基础上,引入星间测量信息提高绝对定轨精度;设计扩展卡尔曼滤波器进行卫星编队轨道状态估计,数学仿真结果验证了这种导航方案和算法的有效性。     

基于ST-EKF与滤波增益约束的加速度计微g级标定

提高加速度计组件的标定精度是实现高精度导航、高精度测姿的重要途径.针对加速度计组件通过线性误差模型标定后难以达到微g级精度的情况,建立了包含二次项误差和振摆误差在内的加速度计组件误差模型,并提出了一种基于状态变换Kalman滤波与滤波增益约束的系统级标定算法.该算法借鉴Schmidt-Kalman滤波器与可观测性约束Kalman滤波器原理,可减小滤波状态协方差矩阵计算误差和滤波增益计算误差,从而提高弱可观误差状态的估计精度.与传统系统级标定算法的对比实验表明,所提出的新算法能够更加精确估计出包含二次项误差与振摆误差在内的加速计组件的各项误差,新算法使在大水平姿态倾角下的重力模值测量残差的均方差从线性误差模型的24.12μg、线性/二次项误差模型的13.38μg减少到6.71μg.4500s大水平姿态变化下的纯惯导实验结果表明:与仅用线性误差模型的系统级标定结果相比,系统级标定新算法使惯导系统的东向、北向导航最大位置误差分别从192.40m、96.72m减小到74.64m、65.44m.所提出的系统级标定新算法具备更好的标定精度,从而使得导航精度得到提高.     

基于记忆融合模式的多无人机分散式协同导航方法

针对多无人机协同交互过程中存在的通信时滞问题，提出基于记忆-融合的多无人机分散式协同导航算法。在无人机惯性和全球卫星导航系统（GNSS）紧组合导航框架基础上，建立含时滞影响的系统状态向量，并对系统状态误差及其方差进行推导，进一步构建关于各无人机状态的最优估计模型，并基于状态误差方差最小准则对状态进行最优估计。建立了基于机间相对测量的多无人机分散式协同导航算法，提出了基于记忆融合模式的时滞处理方法。在GNSS可获取及拒止环境下进行多无人机协同导航仿真与实验测试，结果表明，所提出的基于记忆-融合的分散式协同导航算法能有效补偿通信时滞造成的精度损失，有效提高定位精度。     

基于改进的自适应平方根容积卡尔曼滤波相对导航算法

针对无人机编队飞行时由于目标建模的不确定性导致相对导航滤波算法精度降低甚至出现滤波发散的问题,提出了一种自适应平方根容积卡尔曼滤波算法。首先,建立了无人机双机编队时的相对导航模型。然后,基于新息的自适应修正准则,对滤波状态预测量进行修正,进行了基于自适应修正的平方根容积卡尔曼滤波相对导航算法设计。最后,开展了仿真计算与结果分析。仿真结果表明,该算法具有较好的滤波精度和稳定性,且当目标运动状态与模型不匹配时,该算法与平方根容积卡尔曼滤波算法相比有更好的滤波性能。     

一种联合估计的有源校正高精度测向算法

针对存在系统误差的阵列模型,提出了一种有源标校下的联合估计测向算法。该算法把误差矩阵估计转化为误差系数估计,并采用到达角精确已知的源信号进行标校,在此基础上使用最小二乘法联合估计幅相不一致误差系数和互耦误差系数,最后使用结合误差矩阵的MUSIC算法测量信号的到达角。仿真表明,该算法仅需要3个标校源,其精度相比于无阵列误差情况下降0.05°,具有较好的工程可实现性。     

双视线测量相对导航方法误差分析与编队设计

空间非合作目标的相对导航是在轨维护和近距离监视任务中的关键技术,目前的研究表明仅有视线测量条件下中距离相对导航沿距离方向的观测度较差,而基于双视线测量的相对导航方法可以有效解决该问题。为此,研究了两个追踪航天器所组成的编队,在双视线测量条件下进行自主相对导航的方法。首先,详细地介绍了双视线测量相对导航方案的构成以及具体的导航算法;其次,根据两个追踪航天器与目标航天器的几何构型,推导双视线测量方法中的误差传递规律,并分析其中的影响因素;然后,对两个追踪航天器的编队构型进行设计,并分析编队构型对该方法导航性能的影响;最后,通过数值仿真对上述相关的结论进行验证。     

基于有向图的航天器编队飞行自适应姿态协同控制

在有向通信拓扑下研究了编队航天器自适应姿态协同控制问题。针对航天器编队飞行系统中存在外部扰动和模型不确定性的情况,通过选取包含相对姿态误差和绝对姿态误差的辅助变量,提出了一种鲁棒自适应控制策略。提出了自适应律估计转动惯量矩阵和扰动上界等未知参数,并且利用Lyapunov稳定性理论分析了闭环系统的渐近稳定性。与滑模控制等传统鲁棒控制不同,所设计的鲁棒自适应控制器是连续的,更便于航天器编队飞行系统的实现。最后通过仿真验证了该控制策略能够实现高精度的编队飞行跟踪控制。     

包含乘性噪声自适应修正的非合作目标相对导航算法

无人机（UAV）态势感知的任务是利用机载传感器对未知环境进行目标识别和引导，针对无人机与非合作目标间中远距离的相对导航问题，提出了一种基于角度和距离量测的相对状态估计算法。在现有滤波算法的基础上，为了提高精度和稳定性，本文利用了列文伯格-马夸尔特（LM）优化的思想对迭代卡尔曼滤波（IEKF）算法进行改进，提出了一种LM-IEKF算法，并推导该算法在迭代过程中的状态更新方程及协方差阵的递推公式。在此基础上，考虑到距离传感器由于信号相关特性而引入的乘性噪声，现有的加性噪声模型难以适应，因此，进一步提出了基于量测噪声自适应修正的Modified LM-IEKF方法，通过在线实时更新噪声阵提高滤波的精度，并设置渐消记忆指数平滑估计结果。算法验证结果表明，与现有的EKF、IEKF算法相比，在仅含加性噪声的情况下，LM-IEKF算法具有更好的性能；在包含乘性噪声的情况下，Modified LM-IEKF可以有效地估计量测噪声，与目前广泛使用的EKF算法相比，在综合相对位置和相对速度精度上分别提高了10%和23%。     

空间多机器人协同的多视线仅测角相对导航

研究了空间多机器人对非合作目标的多视线协同仅测角相对导航问题。为利用多视线信息融合提升仅测角相对导航性能,给出了一种可观测度优化的多视线仅测角相对导航方法。首先基于二阶CW方程构建了中心机器人与目标相对动力学模型和状态方程,并构建了仅包含多伴飞机器人视线角的观测方程,结合扩展卡尔曼滤波算法,形成多视线仅测角相对导航系统;然后分析推导得到可观度最优的视线间夹角条件,提出了兼顾可观测度和长期自然维持的多伴飞机器人观测构型优化方法;最后,数学仿真结果表明,提出的多视线仅测角相对导航系统、可观测度最优的视线夹角条件和观测构型优化方法,可以显著提高距离状态可观测度和估计性能,且具有较好的工程可用性。     

基于双视线测量的相对导航方法

对非合作目标自主交会中的中远程相对导航问题进行研究.首先,给出二阶近似的航天器相对轨道动力学方程,并对视线(LOS)导航方法的可观测性进行了分析.然后,提出基于双视线测量的相对导航方案.该导航方案中,系统过程噪声模型采用适用于航天器远距离相对运动的轨道动力学方程;量测量包括目标对两个追踪航天器的视线角和追踪航天器之间的...     

水下复杂环境下基于SINS/USBL/DVL多源信息融合的组合导航算法

针对复杂水下声场环境下高精度、长航时导航与定位的需求,构建了捷联惯性导航系统(SINS)/超短基线(USBL)相对测量信息的观测方程和SINS/声学多普勒测速仪(DVL)的观测方程,提出了一种融合SINS/USBL/DVL多源信息的组合定位算法.为解决声学量测信息不确定引起的导航性能下降的问题,充分考虑水声野值所导致的...     

基于伪距伪距率的双星定位系统/SINS组合导航系统的研究与仿真

双星定位是我国建立起来的一种区域性定位系统(GAPS)。文中介绍了双星定位的基本原理,根据其接收机的特点,论证了双星定位与惯导组合的必然性。建立了其组合的状态、观测方程,仿真结果表明了该组合方法的可行性。     

基于三级滤波的民用飞机组合导航融合算法研究

高精度导航系统是民用飞机必备的机载航电设备。针对民用飞机导航传感器冗余配置特点,设计了一种基于三级滤波的组合导航融合算法。首先根据民用飞机传感器配置特点设计三级滤波架构,然后通过第一级卡尔曼滤波器的局部估计、第二级联邦滤波器的全局估计和第三级全局滤波器的最优全局估计,最终实现导航参数的最优全局估计。最后,通过计算机仿真证明该方法具有很好的位置、速度和姿态估计精度,能够满足民用飞机导航系统的高精度测量要求。     

A New Algorithm for Strapped-Down Inertial Navigation

When a whole-number digital computer, rather than an incremental digital computer, is used to solve the strapped-down inertial navigation computational problem, the approximate direct solution of the direction-cosines matrix equation is no longer the optimal algorithm. The Euler parameters are demonstrated to afford improved accuracy and reduced computation time when used in an appropriate algorithm. A new method of classifying the transformation errors is developed and used.     

基于3D Zernike矩的巡检器与空间站的相对导航算法

针对航天器相对导航问题,以空间站表面为"特殊地形",提出一种基于大型航天器表面巡检的相对导航算法。首先,运用巡检飞行器上的TOF （Time of Flight）相机测量空间站表面局部点云数据,以该点云数据为实时图,以空间站表面先验点云数据为基准图。然后,利用3D Zernike矩与三维地形间的一一对应关系,将三维地形匹配转化为基于3D Zernike矩的特征向量匹配。在此基础上求解实时图与匹配上的基准图间的相对位置、相对姿态,从而确定两航天器间的相对导航参数,并通过实验分析了匹配精度及速度的主要影响因素。最后,将该相对导航参数与惯性系统推算的相对导航参数在扩展卡尔曼滤波器的框架下实现信息融合,估计了巡检飞行器与空间站间的相对位置、相对姿态,实验结果表明,相对位置精度优于0.002 m,相对姿态精度优于0.1°。     

基于对偶数的航天器多特征融合相对导航算法

针对基于视觉的航天器相对导航问题,利用对偶数推导并给出了航天器相对耦合动力学方程,该方程一体化描述了追踪航天器相对于目标航天器的姿态运动和轨道运动,且考虑了由非质心点引起的相对姿态与相对轨道之间的耦合影响。在对偶代数的框架内,统一描述了目标航天器上的特征点和特征线,并基于特征点、线在像平面的投影建立了多特征融合的单目视觉测量模型。最后通过对系统状态方程以及测量方程的线性化,应用迭代扩展卡尔曼滤波(IEKF)算法对非质心点的相对运动状态进行了估计。仿真结果表明,本文的算法能够对航天器非质心点的相对运动状态进行较高精度的估计。