通用组合导航系统与方法与流程

本发明涉及导航领域，具体涉及一种通用组合导航系统、通用组合导航方法。

背景技术：

现代常用的导航技术主要包括惯性导航、卫星导航、天文导航、无线电导航等。其中只有惯性导航是完全自主的，既不向外界辐射信号，也不用接收外部信号。

惯性导航(inertialnavigationsystem，ins)仅依靠陀螺仪和加速度计敏感载体在惯性系下的运动，实现全球、全天候地提供全面导航信息，是一种独立自主导航技术。它具备连续输出载体位置速度和姿态信息、短时导航精度高、完全独立自主等突出优点。惯性导航系统己经逐步推广到航天、航空、航海、石油开发、大地测量、海洋调查、地质钻控、机器人技术和铁路等领域，随着新型惯性敏感器件的出现，惯性技术在汽车工业、医疗电子设备中都得到了应用。惯性导航系统不仅在国防现代化中占有十分重要的地位，在国民经济各个领域中也日益显示出它的巨大作用。

但是，受自身惯性器件误差漂移的影响，惯性导航系统有着无法克服的缺点，导航误差随时间累积。实际的导航系统常以惯性导航系统为主导航系统，辅以其他如天文导航、卫星导航、无线电导航、地形匹配辅助/视觉导航等导航手段，通过组合导航技术进行优势互补，提高导航系统整体性能。组合导航是近代导航理论和技术发展的结果。通过将不同的导航方式组合在一起可以获得比单独使用任一系统时更高的导航性能，也因此组合导航系统得到了越来越广泛的研究和应用。

在不同的行业应用中，现有的组合导航系统通常以惯性导航系统为核心，结合不同的传感器和组合导航模型实现组合导航。常见载体的组合导航系统采用的组合方式如下：机载组合导航采用惯性导航(ins)、卫星导航(gnss)和高度计等组合；车载组合导航采用惯性导航(ins)、卫星导航(gnss)和里程计(odo)等组合；船载组合导航采用惯性导航(ins)、卫星导航(gnss)和测速仪(dvl)等组合；水下组合导航采用惯性导航(ins)、测速仪(dvl)、深度计和基线系统(bl)等组合。

在不同类型的行业应用中，由于传感器和组合导航模型不一样，现有技术方案通常采用不同的组合导航系统，需要采用不同的系统、模型、硬件和软件，明显提高系统成本和应用难度。

此外，在很多行业应用(智能驾驶、轨道检测和管线测量)中惯性导航和组合导航输出的导航数据只是中间结果，通常需要结合其它的硬件和技术才能得到最终的结果和功能。

因此，亟需开发一种通用组合导航系统，能够满足不同的组合导航方式直接应用在同一个组合导航系统中，并且能够通过导航数据和传感器数据直接解算并输出最终的行业测量结果。

技术实现要素：

为了实现多种不同的组合导航方式能够运用在同一个组合导航模型上，以及组合导航模型能够针对不同的组合导航方式计算出导航数据，本发明提供一种通用组合导航系统与方法。

根据本发明的第一方面，提供一种通用组合导航系统，包括：组合导航模块和通用接口电路；其中，

所述组合导航模块至少用于利用陀螺和加速度计的测量数据完成惯性导航解算，并结合其他传感器的测量数据完成组合导航解算；

所述组合导航模块包括硬件层和软件层，所述硬件层与多个通用接口电路连接并支撑软件层的运算，所述软件层包括导航解算模块、系统误差校正模块、最优估计模块和结果输出模块；

导航解算模块用于利用陀螺和加速度计的测量数据完成惯性导航的姿态解算、速度解算和位置解算；

最优估计模块利用导航解算模块输出结果和传感器的测量数据对系统误差进行最优估计，用于实现姿态组合导航、速度组合导航和位置组合导航功能；

系统误差校正模块至少用于根据所述最优估计模块的输出结果对系统误差进行校正；

