弹载SINS-GPS-SAR组合导航算法:原理、建模与优化研究_第1页
弹载SINS-GPS-SAR组合导航算法:原理、建模与优化研究_第2页
弹载SINS-GPS-SAR组合导航算法:原理、建模与优化研究_第3页
弹载SINS-GPS-SAR组合导航算法:原理、建模与优化研究_第4页
弹载SINS-GPS-SAR组合导航算法:原理、建模与优化研究_第5页
已阅读5页,还剩32页未读 继续免费阅读

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

弹载SINS/GPS/SAR组合导航算法:原理、建模与优化研究一、引言1.1研究背景与意义在现代战争中,精确打击能力是衡量军事力量的关键指标之一,而弹载导航系统则是实现精确打击的核心技术。随着科技的飞速发展,战场环境变得愈发复杂,对弹载导航系统的精度、可靠性和抗干扰能力提出了前所未有的挑战。单一的导航系统已难以满足现代战争的多样化需求,因此,研究和开发高性能的组合导航系统成为国防科技领域的重要课题。捷联惯性导航系统(Strap-downInertialNavigationSystem,SINS)是一种基于惯性原理的自主式导航系统,通过内部的三轴加速度计和陀螺仪测量载体的加速度和角速度,进而实时计算出载体的位置、速度和姿态信息。其自主性强,不依赖外部信号,在短时间内能够提供较为精确的导航数据,且具有良好的动态响应特性,能够适应各种复杂的飞行姿态和高过载环境。然而,由于惯性传感器存在不可避免的漂移误差,随着时间的累积,SINS的导航误差会逐渐增大,导致导航精度急剧下降,难以满足长时间、远距离的精确导航需求。全球定位系统(GlobalPositioningSystem,GPS)是一种基于卫星信号的导航系统,具有全球覆盖、高精度、全天候、实时性强等显著优点。它通过接收多颗卫星发射的信号,利用三角测量原理精确确定载体的位置和速度。在理想条件下,GPS能够提供米级甚至更高精度的定位信息,为各类军事和民用应用提供了强大的导航支持。但GPS信号相对较弱,在复杂的战场环境中,如城市峡谷、山区、丛林等地形复杂区域,以及受到电子干扰、卫星信号遮挡等情况下,GPS信号容易受到干扰、衰减甚至完全丢失,导致定位精度大幅下降或导航中断,严重影响其在军事应用中的可靠性和稳定性。合成孔径雷达(SyntheticApertureRadar,SAR)是一种主动式微波成像雷达,利用雷达与目标之间的相对运动,通过信号处理合成等效的大孔径天线,从而获得高分辨率的二维图像。它不受天气、光照条件的限制,能够在恶劣气象条件下正常工作,对地面目标进行精确成像。SAR图像包含了丰富的地物特征信息,通过图像匹配技术,可以将实时获取的SAR图像与预先存储的基准图像进行比对,从而确定载体的位置和姿态,实现高精度的导航定位。但SAR图像匹配算法计算复杂度较高,对硬件计算能力要求苛刻,且在图像特征不明显或地形变化较大的区域,匹配精度和可靠性会受到一定影响。将SINS、GPS和SAR三种导航技术有机组合形成的SINS/GPS/SAR组合导航系统,能够充分发挥各子系统的优势,有效弥补单一导航系统的不足,实现优势互补。在GPS信号正常时,利用GPS的高精度定位信息对SINS的误差进行实时校正,抑制SINS误差的积累,提高导航系统的整体精度;当GPS信号受到干扰或丢失时,SINS能够凭借其自主性继续提供导航信息,保证导航的连续性,同时,利用SAR图像匹配技术辅助惯性导航,通过对SAR图像的处理和分析,获取载体的位置和姿态信息,进一步提高导航精度,增强系统在复杂环境下的可靠性和适应性。这种组合导航系统在导弹、无人机、飞行器等各类运动载体的导航中具有广阔的应用前景,能够显著提升武器装备的作战效能和生存能力。研究弹载SINS/GPS/SAR组合导航算法,对于提升我国国防科技水平,增强武器装备的现代化作战能力具有重要的现实意义。一方面,高精度、高可靠性的组合导航系统能够为导弹等精确制导武器提供更为精准的导航信息,有效提高武器的命中精度和打击效果,增强我国军事力量的威慑力;另一方面,该研究有助于推动我国在惯性导航、卫星导航、雷达技术以及数据融合算法等相关领域的技术创新和发展,促进多学科交叉融合,为我国国防科技的可持续发展奠定坚实的基础。此外,随着民用领域对导航精度和可靠性要求的不断提高,弹载SINS/GPS/SAR组合导航算法的研究成果也有望转化应用于民用航空、智能交通、地质勘探等领域,产生巨大的经济效益和社会效益。1.2国内外研究现状在弹载SINS/GPS/SAR组合导航算法的研究领域,国内外学者和科研机构都投入了大量的精力,取得了一系列具有重要价值的成果。国外在该领域的研究起步较早,技术相对成熟。美国在全球定位系统(GPS)的基础上,大力发展组合导航技术。美国军方及相关科研机构在弹载SINS/GPS/SAR组合导航算法的研究中处于世界领先地位,其研发的多种导弹武器系统都配备了先进的组合导航系统。在算法研究方面,美国学者通过改进卡尔曼滤波算法,如扩展卡尔曼滤波(EKF)、无迹卡尔曼滤波(UKF)等,提高了对系统状态的估计精度,有效融合了SINS、GPS和SAR的导航信息。此外,还研究了基于神经网络、粒子滤波等新兴算法的组合导航方法,以增强系统在复杂环境下的适应性和鲁棒性。欧洲在航天和军事领域也积极开展组合导航技术的研究,欧洲的一些国家联合开展项目,致力于提升组合导航系统的精度和可靠性。例如,在SAR图像匹配算法上,欧洲科研团队提出了一些创新性的算法,通过对SAR图像特征的深入挖掘和分析,提高了图像匹配的速度和精度,为弹载组合导航系统提供了更准确的辅助定位信息。国内对弹载SINS/GPS/SAR组合导航算法的研究虽然起步相对较晚,但近年来发展迅速,取得了显著的成果。众多高校和科研院所积极参与相关研究,在理论研究和工程应用方面都取得了重要进展。在理论研究方面,国内学者针对卡尔曼滤波算法在组合导航应用中的局限性,提出了一系列改进算法,如自适应卡尔曼滤波算法,通过实时调整滤波参数,使其能够更好地适应系统噪声的变化,提高了滤波精度和稳定性。在SAR图像匹配算法方面,国内研究人员提出了基于特征点匹配、区域匹配等多种改进算法,有效提高了图像匹配的成功率和精度。在工程应用方面,我国已经成功将SINS/GPS/SAR组合导航技术应用于多种导弹型号中,显著提高了导弹的命中精度和作战效能。尽管国内外在弹载SINS/GPS/SAR组合导航算法研究方面取得了诸多成果,但仍存在一些不足之处。一方面,在复杂的战场环境下,如强电磁干扰、恶劣气象条件等,组合导航系统的可靠性和精度仍有待进一步提高。现有算法在应对这些复杂环境时,可能会出现性能下降甚至失效的情况。另一方面,随着导弹飞行速度和机动性的不断提高,对组合导航系统的实时性和动态适应性提出了更高的要求,现有的算法和系统架构在处理高动态信号时,还存在一定的局限性。此外,SAR图像匹配算法的计算复杂度仍然较高,如何在保证匹配精度的前提下,降低计算量,提高算法的实时性,也是亟待解决的问题之一。1.3研究目的与主要内容本研究旨在深入探索弹载SINS/GPS/SAR组合导航算法,通过对各导航系统的原理分析、系统建模以及算法优化,实现导航系统精度和抗干扰能力的显著提升,以满足现代战争对弹载导航系统日益严苛的要求。具体而言,研究目的主要包括以下几个方面:一是优化组合导航算法,充分融合SINS、GPS和SAR三种导航系统的信息,降低系统误差,提高导航精度;二是增强组合导航系统在复杂环境下的抗干扰能力,确保系统在受到电子干扰、卫星信号遮挡等不利因素影响时,仍能稳定可靠地工作;三是通过仿真验证和分析,评估所提出算法的性能,为实际工程应用提供理论支持和技术参考。基于上述研究目的,本论文的主要内容安排如下:各导航系统原理分析:深入剖析SINS、GPS和SAR三种导航系统的基本工作原理。对于SINS,详细阐述其基于惯性传感器测量载体加速度和角速度,进而通过积分运算求解载体位置、速度和姿态的过程,分析惯性传感器误差产生的原因及其对导航精度的影响;针对GPS,研究其卫星星座布局、信号传播特性以及基于卫星信号测量实现定位的原理,探讨GPS信号在复杂环境下受到干扰的机制;对于SAR,重点研究其合成孔径成像原理,以及如何利用SAR图像中的地物特征信息实现导航定位,分析影响SAR图像匹配精度的因素。组合导航系统建模:在明确各导航系统原理的基础上,构建SINS/GPS/SAR组合导航系统的数学模型。建立SINS的误差模型,包括加速度计和陀螺仪的漂移误差、刻度因数误差等,为后续的误差补偿和校正提供依据;构建GPS的观测模型,描述GPS测量值与真实位置、速度之间的关系;建立SAR图像匹配的观测模型,将SAR图像匹配得到的位置和姿态信息融入组合导航系统。确定各子系统之间的信息融合方式,建立组合导航系统的状态方程和观测方程,为组合导航算法的设计奠定基础。组合导航算法研究:针对SINS/GPS/SAR组合导航系统,研究高效的数据融合算法。深入研究卡尔曼滤波及其衍生算法,如扩展卡尔曼滤波(EKF)、无迹卡尔曼滤波(UKF)等在组合导航中的应用,分析这些算法在处理非线性系统和非高斯噪声时的优缺点。针对传统卡尔曼滤波算法对系统模型和噪声统计特性要求较高,在实际应用中容易出现滤波发散等问题,提出改进的自适应卡尔曼滤波算法,通过实时估计和调整系统噪声和观测噪声的统计特性,提高滤波算法的适应性和稳定性。研究基于神经网络、粒子滤波等新兴算法的组合导航方法,利用神经网络的自学习和自适应能力,以及粒子滤波对非线性、非高斯系统的良好处理能力,进一步提高组合导航系统在复杂环境下的性能。在算法研究过程中,注重算法的实时性和计算效率,确保算法能够满足弹载导航系统对实时性的严格要求。仿真验证与分析:利用Matlab等仿真工具,搭建SINS/GPS/SAR组合导航系统的仿真平台,对所研究的组合导航算法进行全面的仿真验证。设置多种典型的仿真场景,包括不同的飞行轨迹、干扰环境等,模拟弹载导航系统在实际应用中可能遇到的各种情况。在仿真过程中,对比不同算法在不同场景下的导航精度、抗干扰能力等性能指标,分析算法的优缺点和适用范围。通过仿真结果,评估所提出算法的有效性和可行性,为算法的进一步优化和实际应用提供数据支持。根据仿真结果,对算法进行优化和改进,不断提高组合导航系统的性能。二、弹载SINS、GPS、SAR导航系统基本原理2.1SINS导航原理2.1.1坐标系定义与转换在弹载SINS中,常用的坐标系包括惯性坐标系(i系)、地球坐标系(e系)、地理坐标系(n系)和载体坐标系(b系)。这些坐标系在描述载体运动和测量数据时发挥着关键作用,各坐标系之间的转换关系是SINS导航解算的重要基础。惯性坐标系(i系)是在空间静止或做匀速直线运动的坐标系,它为惯性器件的测量提供了参考基准。在实际应用中,通常采用以地球质心为原点建立的地心直角惯性坐标系来近似代替理想惯性系。在该坐标系中,Z_i轴与地球自转轴平行,方向指向北极;X_i轴指向春分点;X_i、Y_i、Z_i三轴构成右手正交系。地球坐标系(e系)的原点位于地心,坐标轴固定在地球上,构成右手正交系。其中,Z_e轴与极轴平行,方向指向北极;X_e轴指向本初子午线。GPS所使用的WGS-84直角坐标系就是一种高精度的协议地球坐标系,属于地球坐标系的范畴。地理坐标系(n系)是基于大地水准面定义的正交坐标系,通常采用北东地(NED)或东北天(ENU)的定义方式,在导航计算中作为重要的导航基准系。其原点是惯性传感器在大地水准面上的投影,在NED坐标系中,D轴垂直于参考椭球面,指向地球内部;N轴指向真北;E轴水平指向东,构成右手系。载体坐标系(b系)则固连于运载体,在弹载应用中,原点一般固定于导弹的重心。其中,X_b轴沿载体纵轴方向,指向导弹飞行前方;Y_b轴垂直于载体水平面向下;X_b、Y_b、Z_b三轴共同构成右手系。各坐标系之间的转换通过旋转矩阵来实现。例如,从地理坐标系(n系)到载体坐标系(b系)的旋转矩阵C_n^b,可以通过三次旋转得到。假设依次绕Z轴、Y轴、X轴旋转的角度分别为\psi、\theta、\gamma(分别对应航向角、俯仰角、横滚角),则旋转矩阵C_n^b可表示为:C_n^b=\begin{bmatrix}c\psic\theta&s\psic\theta&-s\theta\\c\psis\thetas\gamma-s\psic\gamma&s\psis\thetas\gamma+c\psic\gamma&c\thetas\gamma\\c\psis\thetac\gamma+s\psis\gamma&s\psis\thetac\gamma-c\psis\gamma&c\thetac\gamma\end{bmatrix}其中,c表示余弦函数,s表示正弦函数。i系到e系的旋转矩阵C_i^e与地球的自转相关,地球自转角速度为\omega_{ie},在时间t内,地球绕Z_e轴旋转的角度为\omega_{ie}t,则C_i^e可表示为:C_i^e=\begin{bmatrix}c(\omega_{ie}t)&s(\omega_{ie}t)&0\\-s(\omega_{ie}t)&c(\omega_{ie}t)&0\\0&0&1\end{bmatrix}e系到n系的变换矩阵C_e^n与地理坐标系的经纬度有关,设纬度为L,经度为\lambda,则:C_e^n=\begin{bmatrix}-sLc\lambda&-sLs\lambda&cL\\-s\lambda&c\lambda&0\\-cLc\lambda&-cLs\lambda&-sL\end{bmatrix}通过这些旋转矩阵,可以方便地将不同坐标系下的矢量进行转换,满足SINS在不同阶段的计算需求。例如,在将加速度计和陀螺仪在载体坐标系下的测量值转换到导航坐标系进行解算时,就需要利用上述转换关系。这些坐标系的准确定义以及它们之间精确的转换关系,为SINS后续的导航解算提供了统一的数学框架,确保了从惯性传感器测量数据到载体位置、速度和姿态信息计算过程的准确性和一致性。2.1.2导航解算模型SINS的核心任务是通过加速度计和陀螺仪的测量数据,实时解算出载体的位置、速度和姿态信息。其基本原理基于牛顿力学定律和运动学原理,通过积分运算实现对载体运动状态的推算。加速度计用于测量载体相对于惯性空间的比力,即载体加速度与引力加速度之差,记为\boldsymbol{f}^b(上标b表示在载体坐标系下)。陀螺仪则用于测量载体相对于惯性空间的旋转角速度,记为\boldsymbol{\omega}_{ib}^b。在导航解算过程中,首先需要将加速度计测量的比力从载体坐标系转换到导航坐标系(通常采用地理坐标系n系),转换公式为\boldsymbol{f}^n=C_b^n\boldsymbol{f}^b,其中C_b^n是从载体坐标系到导航坐标系的旋转矩阵。速度解算是SINS导航解算的关键步骤之一。根据牛顿第二定律,在导航坐标系下,速度的变化率等于比力与重力加速度的矢量和,即\dot{\boldsymbol{v}}^n=\boldsymbol{f}^n-2\boldsymbol{\omega}_{ie}^n\times\boldsymbol{v}^n-\boldsymbol{\omega}_{en}^n\times(\boldsymbol{\omega}_{en}^n\times\boldsymbol{r}^n)+\boldsymbol{g}^n。其中,\boldsymbol{v}^n是载体在导航坐标系下的速度,\boldsymbol{\omega}_{ie}^n是地球自转角速度在导航坐标系下的分量,\boldsymbol{\omega}_{en}^n是地球相对导航坐标系的角速度,\boldsymbol{r}^n是载体在导航坐标系下的位置矢量,\boldsymbol{g}^n是重力加速度在导航坐标系下的分量。对该式进行积分,即可得到载体在导航坐标系下的速度:\boldsymbol{v}^n(k)=\boldsymbol{v}^n(k-1)+\int_{t_{k-1}}^{t_k}(\boldsymbol{f}^n-2\boldsymbol{\omega}_{ie}^n\times\boldsymbol{v}^n-\boldsymbol{\omega}_{en}^n\times(\boldsymbol{\omega}_{en}^n\times\boldsymbol{r}^n)+\boldsymbol{g}^n)dt在实际计算中,通常采用离散化的数值积分方法,如四阶龙格-库塔法等,以提高计算精度和效率。位置解算则是基于速度积分实现的。在导航坐标系下,位置的变化率等于速度,即\dot{\boldsymbol{r}}^n=\boldsymbol{v}^n。对该式进行积分,可得载体在导航坐标系下的位置:\boldsymbol{r}^n(k)=\boldsymbol{r}^n(k-1)+\int_{t_{k-1}}^{t_k}\boldsymbol{v}^ndt同样,在实际计算中采用离散化积分方法。例如,采用简单的欧拉积分法,位置更新公式可近似表示为\boldsymbol{r}^n(k)=\boldsymbol{r}^n(k-1)+\boldsymbol{v}^n(k-1)\Deltat,其中\Deltat是积分时间间隔。姿态解算是SINS的另一个重要部分,它用于确定载体在空间的姿态。常用的姿态表示方法有欧拉角、四元数和方向余弦矩阵等。以四元数为例,四元数\boldsymbol{q}=[q_0,q_1,q_2,q_3]^T可以描述载体坐标系相对于导航坐标系的姿态变换。四元数的更新方程与陀螺仪测量的角速度相关,其微分方程为\dot{\boldsymbol{q}}=\frac{1}{2}\boldsymbol{\Omega}(\boldsymbol{\omega}_{ib}^b)\boldsymbol{q},其中\boldsymbol{\Omega}(\boldsymbol{\omega}_{ib}^b)是由角速度构成的反对称矩阵:\boldsymbol{\Omega}(\boldsymbol{\omega}_{ib}^b)=\begin{bmatrix}0&-\omega_{x}^b&-\omega_{y}^b&-\omega_{z}^b\\\omega_{x}^b&0&\omega_{z}^b&-\omega_{y}^b\\\omega_{y}^b&-\omega_{z}^b&0&\omega_{x}^b\\\omega_{z}^b&\omega_{y}^b&-\omega_{x}^b&0\end{bmatrix}对四元数微分方程进行积分,即可得到姿态四元数随时间的更新,从而确定载体的姿态。在实际应用中,也需要采用合适的离散化积分方法对四元数进行更新。通过上述速度、位置和姿态解算模型,SINS能够根据加速度计和陀螺仪的测量数据,实时计算出载体在空间中的运动状态,为导弹等载体的导航提供关键信息。2.1.3误差分析尽管SINS具有自主性强、不依赖外部信号等优点,但由于其测量原理和硬件特性,不可避免地会引入各种误差,这些误差会随着时间的推移逐渐积累,严重影响导航精度。深入分析SINS的误差来源及其对导航精度的影响,对于提高SINS性能和后续的误差补偿具有重要意义。SINS的误差主要来源于传感器误差和积分运算过程中产生的误差。传感器误差是SINS误差的重要组成部分,其中加速度计和陀螺仪的误差对导航精度影响显著。加速度计误差包括零偏误差、刻度因数误差和随机噪声等。零偏误差是指加速度计在没有输入加速度时的输出偏差,它会导致速度和位置解算产生恒定的误差积累。例如,若加速度计存在10^{-4}g(g为重力加速度)的零偏误差,经过100秒的积分,速度误差将达到0.1m/s,位置误差将达到5m。刻度因数误差则是指加速度计实际输出与理想输出之间的比例偏差,这会使测量的加速度不准确,进而影响速度和位置的计算精度。随机噪声是加速度计输出中的高频波动成分,虽然其幅度较小,但在长时间积分过程中也会对导航精度产生一定的影响。陀螺仪误差同样包含零偏误差、刻度因数误差和随机噪声。陀螺仪零偏误差会导致姿态解算误差的积累,进而影响速度和位置的计算。例如,若陀螺仪存在0.01^{\circ}/h的零偏误差,经过1小时,姿态误差将达到0.01^{\circ},这在高精度导航应用中是不可忽视的。刻度因数误差会使陀螺仪测量的角速度不准确,影响姿态更新的精度。随机噪声会使姿态解算产生高频抖动,降低姿态测量的稳定性。积分误差是SINS误差的另一个重要来源。在速度和位置解算过程中,需要对加速度和速度进行积分运算,由于实际计算中采用的离散化积分方法存在截断误差,随着积分次数的增加,这些误差会逐渐积累,导致导航精度下降。例如,采用简单的欧拉积分法时,其截断误差为二阶,如果积分时间间隔较大,误差积累会更加明显。此外,由于载体的运动通常是非线性的,而在解算模型中往往采用线性化近似,这也会引入模型误差,进一步影响导航精度。这些误差对导航精度的影响是多方面的。在短时间内,传感器的随机噪声和积分的截断误差可能是影响导航精度的主要因素;而在长时间导航过程中,传感器的零偏误差和刻度因数误差导致的误差积累将成为主导因素,使导航误差迅速增大,最终可能导致导航结果失去实际意义。因此,在设计和应用SINS时,必须充分考虑这些误差因素,采取有效的误差补偿和校正措施,以提高SINS的导航精度和可靠性。2.2GPS导航原理2.2.1定位原理GPS是一个基于卫星的无线电导航系统,通过测量卫星与地面接收机之间的距离来确定接收机的位置。其定位原理主要基于三角测量原理,通过测量至少四颗卫星到接收机的距离,利用空间几何关系解算出接收机的三维坐标(经度、纬度和高度)。在GPS系统中,卫星不断地向地球发射包含自身位置信息和时间信息的信号。接收机接收到这些信号后,通过测量信号从卫星传播到接收机的时间差,结合信号传播速度(光速),计算出卫星与接收机之间的距离,即伪距。假设卫星i的位置坐标为(x_{si},y_{si},z_{si}),接收机的位置坐标为(x,y,z),则伪距\rho_i的计算公式为:\rho_i=c\times\Deltat_i=\sqrt{(x-x_{si})^2+(y-y_{si})^2+(z-z_{si})^2}+c\times\deltat+\varepsilon_i其中,c是光速,\Deltat_i是信号从卫星i传播到接收机的时间,\deltat是接收机时钟与GPS标准时间的偏差,\varepsilon_i是测量误差。由于接收机时钟与GPS标准时间难以完全同步,因此测量得到的距离是包含时钟偏差的伪距。为了求解接收机的位置坐标(x,y,z)和时钟偏差\deltat,至少需要测量四颗卫星的伪距,建立四个方程联立求解。除了伪距测量外,GPS还可以通过载波相位测量来提高定位精度。载波相位测量是利用卫星发射的载波信号作为测量基准,通过测量接收机接收到的载波信号与本地产生的参考载波信号之间的相位差,来确定卫星与接收机之间的距离。与伪距测量相比,载波相位测量的精度更高,可达到毫米级。但载波相位测量存在整周模糊度问题,即无法直接确定初始相位差中的整周数,需要通过特定的算法进行解算。常用的解算方法包括基于双差观测值的方法、快速模糊度解算方法等。在实际应用中,GPS接收机通常采用差分定位技术进一步提高定位精度。差分定位是利用已知位置的基准站和待定位的移动站同时接收卫星信号,通过比较两者接收到的信号差异,消除或减小公共误差源的影响,从而提高移动站的定位精度。根据差分改正数的发送方式和作用范围,差分定位可分为单站差分、区域差分和广域差分等类型。单站差分是最简单的差分定位方式,基准站将观测到的卫星信号误差信息直接发送给移动站,移动站根据这些信息对自身的测量数据进行修正;区域差分和广域差分则通过多个基准站组成的网络,对更大范围内的卫星信号误差进行监测和修正,并将差分改正数发送给移动站,以实现更精确的定位。2.2.2误差分析尽管GPS在理想情况下能够提供高精度的定位信息,但在实际应用中,由于受到多种因素的影响,GPS定位会产生一定的误差,这些误差会降低定位精度,影响其在高精度导航领域的应用。深入了解GPS误差的来源及其对定位精度的影响,对于采取有效的误差补偿措施和提高GPS定位性能具有重要意义。卫星相关误差是影响GPS定位精度的重要因素之一。卫星轨道误差是指卫星实际运行轨道与预定轨道之间的偏差。卫星在太空中运行时,会受到地球引力、太阳引力、月球引力以及太阳光压等多种摄动力的复杂影响,这些摄动力会导致卫星轨道发生微小变化,从而使卫星的实际位置与星历表中预报的位置存在差异。卫星轨道误差对定位精度的影响较大,尤其是在单点定位中,其误差可达数米甚至数十米。卫星时钟误差则是指GPS卫星上的原子钟与GPS标准时间之间的偏差。虽然GPS卫星采用了高精度的原子钟,但由于时钟漂移、相对论效应等因素的影响,卫星时钟与标准时间之间仍会存在一定的偏差。这种偏差会导致卫星发射的信号时间不准确,从而在伪距测量中引入误差,等效距离误差可达数十米。信号传播误差也是GPS误差的重要来源。大气层对GPS信号的影响主要体现在电离层延迟和对流层延迟。电离层是地球大气层中的一个区域,其中存在大量的自由电子和离子,会对GPS信号产生折射作用,导致信号传播速度发生变化,从而使测量得到的伪距产生误差。电离层延迟与太阳活动、时间、地理位置等因素密切相关,在太阳活动剧烈时,电离层延迟误差可达数十米。对流层是地球大气层的较低层,主要由中性气体组成,对GPS信号的影响主要表现为信号传播路径的弯曲和速度的变化,从而产生对流层延迟误差。对流层延迟与大气温度、湿度、气压等气象条件有关,一般在数米到十几米之间。多径效应是指GPS信号在传播过程中,由于受到周围环境(如建筑物、山脉、水面等)的反射,接收机接收到的信号不仅包含直接来自卫星的直射信号,还包含经过反射的反射信号。这些不同路径的信号相互干涉,导致接收机测量的伪距和载波相位产生误差,严重时会使定位结果出现较大偏差,在城市峡谷等复杂环境中,多径效应误差可达到数米甚至更大。接收机相关误差同样不可忽视。接收机的噪声和干扰会影响信号的接收和处理质量,从而产生误差。接收机内部的电子元件在工作过程中会产生热噪声,外部的电磁干扰也可能影响接收机的正常工作,导致测量数据出现偏差。接收机的测量误差还包括码跟踪误差和载波跟踪误差,这些误差会导致伪距和载波相位测量的不准确,进而影响定位精度。此外,接收机的时钟误差也会对定位结果产生影响,与卫星时钟误差类似,接收机时钟与GPS标准时间的不同步会在伪距测量中引入误差。这些误差相互叠加,会严重影响GPS的定位精度。在实际应用中,需要采取多种措施来减小这些误差的影响,如采用差分定位技术、选择合适的观测环境、优化接收机设计等,以提高GPS定位的准确性和可靠性。2.3SAR导航原理2.3.1工作原理合成孔径雷达(SAR)是一种主动式微波成像雷达,其工作原理基于合成孔径技术和脉冲压缩技术,能够实现对远距离目标的高分辨率成像,为导航提供丰富的地形信息。SAR利用雷达与目标之间的相对运动,通过信号处理合成等效的大孔径天线,从而提高方位向分辨率。在实际工作中,SAR通常搭载于飞机、卫星或导弹等运动平台上。当平台沿飞行方向移动时,雷达不断向地面发射窄脉冲信号,这些信号经地面目标散射后返回,被雷达接收。由于雷达在不同位置发射和接收信号,对于同一地面目标,回波信号的相位和幅度会随着雷达位置的变化而变化。通过记录和处理这些回波信号,将不同位置接收到的回波信号进行相干叠加,就可以合成一个等效的大孔径天线,其孔径长度等于雷达在观测时间内移动的距离。根据雷达成像理论,天线孔径越大,方位向分辨率越高,因此,SAR能够获得高分辨率的方位向图像。在距离向,SAR采用脉冲压缩技术来提高分辨率。发射的脉冲信号具有一定的带宽,通过匹配滤波处理,将宽脉冲压缩成窄脉冲,从而提高距离向的分辨率。例如,发射的线性调频(Chirp)信号,其频率随时间线性变化。在接收回波时,通过与发射信号的共轭进行相关运算,实现脉冲压缩,将原本宽的脉冲压缩到极窄的宽度,使得雷达能够分辨出距离相近的目标。SAR成像的基本流程包括发射信号、接收回波、距离压缩、方位向处理和图像生成等步骤。在发射阶段,雷达发射具有特定波形的脉冲信号;接收回波后,首先进行距离压缩,将接收到的宽脉冲回波信号压缩成窄脉冲,以提高距离向分辨率;然后进行方位向处理,利用合成孔径原理,对不同位置接收到的回波信号进行相位补偿和相干叠加,实现方位向聚焦;最后,经过一系列的数据处理和图像重构算法,生成高分辨率的二维SAR图像。这些图像包含了丰富的地物特征信息,如地形起伏、建筑物分布、道路走向等,通过对这些图像的分析和处理,可以提取出用于导航的关键信息,如地标特征、目标位置等,从而实现基于SAR图像的导航定位。2.3.2运动补偿在SAR成像过程中,运动补偿是至关重要的环节,它对于提高SAR图像的质量和导航精度起着决定性作用。由于SAR通常搭载在运动平台上,如飞机、卫星或导弹,平台在飞行过程中不可避免地会受到各种因素的影响,导致其运动状态发生变化,产生运动误差。这些运动误差会严重影响SAR图像的成像质量,进而降低基于SAR图像的导航精度。因此,必须采取有效的运动补偿措施来消除或减小运动误差的影响。运动误差主要包括平移误差、速度误差和姿态误差。平移误差是指平台在三维空间中的位置偏移,这会导致雷达与目标之间的距离发生变化,使得回波信号的时延产生偏差;速度误差表现为平台实际飞行速度与理想速度的差异,这会改变回波信号的多普勒频率,影响方位向的聚焦效果;姿态误差则是指平台的俯仰、滚转和偏航角度的变化,这些变化会使雷达波束的指向发生改变,导致成像区域的偏移和图像的几何畸变。为了实现运动补偿,通常采用基于导航数据和基于回波信号的两种方法。基于导航数据的运动补偿方法是利用高精度的导航设备,如惯性导航系统(INS)、全球定位系统(GPS)等,实时测量平台的运动参数,包括位置、速度和姿态信息。通过将实际测量的运动参数与理想的运动轨迹进行对比,计算出运动误差,并根据这些误差对回波信号进行相应的时延和相位校正,以消除运动误差对成像的影响。这种方法的优点是简单直接,补偿效果较好,但依赖于导航设备的精度和可靠性,如果导航设备出现故障或误差较大,运动补偿的效果将受到严重影响。基于回波信号的运动补偿方法则是直接从回波信号中提取运动误差信息。该方法利用SAR回波信号的特性,通过对回波信号的分析和处理,估计出平台的运动误差。例如,利用回波信号的多普勒特性来估计速度误差,通过对回波信号的相位分析来确定姿态误差等。然后,根据估计出的运动误差对回波信号进行校正,实现运动补偿。这种方法不依赖于外部导航设备,具有较强的自主性,但算法较为复杂,对信号处理能力要求较高,且在某些情况下,如信噪比较低时,运动误差的估计精度可能会受到影响。在实际应用中,通常将基于导航数据和基于回波信号的运动补偿方法相结合,充分发挥两种方法的优势,以提高运动补偿的精度和可靠性。例如,首先利用导航数据进行粗补偿,初步消除较大的运动误差,然后再利用回波信号进行精补偿,进一步提高补偿精度,从而获得高质量的SAR图像,为后续的导航定位提供准确的数据支持。2.3.3误差分析尽管SAR具有高分辨率成像和不受天气、光照条件限制等优点,但在实际应用中,由于多种因素的影响,SAR会产生各种误差,这些误差会对导航精度产生显著影响,因此,深入分析SAR误差来源及其对导航精度的影响具有重要意义。成像误差是SAR误差的重要组成部分。在成像过程中,由于雷达系统本身的性能限制以及外界环境因素的干扰,会导致成像结果与实际地物存在偏差。例如,雷达发射信号的频率稳定性、脉冲宽度的准确性以及接收系统的噪声等都会影响成像质量。若发射信号的频率存在漂移,会使回波信号的相位发生变化,导致成像模糊;接收系统的噪声会降低回波信号的信噪比,使图像细节丢失,影响对目标特征的提取。几何畸变也是SAR常见的误差之一。几何畸变主要是由于SAR成像的斜距投影特性以及平台运动误差、地形起伏等因素引起的。在SAR成像中,雷达测量的是斜距信息,将斜距信息转换为地距信息时,会因为地球曲率和地形起伏的影响产生几何失真。当地形起伏较大时,靠近雷达一侧的地物在图像上会出现压缩现象,而远离雷达一侧的地物则会出现拉伸现象,这会导致图像中地物的位置和形状发生改变。平台的运动误差也会加剧几何畸变,使成像区域发生偏移和旋转。这些误差对导航精度的影响是多方面的。在基于SAR图像匹配的导航中,成像误差和几何畸变会导致实时SAR图像与预先存储的基准图像之间的特征差异增大,从而降低图像匹配的成功率和精度。如果匹配错误或精度不足,就会导致导航定位出现偏差,影响导弹等载体的飞行轨迹和命中精度。此外,误差还会影响对目标位置和姿态的估计,使导航系统提供的位置和姿态信息与实际情况不符,可能导致导弹在飞行过程中偏离预定航线,无法准确命中目标。因此,为了提高弹载SAR导航的精度,必须对这些误差进行有效的补偿和校正,以减小误差对导航精度的影响。2.4SINS/GPS/SAR组合导航原理2.4.1组合模式SINS/GPS/SAR组合导航系统通过不同的组合模式实现各子系统间的信息融合,常见的组合模式包括松组合和紧组合,它们在系统架构、信息交互方式以及性能特点上存在明显差异。松组合模式,也被称为位置/速度组合模式,是一种相对简单的组合方式。在该模式下,SINS、GPS和SAR各自独立完成导航解算,分别输出载体的位置、速度和姿态信息。然后,通过一个中央处理器对这些独立解算得到的信息进行融合处理。例如,利用卡尔曼滤波算法,将SINS输出的位置和速度信息与GPS、SAR提供的相应信息进行融合。其融合过程主要基于位置和速度的观测值,将不同导航系统的输出作为独立的观测数据输入到滤波器中,通过滤波器的状态估计和更新过程,得到更准确的导航结果。松组合模式的优点在于系统结构简单,各子系统之间的耦合度较低,易于实现和维护。由于各子系统独立工作,当某个子系统出现故障时,其他子系统仍能继续提供导航信息,从而提高了系统的可靠性。但松组合模式也存在一些局限性,由于它仅融合位置和速度信息,忽略了各子系统内部的测量细节,无法充分利用各导航系统的优势,因此在精度提升方面存在一定的局限性。此外,由于各子系统独立解算,数据处理量较大,对硬件计算能力有一定要求。紧组合模式则是一种更为紧密的信息融合方式。在紧组合模式下,SINS、GPS和SAR的测量数据在早期阶段就进行融合处理。以GPS为例,不再是将GPS的定位结果直接用于融合,而是将GPS接收机的原始测量数据,如伪距、伪距率等,与SINS的测量数据(加速度计和陀螺仪的输出)一起输入到组合导航滤波器中。在滤波器中,同时对这些原始测量数据进行处理和融合,通过建立更为复杂的系统模型和观测模型,充分考虑各测量数据之间的相关性和互补性,实现更精确的状态估计。对于SAR,其图像匹配得到的位置和姿态增量信息也可以与SINS和GPS的原始测量数据一起参与融合。紧组合模式的优势在于能够充分利用各导航系统的原始测量信息,提高信息利用率,从而显著提升组合导航系统的精度。由于早期融合测量数据,能够更好地抑制误差传播,增强系统的抗干扰能力。但紧组合模式的实现难度较大,系统的复杂度高,对硬件性能和算法设计要求苛刻。各子系统之间的耦合度高,一旦某个子系统出现故障,可能会对整个系统的性能产生较大影响,降低系统的可靠性。不同组合模式在实际应用中各有优劣,应根据具体的应用需求和场景选择合适的组合模式。在对精度要求相对较低,且需要较高可靠性和简单系统架构的场景下,松组合模式可能更为适用;而在对导航精度要求极高,且硬件条件能够满足复杂计算需求的情况下,紧组合模式则能够发挥其优势,提供更精确的导航信息。2.4.2信息融合策略在SINS/GPS/SAR组合导航系统中,信息融合策略是实现高精度导航的关键环节,它直接影响着系统对各子系统信息的综合利用效率和导航精度。卡尔曼滤波及其衍生算法、粒子滤波等是常用的信息融合方法,它们在不同的应用场景中展现出各自的特点和优势。卡尔曼滤波是一种基于线性系统和高斯噪声假设的最优估计方法,在组合导航领域得到了广泛应用。它通过建立系统的状态方程和观测方程,利用前一时刻的状态估计值和当前时刻的观测值,递归地计算出当前时刻的最优状态估计值。在SINS/GPS/SAR组合导航系统中,系统状态向量通常包括载体的位置、速度、姿态以及SINS的误差状态等。状态方程描述了系统状态随时间的变化规律,例如,SINS的误差状态会随着时间逐渐积累,状态方程可以准确地刻画这种变化。观测方程则建立了系统状态与各导航系统观测值之间的关系,GPS的伪距观测值、SAR图像匹配得到的位置观测值等都可以通过观测方程与系统状态相联系。卡尔曼滤波算法主要包括预测和更新两个步骤。在预测步骤中,根据系统状态方程,利用前一时刻的状态估计值预测当前时刻的状态和误差协方差;在更新步骤中,根据当前时刻的观测值和观测方程,对预测的状态进行修正,得到更准确的状态估计值,并更新误差协方差。然而,实际的组合导航系统往往具有非线性特性,传统的卡尔曼滤波在处理非线性系统时存在一定的局限性。为了应对这一问题,扩展卡尔曼滤波(EKF)应运而生。EKF通过对非线性系统进行一阶泰勒展开,将其近似线性化,然后应用卡尔曼滤波算法进行状态估计。在SINS/GPS/SAR组合导航中,当涉及到一些非线性模型,如SAR图像匹配中的几何变换模型时,EKF可以通过线性化处理,将这些非线性关系近似为线性关系,从而实现对系统状态的估计。但EKF的线性化近似会引入一定的误差,在系统非线性较强时,这种误差可能会导致滤波性能下降,甚至滤波发散。无迹卡尔曼滤波(UKF)则是一种改进的非线性滤波算法,它采用确定性采样策略来近似系统的概率分布,避免了EKF中的线性化近似过程。UKF通过选择一组Sigma点来描述系统状态的概率分布,这些Sigma点能够更准确地捕捉系统状态的统计特性。在预测和更新步骤中,对Sigma点进行相应的变换和加权计算,从而得到更精确的状态估计值。在处理SAR图像匹配中复杂的非线性关系以及应对SINS误差模型中的非线性因素时,UKF能够提供比EKF更准确的估计结果,在非线性较强的组合导航系统中具有更好的性能表现。粒子滤波是一种基于蒙特卡罗模拟的非线性滤波方法,它适用于处理各种复杂的非线性、非高斯系统。粒子滤波通过在状态空间中随机采样大量的粒子来近似系统状态的概率分布,每个粒子都携带一个权重,表示该粒子的可信度。在每一时刻,根据系统的观测值和状态转移模型,对粒子的权重进行更新,并重新采样粒子,使得权重较大的粒子被更多地采样,从而逐渐逼近系统的真实状态。在SINS/GPS/SAR组合导航系统中,当面临复杂的干扰环境,导致系统噪声呈现非高斯分布时,粒子滤波能够充分发挥其优势,通过大量粒子的采样和权重更新,准确地估计系统状态,提高组合导航系统在复杂环境下的适应性和鲁棒性。这些信息融合策略在SINS/GPS/SAR组合导航系统中各有其适用场景和优缺点,在实际应用中,需要根据系统的具体特性和应用需求,选择合适的信息融合方法,以实现最优的导航性能。三、弹载SINS/GPS/SAR组合导航系统建模3.1系统状态方程建立系统状态方程的构建是弹载SINS/GPS/SAR组合导航系统建模的核心环节之一,它描述了系统状态随时间的动态变化过程,为后续的导航解算和数据融合提供了重要的数学基础。在建立状态方程时,需要综合考虑SINS、GPS和SAR各子系统的误差特性以及它们之间的相互关系,通过合理选择状态变量,准确刻画系统的动态行为。在弹载SINS/GPS/SAR组合导航系统中,状态变量的选择至关重要,它直接影响到状态方程的准确性和系统性能。通常,状态变量包括载体的运动状态变量和各导航系统的误差状态变量。载体的运动状态变量主要有位置误差、速度误差和姿态误差。位置误差\delta\boldsymbol{r}=[\deltar_N,\deltar_E,\deltar_D]^T,分别表示在地理坐标系下北、东、地三个方向上的位置偏差;速度误差\delta\boldsymbol{v}=[\deltav_N,\deltav_E,\deltav_D]^T,对应北、东、地方向的速度偏差;姿态误差采用欧拉角误差表示,即\delta\boldsymbol{\phi}=[\delta\phi_N,\delta\phi_E,\delta\phi_D]^T,分别代表航向角、俯仰角和横滚角的误差。SINS的误差状态变量包含加速度计和陀螺仪的误差。加速度计的零偏误差\delta\boldsymbol{b}_a=[\deltab_{ax},\deltab_{ay},\deltab_{az}]^T,表示加速度计在三个轴向的零偏偏差;加速度计的刻度因数误差\delta\boldsymbol{k}_a=[\deltak_{ax},\deltak_{ay},\deltak_{az}]^T,体现了加速度计实际刻度因数与标称值之间的差异。陀螺仪的零偏误差\delta\boldsymbol{b}_g=[\deltab_{gx},\deltab_{gy},\deltab_{gz}]^T,反映了陀螺仪在三个轴向的零偏漂移;陀螺仪的刻度因数误差\delta\boldsymbol{k}_g=[\deltak_{gx},\deltak_{gy},\deltak_{gz}]^T,表示陀螺仪刻度因数的误差。综合以上状态变量,弹载SINS/GPS/SAR组合导航系统的状态向量\boldsymbol{X}可表示为:\boldsymbol{X}=[\delta\boldsymbol{r}^T,\delta\boldsymbol{v}^T,\delta\boldsymbol{\phi}^T,\delta\boldsymbol{b}_a^T,\delta\boldsymbol{k}_a^T,\delta\boldsymbol{b}_g^T,\delta\boldsymbol{k}_g^T]^T根据各状态变量的物理特性和相互关系,建立状态方程。状态方程的一般形式为\dot{\boldsymbol{X}}=\boldsymbol{F}\boldsymbol{X}+\boldsymbol{W},其中\boldsymbol{F}是系统状态转移矩阵,它描述了状态变量之间的耦合关系和随时间的变化规律;\boldsymbol{W}是系统噪声向量,包含了各种不确定性因素对系统状态的影响。对于位置误差的变化率,可根据速度误差和地球自转角速度等因素推导得出。在地理坐标系下,位置误差的微分方程为:\dot{\delta\boldsymbol{r}}=\delta\boldsymbol{v}-(\boldsymbol{\omega}_{ie}^n+\boldsymbol{\omega}_{en}^n)\times\delta\boldsymbol{r}其中,\boldsymbol{\omega}_{ie}^n是地球自转角速度在地理坐标系下的分量,\boldsymbol{\omega}_{en}^n是地球相对地理坐标系的角速度。速度误差的变化率与加速度计误差、姿态误差以及重力加速度误差等相关。其微分方程为:\dot{\delta\boldsymbol{v}}=-(\boldsymbol{\omega}_{ie}^n+\boldsymbol{\omega}_{en}^n)\times\delta\boldsymbol{v}+\boldsymbol{C}_b^n(\delta\boldsymbol{f}+\delta\boldsymbol{k}_a\boldsymbol{f}^b+\boldsymbol{\nabla})-\delta\boldsymbol{g}其中,\boldsymbol{C}_b^n是从载体坐标系到地理坐标系的转换矩阵,\delta\boldsymbol{f}是加速度计测量误差,\boldsymbol{\nabla}是加速度计的随机噪声,\delta\boldsymbol{g}是重力加速度误差。姿态误差的变化率与陀螺仪误差、速度误差等有关。其微分方程为:\dot{\delta\boldsymbol{\phi}}=-\boldsymbol{\omega}_{in}^n\times\delta\boldsymbol{\phi}+\boldsymbol{C}_b^n(\delta\boldsymbol{\omega}+\delta\boldsymbol{k}_g\boldsymbol{\omega}_{ib}^b+\boldsymbol{\varepsilon})+\delta\boldsymbol{v}\times\boldsymbol{g}^n/v^2其中,\boldsymbol{\omega}_{in}^n是载体相对惯性空间的角速度在地理坐标系下的分量,\delta\boldsymbol{\omega}是陀螺仪测量误差,\boldsymbol{\varepsilon}是陀螺仪的随机噪声。加速度计和陀螺仪的零偏误差和刻度因数误差通常被视为随机游走过程,其变化率方程分别为:\dot{\delta\boldsymbol{b}}_a=\boldsymbol{w}_{b_a},\quad\dot{\delta\boldsymbol{k}}_a=\boldsymbol{w}_{k_a},\quad\dot{\delta\boldsymbol{b}}_g=\boldsymbol{w}_{b_g},\quad\dot{\delta\boldsymbol{k}}_g=\boldsymbol{w}_{k_g}其中,\boldsymbol{w}_{b_a}、\boldsymbol{w}_{k_a}、\boldsymbol{w}_{b_g}、\boldsymbol{w}_{k_g}分别是加速度计零偏误差、加速度计刻度因数误差、陀螺仪零偏误差和陀螺仪刻度因数误差的噪声驱动白噪声。将上述各状态变量的微分方程组合起来,就构成了弹载SINS/GPS/SAR组合导航系统的状态方程。该状态方程全面地描述了系统状态的动态变化过程,为后续利用卡尔曼滤波等算法进行状态估计和数据融合提供了坚实的基础。通过准确建立状态方程,能够有效地对系统的误差进行估计和校正,从而提高组合导航系统的精度和可靠性。3.2量测方程建立量测方程的建立是弹载SINS/GPS/SAR组合导航系统建模的另一关键环节,它构建了系统状态与各导航系统测量值之间的联系,为卡尔曼滤波等数据融合算法提供了必要的观测信息,直接影响着组合导航系统的精度和可靠性。在弹载SINS/GPS/SAR组合导航系统中,量测值主要来源于GPS和SAR。GPS能够提供高精度的位置和速度测量信息,其测量值与系统状态中的位置误差和速度误差紧密相关。假设GPS测量得到的位置为\boldsymbol{r}_{GPS}=[r_{GPS,N},r_{GPS,E},r_{GPS,D}]^T,速度为\boldsymbol{v}_{GPS}=[v_{GPS,N},v_{GPS,E},v_{GPS,D}]^T,而系统状态中的真实位置为\boldsymbol{r}=[r_N,r_E,r_D]^T,真实速度为\boldsymbol{v}=[v_N,v_E,v_D]^T,则GPS的量测方程可以表示为:\begin{bmatrix}\boldsymbol{r}_{GPS}\\\boldsymbol{v}_{GPS}\end{bmatrix}=\begin{bmatrix}\boldsymbol{r}+\delta\boldsymbol{r}+\boldsymbol{\varepsilon}_r\\\boldsymbol{v}+\delta\boldsymbol{v}+\boldsymbol{\varepsilon}_v\end{bmatrix}其中,\delta\boldsymbol{r}和\delta\boldsymbol{v}分别是位置误差和速度误差,\boldsymbol{\varepsilon}_r和\boldsymbol{\varepsilon}_v是GPS测量噪声,它们通常被建模为高斯白噪声,其统计特性可以用协方差矩阵来描述。例如,位置测量噪声协方差矩阵\boldsymbol{R}_r和速度测量噪声协方差矩阵\boldsymbol{R}_v分别表示为:\boldsymbol{R}_r=\begin{bmatrix}\sigma_{r_N}^2&0&0\\0&\sigma_{r_E}^2&0\\0&0&\sigma_{r_D}^2\end{bmatrix}\quad\boldsymbol{R}_v=\begin{bmatrix}\sigma_{v_N}^2&0&0\\0&\sigma_{v_E}^2&0\\0&0&\sigma_{v_D}^2\end{bmatrix}其中,\sigma_{r_N}^2、\sigma_{r_E}^2、\sigma_{r_D}^2分别是北、东、地方向位置测量噪声的方差;\sigma_{v_N}^2、\sigma_{v_E}^2、\sigma_{v_D}^2分别是北、东、地方向速度测量噪声的方差。这些方差值可以根据GPS接收机的性能参数以及实际应用环境进行确定。SAR通过图像匹配技术提供载体的位置和姿态信息,其测量值与系统状态中的位置误差、姿态误差相关。假设SAR图像匹配得到的位置增量为\Delta\boldsymbol{r}_{SAR}=[\Deltar_{SAR,N},\Deltar_{SAR,E},\Deltar_{SAR,D}]^T,姿态增量为\Delta\boldsymbol{\phi}_{SAR}=[\Delta\phi_{SAR,N},\Delta\phi_{SAR,E},\Delta\phi_{SAR,D}]^T,则SAR的量测方程可以表示为:\begin{bmatrix}\Delta\boldsymbol{r}_{SAR}\\\Delta\boldsymbol{\phi}_{SAR}\end{bmatrix}=\begin{bmatrix}\delta\boldsymbol{r}+\boldsymbol{\varepsilon}_{r_{SAR}}\\\delta\boldsymbol{\phi}+\boldsymbol{\varepsilon}_{\phi_{SAR}}\end{bmatrix}其中,\boldsymbol{\varepsilon}_{r_{SAR}}和\boldsymbol{\varepsilon}_{\phi_{SAR}}是SAR测量噪声,同样被建模为高斯白噪声。SAR测量噪声协方差矩阵\boldsymbol{R}_{SAR}可以表示为:\boldsymbol{R}_{SAR}=\begin{bmatrix}\boldsymbol{R}_{r_{SAR}}&\boldsymbol{0}\\\boldsymbol{0}&\boldsymbol{R}_{\phi_{SAR}}\end{bmatrix}其中,\boldsymbol{R}_{r_{SAR}}是位置增量测量噪声协方差矩阵,\boldsymbol{R}_{\phi_{SAR}}是姿态增量测量噪声协方差矩阵,它们的具体形式与SAR图像匹配算法的精度以及实际测量环境有关。综合GPS和SAR的量测方程,组合导航系统的量测方程可以表示为:\boldsymbol{Z}=\begin{bmatrix}\boldsymbol{r}_{GPS}\\\boldsymbol{v}_{GPS}\\\Delta\boldsymbol{r}_{SAR}\\\Delta\boldsymbol{\phi}_{SAR}\end{bmatrix}=\begin{bmatrix}\boldsymbol{r}+\delta\boldsymbol{r}+\boldsymbol{\varepsilon}_r\\\boldsymbol{v}+\delta\boldsymbol{v}+\boldsymbol{\varepsilon}_v\\\delta\boldsymbol{r}+\boldsymbol{\varepsilon}_{r_{SAR}}\\\delta\boldsymbol{\phi}+\boldsymbol{\varepsilon}_{\phi_{SAR}}\end{bmatrix}=\boldsymbol{H}\boldsymbol{X}+\boldsymbol{V}其中,\boldsymbol{Z}是量测向量,\boldsymbol{H}是量测矩阵,它反映了系统状态与量测值之间的线性关系,\boldsymbol{V}是量测噪声向量,由GPS和SAR的测量噪声组成。量测噪声对组合导航系统性能有着显著影响。GPS测量噪声会直接影响位置和速度估计的精度,如果噪声过大,会导致滤波估计结果出现较大偏差,降低导航精度。SAR测量噪声则会影响基于图像匹配的位置和姿态估计,使匹配结果不准确,进而影响整个组合导航系统在复杂环境下的可靠性。因此,准确建模和分析量测噪声,对于提高组合导航系统的性能至关重要。在实际应用中,通常需要通过实验测试和数据分析,准确确定量测噪声的统计特性,并在滤波算法中采取相应的措施,如自适应调整噪声协方差矩阵等,以减小量测噪声对系统性能的影响。3.3模型参数确定准确确定弹载SINS/GPS/SAR组合导航系统模型参数对于保证系统性能和导航精度至关重要,这些参数的取值直接影响着系统状态方程和量测方程的准确性,进而决定了组合导航算法的性能。模型参数主要包括系统噪声方差、量测噪声方差以及状态转移矩阵中的相关系数等,可通过实验数据、理论分析等多种方式获取。实验数据是确定模型参数的重要依据之一。对于SINS部分,通过对加速度计和陀螺仪进行长时间的静态和动态实验测试,可以获取其零偏误差、刻度因数误差以及随机噪声的统计特性。在静态实验中,将加速度计和陀螺仪放置在稳定的平台上,记录其长时间的输出数据,通过数据分析计算出零偏误差的均值和方差。动态实验则模拟载体的各种运动状态,如加速、减速、转弯等,测量加速度计和陀螺仪在不同运动条件下的输出,分析其刻度因数误差和随机噪声的变化规律。例如,利用高精度的转台设备,对陀螺仪进行不同转速下的测试,通过对比理论输出和实际测量值,确定刻度因数误差。对于GPS部分,通过在不同环境下进行实际的定位测试,收集GPS接收机的测量数据,分析其测量噪声的特性。在开阔环境、城市环境、山区环境等不同场景下,分别记录GPS的位置和速度测量值,统计测量值与真实值之间的偏差,从而确定位置测量噪声方差\boldsymbol{R}_r和速度测量噪声方差\boldsymbol{R}_v。在城市环境中,由于多径效应和信号遮挡等因素影响较大,GPS测量噪声会明显增大,通过大量实验数据的统计分析,能够更准确地确定该环境下的噪声方差。SAR的模型参数确定同样依赖实验数据。通过进行多次的SAR图像采集实验,对不同地形、不同分辨率下的SAR图像进行处理和分析,获取图像匹配的误差数据,以此确定SAR测量噪声协方差矩阵\boldsymbol{R}_{SAR}。针对不同类型的地物(如森林、沙漠、城市建筑等),分别进行SAR图像采集和匹配实验,分析图像匹配结果与真实位置和姿态的差异,确定位置增量测量噪声协方差矩阵\boldsymbol{R}_{r_{SAR}}和姿态增量测量噪声协方差矩阵\boldsymbol{R}_{\phi_{SAR}}。理论分析也是确定模型参数的重要手段。根据SINS、GPS和SAR的工作原理和误差模型,通过数学推导和理论计算来确定部分参数。对于SINS的状态转移矩阵中的一些系数,可以根据地球自转角速度、重力加速度等已知的物理常量,结合载体的运动方程和坐标系转换关系,通过理论推导得出。例如,在推导位置误差的状态转移方程时,利用地球自转角速度在地理坐标系下的分量以及载体相对地理坐标系的角速度,根据运动学原理和坐标系旋转关系,精确计算出相关系数。在GPS中,根据信号传播理论和定位原理,对卫星轨道误差、时钟误差等因素进行理论分析,估算其对测量噪声的影响,从而辅助确定测量噪声方差。考虑卫星轨道误差对伪距测量的影响时,根据卫星轨道摄动理论,分析各种摄动力对卫星轨道的影响,通过数学模型计算出卫星轨道误差导致的伪距误差范围,为确定位置测量噪声方差提供理论参考。对于SAR,根据成像原理和几何模型,分析成像过程中的几何畸变、信号传播延迟等因素对图像匹配精度的影响,通过理论计算确定相关参数。在分析SAR图像几何畸变对位置测量误差的影响时,根据SAR成像的斜距投影特性和地球曲率、地形起伏等因素,建立几何模型,通过数学计算得出几何畸变导致的位置测量误差的理论表达式,进而为确定SAR测量噪声协方差矩阵提供理论依据。在实际应用中,通常将实验数据和理论分析相结合,相互验证和补充,以更准确地确定模型参数。通过实验数据验证理论分析的结果,根据理论分析指导实验的设计和数据的采集,从而提高模型参数的准确性和可靠性,为弹载SINS/GPS/SAR组合导航系统的高精度运行提供有力保障。四、弹载SINS/GPS/SAR组合导航算法研究4.1传统卡尔曼滤波算法应用4.1.1算法原理卡尔曼滤波(KalmanFilter,KF)是一种基于线性系统和高斯噪声假设的最优估计方法,由RudolfE.Kalman于1960年提出,在组合导航领域得到了广泛应用。其核心思想是通过系统状态的预测与实际测量值的比较,对状态进行修正和更新,以获得最优的状态估计。卡尔曼滤波算法基于状态空间模型,该模型由状态方程和观测方程组成。假设线性离散系统的状态方程为:\boldsymbol{X}_k=\boldsymbol{A}_k\boldsymbol{X}_{k-1}+\boldsymbol{B}_k\boldsymbol{U}_k+\boldsymbol{W}_k其中,\boldsymbol{X}_k是k时刻的状态向量,\boldsymbol{X}_{k-1}是k-1时刻的状态向量,\boldsymbol{A}_k是k时刻的状态转移矩阵,描述了系统状态从k-1时刻到k时刻的变化关系;\boldsymbol{B}_k是输入控制矩阵,\boldsymbol{U}_k是k时刻的控制输入向量,在弹载组合导航系统中,若不考虑外部控制输入,\boldsymbol{B}_k\boldsymbol{U}_k项可忽略;\boldsymbol{W}_k是k时刻的过程噪声向量,假设其服从均值为\boldsymbol{0},协方差矩阵为\boldsymbol{Q}_k的高斯白噪声,即\boldsymbol{W}_k\simN(\boldsymbol{0},\boldsymbol{Q}_k)。观测方程为:\boldsymbol{Z}_k=\boldsymbol{H}_k\boldsymbol{X}_k+\boldsymbol{V}_k其中,\boldsymbol{Z}_k是k时刻的观测向量,\boldsymbol{H}_k是k时刻的观测矩阵,建立了系统状态与观测值之间的联系;\boldsymbol{V}_k是k时刻的观测噪声向量,同样服从均值为\boldsymbol{0},协方差矩阵为\boldsymbol{R}_k的高斯白噪声,即\boldsymbol{V}_k\simN(\boldsymbol{0},\boldsymbol{R}_k)。卡尔曼滤波算法主要包括预测和更新两个过程。在预测过程中,根据k-1时刻的状态估计值\hat{\boldsymbol{X}}_{k-1|k-1}和状态转移矩阵\boldsymbol{A}_k,预测k时刻的状态:\hat{\boldsymbol{X}}_{k|k-1}=\boldsymbol{A}_k\hat{\boldsymbol{X}}_{k-1|k-1}同时,预测k时刻的误差协方差矩阵:\boldsymbol{P}_{k|k-1}=\boldsymbol{A}_k\boldsymbol{P}_{k-1|k-1}\boldsymbol{A}_k^T+\boldsymbol{Q}_k其中,\hat{\boldsymbol{X}}_{k|k-1}是k时刻基于k-1时刻信息的预测状态估计值,\boldsymbol{P}_{k|k-1}是相应的预测误差协方差矩阵。在更新过程中,当获得k时刻的观测值\boldsymbol{Z}_k后,首先计算卡尔曼增益\boldsymbol{K}_k:\boldsymbol{K}_k=\boldsymbol{P}_{k|k-1}\boldsymbol{H}_k^T(\boldsymbol{H}_k\boldsymbol{P}_{k|k-1}\boldsymbol{H}_k^T+\boldsymbol{R}_k)^{-1}卡尔曼增益\boldsymbol{K}_k反映了预测值与观测值之间的权重关系,它根据预测误差协方差矩阵\boldsymbol{P}_{k|k-1}、观测矩阵\boldsymbol{H}_k和观测噪声协方差矩阵\boldsymbol{R}_k计算得出。然后,利用卡尔曼增益对预测状态进行更新,得到k时刻的最优状态估计值:\hat{\boldsymbol{X}}_{k|k}=\hat{\boldsymbol{X}}_{k|k-1}+\boldsymbol{K}_k(\boldsymbol{Z}_k-\boldsymbol{H}_k\hat{\boldsymbol{X}}_{k|k-1})同时,更新误差协方差矩阵:\boldsymbol{P}_{k|k}=(\boldsymbol{I}-\boldsymbol{K}_k\boldsymbol{H}_k)\boldsymbol{P}_{k|k-1}其中,\hat{\boldsymbol{X}}_{k|k}是k时刻的最优状态估计值,\boldsymbol{P}_{k|k}是相应的最优误差协方差矩阵,\boldsymbol{I}是单位矩阵。通过不断地进行预测和更新过程,卡尔曼滤波能够实时地估计系统状态,并在一定程度上抑制噪声的影响,从而实现对系统状态的最优估计。4.1.2在组合导航中的应用及局限性在弹载SINS/GPS/SAR

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论