1、1组合导航与融合导航组合导航与融合导航21 1、概述、概述 组合导航组合导航同一平台、多传感器实施互补、互验、同一平台、多传感器实施互补、互验、互校的导航系统。互校的导航系统。特点:特点:各传感器独立输出导航信各传感器独立输出导航信息。息。 融合导航融合导航同一平台、多传感器实施信息融合的同一平台、多传感器实施信息融合的导航系统。导航系统。特点:特点:多传感器、统一输出导航信息。多传感器、统一输出导航信息。 组合导航一般强调硬件的最佳组合;组合导航一般强调硬件的最佳组合; 融合导航一般强调多传感器数据融合算法;融合导航一般强调多传感器数据融合算法; 融合导航与组合导航既有联系又有区别,融合导航
2、融合导航与组合导航既有联系又有区别,融合导航首先基于组合导航首先基于组合导航。1.1 1.1 概念概念31 1、概述(续)、概述(续)重磁导航(重力导航、磁力导重磁导航(重力导航、磁力导航)航)现有导航系统现有导航系统全球卫星导航定位系统(全球卫星导航定位系统(GPSGPS、GLONASSGLONASS、GALILEOGALILEO、BDBD) 惯性导航(包括惯性导航惯性导航(包括惯性导航INSINS、航位推算导航航位推算导航DRDR)天文导航系统(天文导航系统(CNSCNS)匹配导航(地形匹配导航、影匹配导航(地形匹配导航、影像匹配导航)像匹配导航)1.2 1.2 分类分类42.1 2.1
3、卫星导航的发展卫星导航的发展2 2、卫星导航的发展即存在的问题、卫星导航的发展即存在的问题 卫星定位系统是一种天基无线电导航系统。卫星定位系统是一种天基无线电导航系统。 它能够在全球范围,为多个用户,全天候、实时、它能够在全球范围,为多个用户,全天候、实时、连续地提供高精度三维位置、速度及时间信息。连续地提供高精度三维位置、速度及时间信息。美国:美国:GPSGPS;俄罗斯:俄罗斯:GLONASSGLONASS;目前己经投入运营或正在建设的几个主要的卫星导目前己经投入运营或正在建设的几个主要的卫星导航系统有:航系统有:欧空局:欧空局:GALILEOGALILEO;中国:中国:COMPASSCOM
4、PASS。5结论:结论:GPSGPS不能保证安全、连续、精确、可靠导航不能保证安全、连续、精确、可靠导航 美国美国20002000年之后每年都将审议一次年之后每年都将审议一次SASA政策;政策; 美国军方声称随时都有可能改变美国军方声称随时都有可能改变GPSGPS政策;政策; GPSGPS的系统信号在高纬度地区经常出现盲区;的系统信号在高纬度地区经常出现盲区; 美国国防部曾强调,限制敌人在战时利用美国国防部曾强调,限制敌人在战时利用GPSGPS。1 1)美国)美国GPSGPS可能存在问题可能存在问题2.2 2.2 卫星导航存在的问题卫星导航存在的问题2 2、卫星导航的发展即存在的问题、卫星导航
5、的发展即存在的问题6 与与GPSGPS相比,相比,GLONASSGLONASS因运行时间短,用户尚少,因运行时间短,用户尚少,目前还不具备象目前还不具备象GPSGPS增强系统和增强系统和IGSIGS网络长期不间网络长期不间断的观测信息支持。断的观测信息支持。 GPSGPS接收机市场十分活跃,产品不断翻新,而接收机市场十分活跃,产品不断翻新,而GLONASSGLONASS目前还未达到这一水平,且目前还未达到这一水平,且GLONASSGLONASS接收接收机供应严重不足。机供应严重不足。 此外,因为没有此外,因为没有GLONASSGLONASS卫星的精确轨道源数据,卫星的精确轨道源数据,故无法测定
6、精度。与故无法测定精度。与GPSGPS相比这是相比这是GLONASSGLONASS的个一的个一主要缺陷主要缺陷。 2 2)GLONASSGLONASS存在的主要问题存在的主要问题2.2 2.2 卫星导航存在的问题(续)卫星导航存在的问题(续)2 2、卫星导航的发展即存在的问题、卫星导航的发展即存在的问题7 “伽利略计划伽利略计划”是由欧盟委员会和欧洲空间局共同发是由欧盟委员会和欧洲空间局共同发起并组织实施的欧洲民用卫星导航计划,它受多个起并组织实施的欧洲民用卫星导航计划,它受多个国家政策和利益的制约,政策具有摇摆性。国家政策和利益的制约,政策具有摇摆性。 由于欧盟受美国的影响极大,由于欧盟受美
7、国的影响极大,“伽利略计划伽利略计划”本身本身的独立性值得怀疑;的独立性值得怀疑; GALILEOGALILEO计划目前已经延后,考虑到目前的金融危机,计划目前已经延后,考虑到目前的金融危机,未来的未来的GALILEOGALILEO如何发展现在还看不清楚。如何发展现在还看不清楚。2.2 2.2 卫星导航存在的问题(续)卫星导航存在的问题(续) 3 3)GALILEOGALILEO存在的主要问题存在的主要问题2 2、卫星导航的发展即存在的问题、卫星导航的发展即存在的问题8 北斗一代系统由三颗地球同步卫星、一个地面控制北斗一代系统由三颗地球同步卫星、一个地面控制中心及各类用户接收机组成。中心及各类
8、用户接收机组成。 “北斗一号北斗一号”覆盖范围小,服务区由东经覆盖范围小,服务区由东经7070度至东度至东经经145145度,北纬度,北纬5 5度到北纬度到北纬5555度,覆盖我国和周边地度,覆盖我国和周边地区。区。 “北斗一号北斗一号”采用双星定位技术,只能为终端用户采用双星定位技术,只能为终端用户提供经度和纬度,无法为用户提供所在高度的数据,提供经度和纬度,无法为用户提供所在高度的数据,因此需要预先存储需定位目标的地面高程信息,并因此需要预先存储需定位目标的地面高程信息,并通过与地面中心站的联系才能推算高度。通过与地面中心站的联系才能推算高度。3 3)北斗卫星定位系统可能存在的问题)北斗卫
9、星定位系统可能存在的问题2.2 2.2 卫星导航存在的问题(续)卫星导航存在的问题(续)2 2、卫星导航的发展即存在的问题、卫星导航的发展即存在的问题9 由于地面高程精度不高,且卫星数量少,无冗余信息,由于地面高程精度不高,且卫星数量少,无冗余信息,定位精度和可靠性不高。定位精度和可靠性不高。 用户必须向地面中心站申请定位,才能获得定位信息,用户必须向地面中心站申请定位,才能获得定位信息,于是用户的隐蔽性成问题。于是用户的隐蔽性成问题。 由于地面中心站是北斗一代的核心,地面中心站一旦由于地面中心站是北斗一代的核心,地面中心站一旦遭攻击,整个卫星系统将陷入瘫痪。遭攻击,整个卫星系统将陷入瘫痪。
10、北斗一号用户受限,用户过多会造成信道拥挤;北斗一号用户受限,用户过多会造成信道拥挤; 信号需双向传送,很难满足高动态定位要求;信号需双向传送,很难满足高动态定位要求;3 3)北斗卫星定位系统可能存在的问题)北斗卫星定位系统可能存在的问题2 2、卫星导航的发展即存在的问题、卫星导航的发展即存在的问题10 接收机生产厂家生产的接收机也必须入网注册,接收机生产厂家生产的接收机也必须入网注册,否则无法定位;否则无法定位; 接收机必须经过特许部门的测试才有市场准入;接收机必须经过特许部门的测试才有市场准入; 接收机市场竞争局面很难打开;接收机市场竞争局面很难打开; 接收机电磁待机时间短,很难用于长时间野
11、外导接收机电磁待机时间短,很难用于长时间野外导航定位与通讯;航定位与通讯; BDBD跟踪站只限在境内,于是轨道精度也受限。跟踪站只限在境内,于是轨道精度也受限。3 3)北斗卫星定位系统可能存在的问题)北斗卫星定位系统可能存在的问题2 2、卫星导航的发展即存在的问题、卫星导航的发展即存在的问题112.3 2.3 北斗二代展望北斗二代展望 “北斗一号北斗一号”卫星的寿命卫星的寿命即将到限,发展新一代即将到限,发展新一代北斗卫星势在必行。北斗卫星势在必行。 二代二代COMPASS,可望,可望实现全球导航定位。实现全球导航定位。 必须解决防欺骗、防干必须解决防欺骗、防干扰、兼容性、互操作、扰、兼容性、
12、互操作、降低发射功率等问题;降低发射功率等问题; 需解决全球跟踪问题。需解决全球跟踪问题。2 2、卫星导航的发展即存在的问题、卫星导航的发展即存在的问题12 与外界不发生任何光、电和磁联系与外界不发生任何光、电和磁联系隐蔽性好隐蔽性好; 工作不受气象条件的限制工作不受气象条件的限制可用性强可用性强; 完全依靠运动载体设备自主完成导航任务完全依靠运动载体设备自主完成导航任务自主自主性好性好; 能够提供比较齐全的导航参数能够提供比较齐全的导航参数参数齐全参数齐全; 目前已广泛应用于潜艇、水面舰艇、军用飞机、战目前已广泛应用于潜艇、水面舰艇、军用飞机、战略导弹和战术导弹、战车和人造卫星等领域略导弹和
13、战术导弹、战车和人造卫星等领域应应用面广用面广。 3.1 3.1 惯性导航的优点惯性导航的优点3 3、惯性导航特点、惯性导航特点13 系统精度主要取决于惯性测量元件,导航参数的系统精度主要取决于惯性测量元件,导航参数的误差误差随时间而积累随时间而积累,不适宜长时间导航。,不适宜长时间导航。 一般惯导系统的加热和一般惯导系统的加热和初始对准所需时间较长初始对准所需时间较长,很难,很难满足远距离、高精度导航和其它特定条件下的快速反满足远距离、高精度导航和其它特定条件下的快速反应要求。应要求。 3.2 3.2 惯性导航的缺点惯性导航的缺点02000400060008000-2.5-2.0-1.5-1
14、.0-0.50.0Second dB02000400060008000024dLDeg020004000600080000400800Second02000400060008000-80-400 m/sVeastVnorth位置误差位置误差速度误差速度误差3 3、惯性导航(续)、惯性导航(续)144 4、天文导航、天文导航 根据天体来测定飞行器位置和航向的导航技术。即以根据天体来测定飞行器位置和航向的导航技术。即以天体为参考点,确定飞行器在空中的真航向。天体为参考点,确定飞行器在空中的真航向。 天体的坐标位置和它的运动规律是已知的,测量天体天体的坐标位置和它的运动规律是已知的,测量天体相对于飞
15、行器参考基准面的高度角和方位角就可以计相对于飞行器参考基准面的高度角和方位角就可以计算出飞行器的位置和航向。算出飞行器的位置和航向。 星体跟踪器望远镜对准天体方向可以测出飞行器前进星体跟踪器望远镜对准天体方向可以测出飞行器前进方向(纵轴)与天体方向(即望远镜轴线方向)之间方向(纵轴)与天体方向(即望远镜轴线方向)之间的夹角(称为航向角)。天体任一瞬间相对于子午线的夹角(称为航向角)。天体任一瞬间相对于子午线的夹角(即天体方位角)已知,天体方位角减去航向的夹角(即天体方位角)已知,天体方位角减去航向角即得飞行器的真航向。角即得飞行器的真航向。4.1 天文导航的基本概念与原理天文导航的基本概念与原
16、理15天文导航系统是自主式系统,不需要地面设备;天文导航系统是自主式系统,不需要地面设备;不受人工或自然形成的电磁场的干扰;不受人工或自然形成的电磁场的干扰;不向外辐射电磁波,隐蔽性好;不向外辐射电磁波,隐蔽性好;定向、定位精度高,定位误差不随时间累积。定向、定位精度高,定位误差不随时间累积。因而天文导航得到广泛应用,并将在未来的深空因而天文导航得到广泛应用,并将在未来的深空探测中发挥更加广泛的作用。探测中发挥更加广泛的作用。 4.2 天文导航的优点天文导航的优点4 4、天文导航(续)、天文导航(续)16 脉冲星是太阳系以外的遥远脉冲星是太阳系以外的遥远天体,它们的位置坐标,如天体,它们的位置
17、坐标,如恒星星表一样构成一种恒星星表一样构成一种高精高精度惯性参考系度惯性参考系; 脉冲星按一定频率发射稳定脉冲星按一定频率发射稳定的脉冲信号,其长期稳定度的脉冲信号,其长期稳定度好于最稳定的铯原子钟。好于最稳定的铯原子钟。 脉冲星可以提供绝好的空间脉冲星可以提供绝好的空间参考基准和时间基准参考基准和时间基准,所以脉,所以脉冲星是空间飞行器的极好的冲星是空间飞行器的极好的天然导航信标天然导航信标。4 4、天文导航(续)、天文导航(续)4.3 脉冲星导航脉冲星导航174.4 脉冲星导航优势脉冲星导航优势 提供良好的时间频率源:提供良好的时间频率源:可用于监测原子钟的长期稳定度。长期观测多颗脉冲可
18、用于监测原子钟的长期稳定度。长期观测多颗脉冲星可以建立综合脉冲星时,并应用于导航系统,实现星可以建立综合脉冲星时,并应用于导航系统,实现系统时间的维持。在航天器运行期间,也可用于系统时间的维持。在航天器运行期间,也可用于修正修正搭载原子钟钟面时,减少地面监测站信息注入次数。搭载原子钟钟面时,减少地面监测站信息注入次数。 扩大导航定位覆盖范围:扩大导航定位覆盖范围:X X射线脉冲星导航可以精确自主地为飞行器提供位置射线脉冲星导航可以精确自主地为飞行器提供位置、姿态和自然时间源。、姿态和自然时间源。可用于空间攻防战,极大增可用于空间攻防战,极大增强我国的太空防御能力。强我国的太空防御能力。4 4、
19、天文导航(续)、天文导航(续)18 有效提高自主导航能力:有效提高自主导航能力:X X射线脉冲星导航在脉冲星参数确定后,在较长时间内射线脉冲星导航在脉冲星参数确定后,在较长时间内,可完全实现自主导航。,可完全实现自主导航。大大减轻地面测控系统的工大大减轻地面测控系统的工作负担,减少测控站的布设数量,降低航天器的运行作负担,减少测控站的布设数量,降低航天器的运行管理和维持费用。管理和维持费用。 作为现有卫星导航系统的备份:作为现有卫星导航系统的备份:当人造卫星导航系统受到人为干扰或破坏,以至不能当人造卫星导航系统受到人为干扰或破坏,以至不能进行导航服务时,单独利用进行导航服务时,单独利用X X射
20、线脉冲星导航,可起射线脉冲星导航,可起到有效的备份作用。到有效的备份作用。4 4、天文导航(续)、天文导航(续)19 提高抗干扰性:提高抗干扰性: X X射线脉冲星作为自然的天体,其运行特性不会受到射线脉冲星作为自然的天体,其运行特性不会受到人为的破坏与干扰;人为的破坏与干扰; X X射线穿透性好,被污染物破坏的风险低;射线穿透性好,被污染物破坏的风险低; X X波段特征显著,可以避免空间各种信号的干扰;波段特征显著,可以避免空间各种信号的干扰; X X射线探测器的稳健性强,不需要任何光学仪器和特射线探测器的稳健性强,不需要任何光学仪器和特别的制冷设备;别的制冷设备; 可以由一个单一的仪器自主
21、完成时间、姿态及位置的可以由一个单一的仪器自主完成时间、姿态及位置的测量。测量。4 4、天文导航(续)、天文导航(续)20 为了提高对动态载体运动目标(导弹、飞机、卫星、为了提高对动态载体运动目标(导弹、飞机、卫星、坦克、车辆、舰船等)的跟踪精度或对动态系统的状坦克、车辆、舰船等)的跟踪精度或对动态系统的状态估计精度,需要多传感器的组合导航。态估计精度,需要多传感器的组合导航。 单一传感器提供的信息很难满足目标跟踪或状态估计单一传感器提供的信息很难满足目标跟踪或状态估计的精度要求,采用多个传感器进行组合导航,并将多的精度要求,采用多个传感器进行组合导航,并将多类信息按某种最优融合准则进行最优融
22、合,可望提高类信息按某种最优融合准则进行最优融合,可望提高目标跟踪或状态估计的精度。目标跟踪或状态估计的精度。 多传感器组合导航(多星座卫星组合、卫星导航与惯多传感器组合导航(多星座卫星组合、卫星导航与惯性导航的组合等)成为导航系统的发展趋势。性导航的组合等)成为导航系统的发展趋势。5 5、组合导航系统、组合导航系统5.1 5.1 背景背景21 GPSGPS、GLONASSGLONASS、BDBD及及GALILEOGALILEO卫星导航系统,本身都卫星导航系统,本身都存在着固有的缺陷或人为施加的干扰,于是,使用存在着固有的缺陷或人为施加的干扰,于是,使用单一的卫星导航系统存在着很大风险。单一的
23、卫星导航系统存在着很大风险。 GPSGPS系统受美国国家政策的影响,随时可能出现人为系统受美国国家政策的影响,随时可能出现人为“故障故障”,使得非美国的盟国不能利用卫星资源,使得非美国的盟国不能利用卫星资源,或其卫星信号中存在显著的异常干扰。或其卫星信号中存在显著的异常干扰。 GLONASSGLONASS系统,虽然尚无明确的信号干扰政策,但它系统,虽然尚无明确的信号干扰政策,但它由俄罗斯空军控制,特殊时期的应用难以保证,而由俄罗斯空军控制,特殊时期的应用难以保证,而且且GLONASSGLONASS卫星的稳定性较差,导航精度也成问题。卫星的稳定性较差,导航精度也成问题。5.2 5.2 多星座卫星
24、导航组合多星座卫星导航组合5 5、组合导航系统(续)、组合导航系统(续) 需求需求22 由于多星座提高了卫星星座的几何结构,增强了由于多星座提高了卫星星座的几何结构,增强了可用可用性(性(availabilityavailability); GPS/GLONASS/COMPASS/GalileoGPS/GLONASS/COMPASS/Galileo全部建成后,卫星覆全部建成后,卫星覆盖率将极大增强(星空璀璨盖率将极大增强(星空璀璨100100颗卫星以上),颗卫星以上),提高导航定位的连续性(提高导航定位的连续性(continuitycontinuity);); 多卫星信号组合可以很容易地探测和
25、诊断某类卫星信多卫星信号组合可以很容易地探测和诊断某类卫星信号的故障和随机干扰,并及时予以排除或及时给用户号的故障和随机干扰,并及时予以排除或及时给用户发送预警信息,提高导航系统的抗干扰能力,从而提发送预警信息,提高导航系统的抗干扰能力,从而提高系统的高系统的完好性完好性(integrityintegrity);); 多卫星系统可提高相位模糊度搜索速度多卫星系统可提高相位模糊度搜索速度。5 5、组合导航系统(续)、组合导航系统(续) 卫星组合导航的性能优势卫星组合导航的性能优势235 5、组合导航系统(续)、组合导航系统(续) 卫星组合导航的误差补偿优势卫星组合导航的误差补偿优势系统误差系统误
26、差轨道系统误差、卫星钟差、多路径误轨道系统误差、卫星钟差、多路径误差差;随机误差随机误差信号随机误差、轨道随机误差、钟差信号随机误差、轨道随机误差、钟差随机误差随机误差;有色噪声有色噪声太阳光压、随时间变化的钟差太阳光压、随时间变化的钟差;异常误差异常误差周跳、变轨误差周跳、变轨误差。利用多种导航卫星信号有利于误差补偿提高导航定位利用多种导航卫星信号有利于误差补偿提高导航定位的的精度和可靠性精度和可靠性。24 卫星组合导航的缺点卫星组合导航的缺点1 1)存在信号遮挡。当接收机天线被建筑、隧道等遮挡存在信号遮挡。当接收机天线被建筑、隧道等遮挡时,卫星信号中断,无法定位。时,卫星信号中断,无法定位
27、。2 2)抗干扰能力差。当存在人为干扰时,接收机码环环抗干扰能力差。当存在人为干扰时,接收机码环环路很容易失锁,导致接收机无法定位。路很容易失锁,导致接收机无法定位。3 3)多类卫星信号在同一载体上常形成互相干扰。多类卫星信号在同一载体上常形成互相干扰。4 4)数据输出频率低。尽管目前一些新的数据输出频率低。尽管目前一些新的GPSGPS接收机可以接收机可以提供提供10 Hz10 Hz的无插值定位输出,但大多数接收机的定的无插值定位输出,但大多数接收机的定位输出频率仍然为位输出频率仍然为1 Hz1 Hz。5 5)GPSGPS、GLONASSGLONASS、GALILEOGALILEO分别由各自研
28、制国直接控制,分别由各自研制国直接控制,使用权受制于人。使用权受制于人。5 5、组合导航系统(续)、组合导航系统(续)25 尽管卫星定位系统具有较高精度和较低的成本,且尽管卫星定位系统具有较高精度和较低的成本,且具有长期稳定性。多类导航卫星组合仍然不能完全具有长期稳定性。多类导航卫星组合仍然不能完全摆脱卫星信号受遮挡而不能实施导航的风险。当载摆脱卫星信号受遮挡而不能实施导航的风险。当载体通过遂道或行驶在高耸的楼群间的街道时,这种体通过遂道或行驶在高耸的楼群间的街道时,这种信号盲区信号盲区一般不能通过多类卫星组合加以克服。一般不能通过多类卫星组合加以克服。 INSINS由于具有全天候、完全自主、
29、不受外界干扰、可由于具有全天候、完全自主、不受外界干扰、可以提供全导航参数(位置、速度、姿态)等优点,以提供全导航参数(位置、速度、姿态)等优点,是目前最主要的导航系统之一。是目前最主要的导航系统之一。INSINS有一个致命的缺有一个致命的缺点:点:导航定位误差随时间积累导航定位误差随时间积累。5.3 5.3 卫星导航与惯性导航的组合卫星导航与惯性导航的组合 需求需求5 5、组合导航系统(续)、组合导航系统(续)26 可发现并标校惯导系统误差,提高可发现并标校惯导系统误差,提高导航精度导航精度。 弥补卫星导航的信号缺损问题,提高弥补卫星导航的信号缺损问题,提高导航能力导航能力。 提高卫星导航载
30、波相位的模糊度搜索速度,提高信提高卫星导航载波相位的模糊度搜索速度,提高信号周跳的检测能力,提高组合号周跳的检测能力,提高组合导航的可靠性导航的可靠性。 可以提高卫星导航接收机对卫星信号的捕获能力,可以提高卫星导航接收机对卫星信号的捕获能力,提高整体提高整体导航效率导航效率。 增加观测冗余度,提高异常误差的监测能力,提高增加观测冗余度,提高异常误差的监测能力,提高系统的系统的容错功能容错功能。 提高导航系统的抗干扰能力,提高提高导航系统的抗干扰能力,提高完好性完好性。6 6、组合导航系统(续)、组合导航系统(续) GNSS GNSS与与INSINS组合导航的优势组合导航的优势27 松组合又称级
31、联松组合又称级联KalmanKalman滤波滤波(Cascaded Kalman (Cascaded Kalman Filter)Filter)方式。方式。 观测量观测量INSINS和和GNSSGNSS输出的速度和位置信息的差值;输出的速度和位置信息的差值; 系统方程系统方程INSINS线性化的误差方程;线性化的误差方程; 通过扩展通过扩展KalmanKalman滤波(滤波(Extended Kalman Filter= Extended Kalman Filter= EKFEKF)对)对INSINS的速度、位置、姿态以及传感器误差进行的速度、位置、姿态以及传感器误差进行最优估计,并根据估计结
32、果对最优估计,并根据估计结果对INSINS进行输出或者反馈进行输出或者反馈校正。校正。6 6、卫星导航与惯性导航组合方式、卫星导航与惯性导航组合方式6.1 6.1 松散组合松散组合(Loosely-Coupled Integration)(Loosely-Coupled Integration) 松组合基本概念松组合基本概念28 GNSSGNSS接收机通常通过自己的接收机通常通过自己的KalmanKalman滤波输出其速度滤波输出其速度和位置,这种组合导致滤波器的串联,使组合导航和位置,这种组合导致滤波器的串联,使组合导航观测噪声时间相关(观测噪声时间相关(有色噪声有色噪声),不满足),不满足
33、EKFEKF观测观测噪声为白噪声的基本要求,严重时可能使滤波器不噪声为白噪声的基本要求,严重时可能使滤波器不稳定。稳定。 几乎无冗余信息,不利于异常诊断,不利于进行随几乎无冗余信息,不利于异常诊断,不利于进行随机模型改化机模型改化 。 松组合的主要缺点松组合的主要缺点系统结构简单,易于实现,可以大幅度提高系统的系统结构简单,易于实现,可以大幅度提高系统的导航精度,并使导航精度,并使INSINS具有动基座对准能力。具有动基座对准能力。 松组合的主要优点松组合的主要优点6 6、卫星导航与惯性导航组合方式(续)、卫星导航与惯性导航组合方式(续)29 观测量观测量根据根据GNSSGNSS接收机收到的星
34、历信息和接收机收到的星历信息和INSINS输出输出的位置和速度信息,计算相应于的位置和速度信息,计算相应于INSINS位置的伪距和伪距位置的伪距和伪距率,率,GNSSGNSS接收机测量得到的伪距和伪距速率与接收机测量得到的伪距和伪距速率与INSINS计算计算值的差值。值的差值。 通过通过EKFEKF对对INSINS的误差和的误差和GPSGPS接收机的误差进行最优估计,接收机的误差进行最优估计,然后对然后对INSINS进行输出或者反馈校正。进行输出或者反馈校正。 由于不存在滤波器的级联,并可对由于不存在滤波器的级联,并可对GNSSGNSS接收机的测距误接收机的测距误差进行建模,因此这种差进行建模
35、,因此这种伪距、伪距率组合伪距、伪距率组合方式比方式比位置、位置、速度组合速度组合具有更高的组合精度。而且在可见星的个数少具有更高的组合精度。而且在可见星的个数少于于4 4颗时也可以使用。颗时也可以使用。6.2 6.2 紧组合(紧组合(Tightly-Coupled IntegrationTightly-Coupled Integration)6 6、卫星导航与惯性导航组合方式(续)、卫星导航与惯性导航组合方式(续)30 深组合是使用惯性导航信息对深组合是使用惯性导航信息对GNSSGNSS接收机进行辅助接收机进行辅助导航的组合方式。导航的组合方式。 主要思想:主要思想:既使用滤波技术对既使用滤
36、波技术对INSINS的误差进行最优的误差进行最优估计,同时使用校正后的估计,同时使用校正后的INSINS速度信息对接收机的速度信息对接收机的载波环、码环进行辅助跟踪,从而减小环路的等效载波环、码环进行辅助跟踪,从而减小环路的等效带宽,增加带宽,增加GPSGPS接收机在高动态或强干扰环境下的接收机在高动态或强干扰环境下的跟踪能力。跟踪能力。 嵌入式组合将嵌入式组合将INSINS和和GNSSGNSS进行一体化设计,通过共进行一体化设计,通过共用电源、时钟等进一步减小体积、降低成本和减小用电源、时钟等进一步减小体积、降低成本和减小非同步误差的影响。非同步误差的影响。6.3 6.3 深组合(深组合(D
37、eeply-Coupled IntegrationDeeply-Coupled Integration)6 6、卫星导航与惯性导航组合方式(续)、卫星导航与惯性导航组合方式(续)31各传感器观测信息分别与动力学模型进行滤波解各传感器观测信息分别与动力学模型进行滤波解算,得到分滤波结果;算,得到分滤波结果;各分滤波器结果与主滤波器进行融合;各分滤波器结果与主滤波器进行融合;采用联邦滤波原理(采用联邦滤波原理(Federated Klamn filterFederated Klamn filter)7 7、融合导航算法进展、融合导航算法进展)XPXPX(PPXrkX2kX1kX1Xkrk2k1kk
38、)XA(LKXXkikikikkik32 联邦滤波算法示意图联邦滤波算法示意图参考系统参考系统局部传感器局部传感器r r局部滤波器局部滤波器r rLr主滤波器主滤波器 时间传递时间传递状态转移状态转移融合融合更新更新L1局部传感器局部传感器1 1局部滤波器局部滤波器1 1局部传感器局部传感器2 2局部滤波器局部滤波器2 2L2,rrXX 11,XX 22,XX 7 7、融合导航算法进展(续)、融合导航算法进展(续)33联联邦邦滤滤波波存存在在的的问问题题)XPXPX(PPXrkX2kX1kX1Xkrk2k1kk)XA(LKXXkikikikkik7 7、融合导航算法进展(续)、融合导航算法进展
39、(续)347 7、融合导航算法进展(续)、融合导航算法进展(续) 联邦滤波算法不是最优算法,且稳定性无法得到保障联邦滤波算法不是最优算法,且稳定性无法得到保障(吴德平等,申功勋,(吴德平等,申功勋,20012001)。)。 联邦滤波要求局部传感器采用联邦滤波要求局部传感器采用KalmanKalman滤波处理,且局滤波处理,且局部系统采用相同的转移矩阵和系统噪声矩阵,实际上部系统采用相同的转移矩阵和系统噪声矩阵,实际上许多导航仪内部处理模块并非采用许多导航仪内部处理模块并非采用KalmanKalman滤波器。滤波器。 联邦滤波在融合处理时往往对联邦滤波在融合处理时往往对局部系统噪声矩阵局部系统噪
40、声矩阵进行进行统一放大,对高精度、高可靠性的传感器造成效率损统一放大,对高精度、高可靠性的传感器造成效率损失,而对低精度传感器的误差又得不到应有控制。失,而对低精度传感器的误差又得不到应有控制。35 各局部传感器的滤波采用了相同的或相近的状态各局部传感器的滤波采用了相同的或相近的状态方程,导致主滤波器与各局部滤波器输出量之间方程,导致主滤波器与各局部滤波器输出量之间以及各局部滤波器输出量之间不独立,其解不具以及各局部滤波器输出量之间不独立,其解不具有严格性和最优性。有严格性和最优性。 如果状态方程出现扰动误差,将影响每个滤波器如果状态方程出现扰动误差,将影响每个滤波器的性能,最终影响整体滤波效
41、果,从而导致导航的性能,最终影响整体滤波效果,从而导致导航解的可靠性差。解的可靠性差。7 7、融合导航算法进展(续)、融合导航算法进展(续)36 忽略相关性?忽略相关性?动力学模型导致的相关性,本动力学模型导致的相关性,本质上是动态载体扰动对所有传感器滤波结果影响质上是动态载体扰动对所有传感器滤波结果影响的相关性,忽略这种相关性,有时会带来灾难性的相关性,忽略这种相关性,有时会带来灾难性的导航结果。的导航结果。 各传感器采用不同的状态方程?各传感器采用不同的状态方程?但同一动态但同一动态载体一般很难建立多个独立的动力学模型。载体一般很难建立多个独立的动力学模型。 相关数据融合滤波?相关数据融合
42、滤波?数据处理相当复杂。数据处理相当复杂。 改变采样间隔改变采样间隔又会产生同步问题。又会产生同步问题。7 7、融合导航算法进展(续)、融合导航算法进展(续)377 7、融合导航算法进展(续)、融合导航算法进展(续)选择一个精度较高的传感器与动力学模型进选择一个精度较高的传感器与动力学模型进行动态滤波解算,得到动态滤波结果;行动态滤波解算,得到动态滤波结果;其他传感器观测信息与动态滤波结果进行融其他传感器观测信息与动态滤波结果进行融合;合;分别采用分别采用KalmanKalman滤波原理和序贯平差原理。滤波原理和序贯平差原理。38动态滤波:动态滤波: ,1X1XP静态滤波:静态滤波: ,2X2
43、XP静态滤波:静态滤波: ,rXrXP传感器传感器2 2: ,1L1P传感器传感器3 3: ,2L2P传感器传感器 : ,rP 状态向量估值状态向量估值rLr动、静滤波算法示意图动、静滤波算法示意图7 7、融合导航算法进展(续)、融合导航算法进展(续)39minVPVVPVr1iikikTikXXTXkkkminVPVVPVjkjkTjkXXTX1)k(j1)k(j1)k(j)LPAX(P)APA(PXikikr1iTikkX1ikikr1iTikXkkk)LPAX(P)APA(PXrkrkTrk1)k(rX1rkrkTrkXrk1)k(r1)k(r7 7、融合导航算法进展(续)、融合导航算法
44、进展(续)407 7、融合导航算法进展(续)、融合导航算法进展(续)417 7、融合导航算法进展(续)、融合导航算法进展(续) 各传感器观测信息分别进行单历元静态平差,获得各传感器观测信息分别进行单历元静态平差,获得几何导航解;几何导航解; 将综合几何导航解与动力学模型信息进行融合;将综合几何导航解与动力学模型信息进行融合; 几何导航解算中可采用抗差估计;几何导航解算中可采用抗差估计; 与动力学模型信息进行融合时,引入自适应因子控与动力学模型信息进行融合时,引入自适应因子控制动力学模型异常的影响;制动力学模型异常的影响; 自适应因子采用几何融合导航结果与动力学模型信自适应因子采用几何融合导航结
45、果与动力学模型信息的较差构造。息的较差构造。42基于各传感器几何导航解的自适应融合导航基于各传感器几何导航解的自适应融合导航7 7、融合导航算法进展(续)、融合导航算法进展(续)43)(21121rkkkkkrkkkkkXPXPXPXPPXXXXXXkkkwXXXPP等价权矩阵为等价权矩阵为ikikikwXXPPrkkkkkkrkkkwwwwXXXXXXPPPPP2121信息矩阵为信息矩阵为7 7、融合导航算法进展(续)、融合导航算法进展(续)自适应调节因子满足自适应调节因子满足121rkkkwwwwkX44 基于多传感器局部几何导航结果的自适应融合解具有基于多传感器局部几何导航结果的自适应融
46、合解具有较严密的理论基础较严密的理论基础; ; 局部导航解之间及局部导航解与主滤波器输出量之间局部导航解之间及局部导航解与主滤波器输出量之间不相关不相关, ,可提高导航解的精度可提高导航解的精度; ; 可同时控制观测异常和状态预报值异常的影响可同时控制观测异常和状态预报值异常的影响, ,具有具有很强的抗差性和容错性很强的抗差性和容错性; ; 解决各传感器输出量的合理信息分享问题。解决各传感器输出量的合理信息分享问题。 缺点缺点:任一传感器信息不足时,该方法不可用。:任一传感器信息不足时,该方法不可用。7 7、融合导航算法进展(续)、融合导航算法进展(续)45采用模拟数据采用模拟数据7 7、融合
47、导航算法进展(续)、融合导航算法进展(续)X轴方向467 7、融合导航算法进展(续)、融合导航算法进展(续)各传感器观测信息单独进行抗差估计,保证局各传感器观测信息单独进行抗差估计,保证局部导航阶段可靠性;部导航阶段可靠性;引入动力学模型信息进行融合时,计算自适应引入动力学模型信息进行融合时,计算自适应因子控制动力学模型异常的影响;因子控制动力学模型异常的影响;自适应因子采用几何融合导航结果与动力学模自适应因子采用几何融合导航结果与动力学模型信息的较差构造。型信息的较差构造。47基于观测信息抗差估计和状态预测信息的自适应融合导航基于观测信息抗差估计和状态预测信息的自适应融合导航状态方程观测信息
48、:状态方程观测信息: ,XPX抗差解抗差解 抗差解抗差解 抗差解抗差解1L1P传感器传感器r r:观测信息:观测信息 ,2L2P传感器传感器r r:观测信息:观测信息 ,rLrP传感器传感器r r:观测信息:观测信息 ,1X1P ,X22XP ,XrrXP ,X融合导航解融合导航解自适应估计自适应估计XXPX7 7、融合导航算法进展(续)、融合导航算法进展(续)48)()(0100kkkkkkkkkXPXPPPXXXXX201)(0kkkkkXXXPP)(2110210rkkkkrkkkkXPXPXPPXXXXXriikk10XXPP7 7、融合导航算法进展(续)、融合导航算法进展(续)49
49、对各局部传感器观测信息实施抗差估计对各局部传感器观测信息实施抗差估计提高容错提高容错能力;能力; 各局部融合导航解之间不相关各局部融合导航解之间不相关提高导精度提高导精度; ; 基于抗差估计提供较可靠的状态初值,再对状态方程基于抗差估计提供较可靠的状态初值,再对状态方程信息引入自适应因子信息引入自适应因子控制动力模型误差影响;控制动力模型误差影响; 可同时控制观测异常值和状态预报值异常影响可同时控制观测异常值和状态预报值异常影响具具有很强的抗差性和容错性。有很强的抗差性和容错性。 基于抗差解的融合算法计算简单、易于实现。基于抗差解的融合算法计算简单、易于实现。7 7、融合导航算法进展(续)、融
50、合导航算法进展(续)50采用模拟数据采用模拟数据7 7、融合导航算法进展(续)、融合导航算法进展(续)X X轴方向轴方向517 7、融合导航算法进展(续)、融合导航算法进展(续)各传感器观测信息的标称精度不一定可靠;各传感器观测信息的标称精度不一定可靠;观测信息与动力学模型之间的精度可能不可靠;观测信息与动力学模型之间的精度可能不可靠;动力学模型信息的不可靠可反映在方差分量中;动力学模型信息的不可靠可反映在方差分量中;应用方差分量估计可以调节各传感器观测信息的应用方差分量估计可以调节各传感器观测信息的权比;权比;方差分量比可用来构造自适因子控制动力学模型方差分量比可用来构造自适因子控制动力学模