结果输出模块用于输出测量结果数据；

所述通用接口电路至少用于连接不同接口类型的传感器和其他系统外部设备。

根据本发明的一示例实施方式，所述组合导航模块的软件层还包括行业测量解算模块，所述行业测量解算模块与所述导航解算模块、所述最优估计模块和所述结果输出模块连接，用于完成在机载、车载、船载或水下的具体行业应用中的测量模型解算和误差补偿。

根据本发明的一示例实施方式，所述组合导航模块的软件层还包括误差补偿模块、故障检测模块、重力异常解算模块、动力学解算模块和运动约束解算模块中的一个或多个模块；其中，

误差补偿模块用于对接入的传感器数据进行误差补偿；

故障检测模块用于对误差补偿模块输出的数据进行故障检测；

重力异常解算模块用于计算重力异常数据，补偿实际重力与导航解算模块采用的重力模型之间的误差；

动力学解算模块用于动力学运动模型解算和误差补偿；

运动约束解算模块用于具体行业应用中的运动约束模型解算和误差补偿。

根据本发明的一示例实施方式，系统误差校正模块还用于校正重力异常误差。

根据本发明的一示例实施方式，所述组合导航模块还包括数据存储模块，所述数据存储模块用于实时保存各种原始数据和结果数据，包括惯性导航数据(陀螺和加速度计数据及惯性导航解算的结果数据)、其他传感器和惯性导航数据组合的导航数据、系统状态数据、外部传感器数据、伺服控制数据和智能驾驶数据。

根据本发明的一示例实施方式，所述组合导航模块的硬件层包括soc芯片、fpga、dram和固态硬盘；

所述soc芯片为软件层提供运算和控制的支撑；

所述fpga连接soc芯片和通用接口电路，至少用于采集陀螺、加速度计和传感器的信号并传输给soc芯片；

所述dram与所述soc芯片连接，用于存储数据；

所述固态硬盘与所述soc芯片连接，用于存储数据。

根据本发明的一示例实施方式，每个通用接口电路包括四个硬件接口，分别是同步接口、模拟接口、数字接口和通信接口；

同步接口用于同步输入信号和输出信号；

模拟接口用于连接传感器和其他系统外部设备的模拟接口；

数字接口用于连接传感器和其他系统外部设备的数字接口；

通信接口用于连接传感器和其他系统外部设备的通信接口，包括网络接口、串口、can接口、usb接口、光纤接口和无线接口。

根据本发明的一示例实施方式，每个通信接口电路包括四层结构，依次为接口链路层、接口设备层、设备驱动层和设备应用层；

接口链路层用于提供传感器和其他系统外部设备与四个接口的电气连接和电平标准转换硬件；

接口设备层用于提供同步接口、模拟接口、数字接口和通信接口的功能实现硬件，包括fpga电路、adc电路、dac电路、运放电路和soc通信接口电路；

设备驱动层用于提供通用接口驱动程序；

设备应用层用于完成接口设备初始化、状态监测、数据通信和设备控制功能。

根据本发明的一示例实施方式，所述通用组合导航系统还包括外部温度传感器，所述外部温度传感器与所述通用接口电路连接。

根据本发明的一示例实施方式，所述通用组合导航系统还包括惯性器件电路，所述惯性器件电路与组合导航模块的硬件层的fpga连接，用于连接不同接口类型的陀螺、加速度计和温度传感器；

所述惯性器件电路包括adc、运放电路、i/f转换电路、激光陀螺接口电路、光纤陀螺接口电路和mems数字接口电路；

所述运放电路用于采集模拟电压信号，包括输出为模拟电压的温度传感器、mems陀螺和mems加速度计的模拟电压信号；

所述adc将模拟电压信号转换成数字信号并发送给fpga；

所述i/f转换电路用于接收模拟电流信号转换成数字信号并发送给fpga，所述模拟电流信号包括石英加速度计的模拟电流信号；

所述激光陀螺接口电路用于连接和处理激光陀螺的输出信号并发送给fpga；

所述光纤陀螺接口电路用于连接和处理光纤陀螺的输出信号并发送给fpga；

所述mems数字接口电路用于将具有数字接口的mems陀螺和mems加速度计的信号采集给fpga。

根据本发明的一示例实施方式，所述通用组合导航系统还包括内部温度传感器，所述内部温度传感器与所述惯性器件电路连接，用于测量通用组合导航系统的陀螺、加速度计和电路的温度。

根据本发明的一示例实施方式，所述通用组合导航系统还包括陀螺和加速度计，所述陀螺包括激光陀螺、光纤陀螺或mems陀螺；所述加速度计包括石英加速度计或mems加速度计。

根据本发明的一示例实施方式，所述其他传感器包括卫星导航接收机、里程计、测速仪、高度计、深度计、外部温度传感器、行业测量传感器、星敏感器，所述其他系统外部设备包括智能驾驶系统、伺服控制系统和上位机。

根据本发明的一示例实施方式，所述通用组合导航系统还包括电源电路，电源电路用于将外部输入电源转换为系统内部需要的各种电源。

根据本发明的第二方面，提供一种通用组合导航方法，包括以下步骤：

s101：采集陀螺、加速度计、传感器的测量数据；

s102：利用陀螺和加速度计的测量数据进行惯性导航解算；

s103：将经过惯性导航解算的惯性导航数据和传感器的测量数据对系统误差进行最优估计；

s104：根据最优估计结果对组合导航系统误差进行修正；

s105：输出测量结果。

根据本发明的一示例实施方式，步骤s101中，传感器数据包括温度数据、卫星导航数据、里程计数据、高度计数据、测速仪数据、深度计数据和智能驾驶数据。

根据本发明的一示例实施方式，步骤s101中，获取陀螺、加速度计、传感器数据之后，对数据进行误差补偿和故障检测。

根据本发明的一示例实施方式，步骤s101中，还包括对智能驾驶数据进行故障检测后，再进行动力学解算，所述动力学解算的方法包括：利用智能驾驶系统提供的油门、刹车、制动、方向盘、方向舵、轮速、空速等数据和运动模型进行运动参数解算和误差补偿。

根据本发明的一示例实施方式，步骤s102中，所述惯性导航解算的方法包括：

结合重力异常数据对系统误差进行校正；

结合陀螺数据和加速度计数据以及系统误差校正后的数据，完成惯性导航的姿态解算、速度解算和位置解算，解算过程中采用圆锥误差补偿、划桨误差补偿和涡卷误差补偿方法提高导航解算精度。

根据本发明的一示例实施方式，步骤s103中，所述最优估计的方法包括利用卡尔曼滤波、扩展卡尔曼滤波、无迹卡尔曼滤波或最小二乘方法对系统误差进行最优估计。

根据本发明的一示例实施方式，步骤s103中，进行最优估计时，通过单个或多个具有姿态测量功能的传感器或设备测量的姿态数据进行组合导航计算和最优估计，从而实现姿态组合导航功能；通过单个或多个具有速度测量功能的传感器或设备测量的数据进行最优估计，从而实现速度组合导航功能；通过单个或多个具有位置测量功能的传感器或设备测量的位置数据进行最优估计，从而实现位置组合导航功能。

根据本发明的一示例实施方式，具有姿态测量功能的传感器或设备包括卫星导航接收机、星敏感器、摄像测量相机、激光雷达、智能驾驶系统、全站仪或其他惯性导航系统。具有速度测量功能的传感器或设备包括里程计、测速仪、高度计、深度计、卫星导航接收机、星敏感器、摄像测量相机、激光雷达、智能驾驶系统或其它导航系统。具有位置测量功能的传感器或设备包括里程计、测速仪、高度计、深度计、卫星导航接收机、星敏感器、摄像测量相机、激光雷达、智能驾驶系统或其它惯导系统。

根据本发明的一示例实施方式，步骤s103中，还包括对运动约束解算后的数据进行最优估计。

根据本发明的一示例实施方式，步骤s103中，还包括进行最优估计后，将行业测量传感器数据和最优估计的结果进行行业测量解算。

本发明的有益效果是：

本发明提供了一种通用组合导航系统，与现有的组合导航系统相比，能够灵活地运用于机载、车载、船载和水下组合导航，具体优点通过以下五点进行阐述：

1)本发明采用了一种新型通用化的组合导航系统和传感器接入方法，具有灵活接入不同传感器和组合导航能力，可以方便应用于机载、车载、船载和水下组合导航，能够直接接入绝大部分相关行业的传感器。

2)本发明的通用组合导航系统增加了行业测量传感器接入功能和行业测量模型解算、误差补偿功能，可以直接输出行业应用所需的测量结果数据，明显提高了系统的集成度、可靠性和易用性。

3)本发明的通用组合导航系统中增加了重力异常解算、动力学解算、运动约束解算和相关的误差补偿功能，能有效提高系统的测量精度和可靠性。

4)本发明的通用组合导航系统采用了统一结构的故障检测模块和方法，对外部和内部的传感器数据进行异常和故障检测，能有效提高系统的可靠性。

5)本发明的通用接口电路具有高精度硬件同步、高精度模拟输入和输出、定制化数字输入和输出和多种标准通信(网络、串口、can、usb等)功能，能够满足绝大部分(机载、车载、船载和水下等)组合导航系统的外部传感器和设备连接需要；通用接口电路将接口电路相关硬件和软件分为四层，采用硬件和软件深度优化方法，能明显提高接口电路的通用性、可靠性和方便性；同时，通用接口电路具有软件可配置功能，能通过修改设备驱动层的配置参数改变接口功能、连接不同的外部传感器和设备。

6)本发明采用惯性器件电路，能够接收不同类型的陀螺和加速度计的信号，提升系统的通用性。

7)采用最优估计模块，可以实现姿态组合导航功能、速度组合导航功能和位置组合导航功能。

附图说明

图1是通用组合导航系统的结构关系图；

图2是组合导航模块内部的模块关系图；

图3是组合导航模块内部和外部的硬件连接关系图；

图4是惯性器件电路的硬件连接关系图；

图5是通用接口电路的接口模块图；

图6是通用接口电路的层级关系图。

具体实施方式

现在将参考附图更全面地描述示例实施方式。然而，示例实施方式能够以多种形式实施，且不应被理解为限于在此阐述的范例；相反，提供这些实施方式使得本发明的描述将更加全面和完整，并将示例实施方式的构思全面地传达给本领域的技术人员。附图仅为本发明的示意性图解，并非一定是按比例绘制。

此外，所描述的特征、结构或特性可以以任何合适的方式结合在一个或更多实施方式中。在下面的描述中，提供许多具体细节从而给出对本发明的实施方式的充分理解。然而，本领域技术人员将意识到，可以实践本发明的技术方案而省略所述特定细节中的一个或更多，或者可以采用其它的方法、组元、步骤等。在其它情况下，不详细示出或描述公知结构、方法、实现或者操作以避免喧宾夺主而使得本发明的各方面变得模糊。

根据本发明的第一种实施方式，本发明提供一种通用组合导航系统，如图1所示，包括：陀螺、加速度计、组合导航模块、惯性器件电路、多个通用接口电路、内部温度传感器、外部温度传感器和电源电路。

陀螺包括激光陀螺、光纤陀螺或mems陀螺。加速度计包括石英加速度计或mems加速度计。

组合导航模块至少用于利用陀螺和加速度计的测量数据完成惯性导航解算，并结合传感器的测量数据完成组合导航解算，组合导航模块可以采用导航计算机，也可以采用其他设备。

组合导航模块包括硬件层和软件层，硬件层与多个通用接口电路和惯性器件电路连接并支撑软件层的运算。

如图2所示，软件层包括多个误差补偿模块、多个故障检测模块、导航解算模块、重力异常解算模块、系统误差校正模块、动力学解算模块、运动约束解算模块、最优估计模块、行业测量解算模块、结果输出模块和数据存储模块。

误差补偿模块用于对接入的传感器数据进行误差补偿，接入的传感器数据包括：行业测量传感器数据、陀螺数据、加速度计数据、温度数据、卫星导航数据、里程计数据、测速仪数据、高度计数据、深度计数据、其他传感器数据和智能驾驶数据。

故障检测模块用于对误差补偿模块输出的数据进行故障检测，能够避免异常和故障数据的干扰，明显提高系统可靠性和测量精度。

导航解算模块用于根据陀螺数据、加速度计数据和系统误差校正模块输出的数据完成惯性导航的姿态解算、速度解算和位置解算，并传输给最优估计模块。

重力异常解算模块用于计算重力异常数据，补偿实际重力与导航解算模块采用的重力模型之间的误差。

系统误差校正模块用于根据最优估计模块输出的数据和重力异常数据校正系统误差和重力异常误差，并输出给导航解算模块。

动力学解算模块基于车载、船载等特定行业应用的运动约束特性进行运动参数解算和误差补偿。

运动约束解算模块用于将智能驾驶数据在具体行业应用中的运动约束模型解算和误差补偿。

最优估计模块用于对系统误差进行最优估计。

行业测量解算模块用于结合行业测量传感器数据和最优估计模块的数据完成在具体行业应用中的测量模型解算和误差补偿。

结果输出模块用于输出测量结果数据，包括惯性导航数据(陀螺和加速度计数据及惯性导航解算的结果数据)、其他传感器和惯性导航数据组合的导航数据、系统状态数据、外部传感器数据、伺服控制数据和智能驾驶数据。

数据存储模块用于实时保存各种原始数据和结果数据，包括惯性导航数据(陀螺和加速度计数据及惯性导航解算的结果数据)、其他传感器和惯性导航数据组合的导航数据、系统状态数据、外部传感器数据、伺服控制数据和智能驾驶数据。

如图3所示，硬件层包括soc芯片、fpga、dram和固态硬盘。soc芯片为软件层提供运算和控制的支撑，soc芯片采用x86、arm、power或mips等系列高性能低功耗单核或多核soc芯片。fpga连接soc芯片和通用接口电路，至少用于采集陀螺、加速度计和传感器的信号并传输给soc芯片，采用pcie、sata、pata、emmc或soc局部总线接口与soc进行高速数据交换，还用于控制外部设备。dram与soc芯片连接，用于大容量高速数据动态存储，采用sdram、ddrsdram、ddr2sdram、ddr3sdram、ddr4sdram或ddr5sdram等类型dram芯片。固态硬盘与soc芯片连接，用于大容量传感器数据、状态数据和结果数据的静态存储，采用emmc、pata、sata、pcie或soc局部总线接口的大容量flash芯片。

惯性器件电路至少用于采集不同接口类型的陀螺数据、加速度计数据和内部温度传感器的数据并发送给组合导航模块的fpga。如图4所示，惯性器件电路与组合导航模块的硬件层的fpga连接，包括adc、运放电路、i/f转换电路、激光陀螺接口电路、光纤陀螺接口电路和mems数字接口电路。

运放电路用于采集模拟电压信号，包括输出为模拟电压的内部温度传感器、mems陀螺和mems加速度计的模拟电压信号。

adc将模拟电压信号转换成数字信号并发送给fpga。

i/f转换电路用于接收模拟电流信号转换成数字信号并发送给fpga，所述模拟电流信号包括石英加速度计的模拟电流信号。

激光陀螺接口电路用于连接和处理激光陀螺的输出信号并发送给fpga。

光纤陀螺接口电路用于连接和处理光纤陀螺的输出信号并发送给fpga。

mems数字接口电路用于将具有数字接口的mems陀螺和mems加速度计的信号采集给fpga。

内部温度传感器与惯性器件电路连接，用于测量陀螺、加速度计、电路的温度，进行温度补偿，提高系统测量精度。

每个通用接口电路包括同步接口、模拟接口、数字接口和通信接口(如图5所示)，多个通用接口电路至少用于连接不同接口类型的传感器以及其他系统外部设备。

通用接口电路能够与不同接口类型的系统内部温度传感器、外部传感器和其他系统设备连接，主要是因为通用接口电路包含了不同接口类型的传感器和设备的接入端，如图5所示，分别是同步接口、模拟接口、数字接口和通信接口。

同步接口用于同步输入信号和输出信号，同步接口即可输入外部的始终信号或同步信号(包括卫星导航接收机的pps和外部设备触发输入)，也可以输出系统内部的时钟信号和同步信号(包括触发信号和复位信号)，同步接口通过采用硬件同步方法进行高精度同步，同步精度可达到纳秒级。

模拟接口具有高精度的模拟信号输入和输出功能，能方便连接系统的各种模拟接口传感器和设备，用于连接内部温度传感器、外部温度传感器、外部传感器以及其他系统外部设备的模拟接口。

数字接口具有可编程数字信号输入和输出功能，能方便连接系统外部的各种特定数字信号接口传感器和设备(包括编码器、计数器、pwm控制器、spi接口设备、dymos接口设备等)，可以通过修改fpga程序方式方便连接不同数字接口传感器，用于连接外部传感器以及其他系统外部设备的数字接口。

通信接口用于连接外部传感器以及其他系统外部设备的通信接口，包括网络接口、串口、can接口、usb接口、光纤接口和无线接口；网络接口用于连接具有网络接口(包括10mbps、100mbps、1000mbps等不同传输速率的网络接口)的各种传感器和设备；串口用于连接具有串口(包括rs232、rs422和rs485等串口)的各种传感器和设备；can接口用于连接具有can接口的各种传感器和设备；usb接口用于连接具有usb接口的各种传感器和设备。

通过不同的接口，通用接口电路能方便地接入机载、车载、船载和水下组合导航系统中常见的外部传感器(包括卫星导航接收机、高度计、里程计、测速仪、深度计、外部温度传感器、行业测量传感器和其他传感器等)和其他设备(包括基线系统、上位机、智能驾驶系统、伺服控制系统等)。

如图6所示，通用接口电路包括四层结构，依次为接口链路层、接口设备层、设备驱动层和设备应用层。

接口链路层与组合导航的传感器或其他系统外部设备连接，用于提供外部设备与四个接口的电气连接和电平标准转换硬件。

接口设备层包括同步接口、模拟接口、数字接口和通信接口相关能功能实现硬件，即fpga电路、adc电路、dac电路、运放电路和soc通信接口电路，用于将信号电路转换后传输给设备驱动层。

设备驱动层用于提供通用接口驱动程序，包括各种设备的通用接口驱动程序，通过修改设备配置参数可方便改变接口功能、连接不同的组合导航的传感器和设备。

设备应用层包括各种接口设备的应用程序，用于完成接口设备初始化、状态监测、数据通信和设备控制功能。

接口链路层和接口设备层为接口相关硬件，接口链路层和接口设备层针对不同的接口设置不同的链路和接口设备，接口链路层包括同步接口链路、模拟接口链路、数字接口链路和通信接口链路，接口设备层包括同步接口设备、模拟接口设备、数字接口设备和通信接口设备。设备驱动层和设备应用层为接口相关软件。通用接口电路根据组合导航系统需求，对接口电路相关的硬件和软件进行了功能、逻辑和标准化方面的分层方法，通过硬件和软件的深度优化，能明显提高接口电路的通用性、可靠性和方便性。

电源电路用于将外部输入电源转换为系统内部需要的各种电源。

因为机载、车载、船载和水下组合导航系统中都会应用到惯性导航系统，但是每个惯性导航系统所需要的陀螺和加速度计的接口不同，与惯性导航系统组合使用的传感器的接口也不同，采用惯性器件电路可以连接不同接口类型的陀螺和加速度计，采用通用接口电路可以连接不同接口类型的传感器和其他系统设备(包括输入数据的设备和输出数据的设备)。通用组合导航系统根据陀螺和加速度计的数据进行导航解算，再结合传感器的数据测算出最终结果，然后通过通用接口电路将结果进行输出，能够直接适用于机载、车载、船载和水下不同的行业。

采用通用组合导航系统进行组合导航，方法包括如下步骤：

s101：采集陀螺、加速度计、传感器的测量数据，并对这些数据进行误差补偿和故障检测。如果传感器数据中包括了智能驾驶数据，还要对智能驾驶数据进行动力学解算。动力学解算的方法包括：利用智能驾驶系统提供的油门、刹车、制动、方向盘、方向舵、轮速、空速等数据和运动模型进行运动参数解算和误差补偿。

s102：结合重力异常数据对系统误差进行校正；结合陀螺数据和加速度计数据以及系统误差校正后的数据，完成惯性导航的姿态解算、速度解算和位置解算，解算过程中采用圆锥误差补偿、划桨误差补偿和涡卷误差补偿方法提高导航解算精度。

s103：将经过惯性导航解算的惯性导航数据和传感器数据利用卡尔曼滤波、扩展卡尔曼滤波、无迹卡尔曼滤波或最小二乘方法等最优估计方法对系统误差进行最优估计。

进行最优估计时，通过单个或多个具有姿态测量功能的传感器或设备测量的姿态数据进行组合导航计算和最优估计，从而实现姿态组合导航功能；通过单个或多个具有速度测量功能的传感器或设备测量的数据进行最优估计，从而实现速度组合导航功能；通过单个或多个具有位置测量功能的传感器或设备测量的位置数据进行最优估计，从而实现位置组合导航功能。具有姿态测量功能的传感器或设备包括卫星导航接收机、星敏感器、摄像测量相机、激光雷达、智能驾驶系统、全站仪或其他惯性导航系统。具有速度测量功能的传感器或设备包括里程计、测速仪、高度计、深度计、卫星导航接收机、星敏感器、摄像测量相机、激光雷达、智能驾驶系统或其它导航系统。具有位置测量功能的传感器或设备包括里程计、测速仪、高度计、深度计、卫星导航接收机、星敏感器、摄像测量相机、激光雷达、智能驾驶系统或其它惯导系统。

进行最优估计后，将行业测量传感器数据和最优估计的结果进行行业测量解算。

s104：根据最优估计结果对组合导航系统误差进行校正。

s105：输出测量结果。

通用组合导航系统通过通用接口电路接收不同的传感器数据，通过组合导航模块对传感器数据进行导航解算，输出惯性导航数据、惯性导航与传感器组合的导航数据、系统状态数据、各种传感器数据、伺服控制数据和智能驾驶数据，能够满足大部分传感器和外部设备的连接需要和各类组合导航系统的使用需求，同时测量精度高，计算可靠牢固，易于使用。

以上公开的本发明优选实施例只是用于帮助阐述本发明。优选实施例并没有详尽叙述所有的细节，也不限制该发明仅为所述的具体实施方式。显然，根据本说明书的内容，可作很多的修改和变化。本说明书选取并具体描述这些实施例，是为了更好地解释本发明的原理和实际应用，从而使所属技术领域技术人员能很好地理解和利用本发明。本发明仅受权利要求书及其全部范围和等效物的限制。