CN101261129B - 一种基于dsp和fpga的组合导航计算机 - Google Patents
一种基于dsp和fpga的组合导航计算机 Download PDFInfo
- Publication number
- CN101261129B CN101261129B CN2008101008289A CN200810100828A CN101261129B CN 101261129 B CN101261129 B CN 101261129B CN 2008101008289 A CN2008101008289 A CN 2008101008289A CN 200810100828 A CN200810100828 A CN 200810100828A CN 101261129 B CN101261129 B CN 101261129B
- Authority
- CN
- China
- Prior art keywords
- data
- imu
- gps
- module
- dsp
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
一种基于DSP和FPGA的组合导航计算机,由数据输入模块、数据采集模块、导航解算模块和数据输出模块组成,用于GPS和惯性导航***的组合导航。数据输入模块实现输入信号的电平转换,数据采集模块利用FPGA实现IMU脉冲信号与GPS信号的同步采集,导航解算模块通过高速浮点型DSP的外部存储器接口并行读取数据采集模块采集的数据,完成惯性/GPS的实时组合导航,导航结果通过数据输出模块输出,并且输出信息具有多重冗余的特点。该导航计算机集成度高,体积小,重量轻,功耗低,实时性好,可扩展性强,***升级方便,可广泛应用于航空飞行器、舰船、地面车辆等运动载体的导航。
Description
技术领域
本发明涉及一种基于数字信号处理器(Digital Signal Processing,DSP)和现场可编程门阵列(Field-Programmable Gate Array,FPGA)的组合导航计算机,属于组合导航技术领域,用于以脉冲方式输出的惯性测量单元组成的惯性导航***(Inertial Navigation System,INS)与全球定位***(Global Position System,GPS)的组合导航***,特别适用于对体积功耗和实时性要求较高的应用场合。
背景技术
在导航技术领域,组合导航技术利用有效的数据融合方法,将各种具有优势互补功能的导航子***组合起来,充分发挥各子***的优点,从而提高导航***的整体性能,是导航技术领域一个重要的发展方向。
组合导航计算机首先完成组合导航***各子***的数据采集和子***间的时间同步,进而完成组合导航算法的实时运行,得到载体高精度的导航信息,最终将导航信息输出。
传统的组合导航计算机主要是基于X86架构的专用计算机,体积功耗大,电路结构复杂。目前基于嵌入式技术的组合导航计算机通常采用主从结构的设计方案,主机一般采用一片微处理器或一片数字信号处理器,主要负责导航计算,并承担GPS数据采集和导航信息输出。从机采用一片微处理器,负责惯性测量单元(Inertial Measurement Unit,IMU)的数据采集,这类方案由于主机采用串行方式接收GPS串行数据,接收过程占用较多的时间而使得主机中导航解算流程经常被中断,实时性差,不能满足高实时性应用的要求。专利200610113983.5所述的一种基于双DSP的集成化组合导航计算机,采用两个数字信号处理器,一个用于数据接收和时间同步,一个用于导航解算,时间同步采用软同步方法,针对的是具有时间同步信号的IMU数据与GPS数据的同步问题,该专利不含IMU数据采集功能,集成度低。而基于FPGA和DSP的组合导航计算机方案通常采用FPGA完成IMU数据采集,DSP除完成导航解算外,还要采集GPS串行数据、完成时间同步并承担通信任务,DSP仍然会因以串行方式接收GPS数据而常常中断导航解算流程,因而实时性差,在数据量大的实时应用场合不能满足应用要求。
发明内容
本发明的技术解决问题是:针对现有组合导航计算机的不足,提供一种基于DSP和FPGA的组合导航计算机,实现数据的集中采集以及导航信息的实时解算和输出,具有体积小、功耗低、集成度高、实时性好、可扩展性强、易于升级的特点。
本发明的技术解决方案是:一种基于DSP和FPGA的组合导航计算机,由数据输入模块、数据采集模块、导航解算模块和数据输出模块组成。
所述的数据输入模块包括电平转换芯片和光电耦合芯片组,秒脉冲(One Pulse Per Second,1PPS)信号经过光电耦合芯片去除噪声后输出CMOS电平形式的1PPS信号,GPS信号经过电平转换芯片转换后输出CMOS电平形式的GPS信号,IMU脉冲信号经过光电耦合芯片组去除噪声后输出CMOS电平形式的IMU脉冲信号。
所述的数据采集模块包括FPGA、配置芯片和拨码开关,其中,FPGA包括时间同步模块、译码器、多路计数器、全双工异步串行收发器(Universal Asynchronous Receiver/TransmitterUART)UART1、UART2、UART3、双口RAM1、双口RAM2、双口RAM3,通过高速硬件描述语言(VHSIC Hardware Description Language,VHDL)实现;数据输入模块输出的CMOS电平形式的1PPS信号和拨码开关确定的开关量信号经译码器译码得到的信号作为时间同步模块的输入信号,由时间同步模块通过时间同步方法得到IMU脉冲信号采集的采样时钟,FPGA通过UART1和多路计数器以及时间同步模块完成GPS信号和IMU脉冲信号的同步采集;数据输入模块输出的CMOS电平形式的GPS信号经过UART1串并转换为并行数据,存储于双口RAM1;多路计数器根据时间同步模块输出的采样时钟对IMU脉冲信号计数,并通过一路计数器记录IMU采样次数,将IMU脉冲信号计数结果(即IMU数据)及IMU采样次数存储于双口RAM2,然后送入UART2进行并串转换,并输出串行IMU数据和IMU采样次数;双口RAM3存储导航解算模块送来的IMU数据、IMU采样次数、GPS数据与导航解算结果,然后送入UART3进行并串转换,并输出串行IMU数据、IMU采样次数、GPS数据与导航解算结果。
所述的导航解算模块包括DSP和Flash,DSP通过外部存储器接口(External Memory Interface,EMIF)定时读取数据采集模块中双口RAM1存储的GPS数据和双口RAM2存储的IMU数据和IMU采样次数,读取到IMU数据时进行捷联解算,读取到GPS数据时,通过GPS故障诊断方法对GPS数据进行判断,若可用则进行组合滤波和反馈校正,然后将IMU数据、IMU采样次数、GPS数据和导航解算结果通过EMIF送到数据采集模块的双口RAM3和数据输出模块中的网口;同时,上位机通过数据输出模块中的HPI接口与DSP的HPI通信,获取IMU数据、IMU采样次数、GPS数据和导航解算结果;Flash保存DSP内运行的程序。
所述的数据输出模块包括电平转换芯片组、第一串口、第二串口、网口和HPI(Host PortInterface,HPI)接口,数据采集模块中由UART2并串转换后的串行IMU数据和IMU采样次数通过电平转换芯片组进行转换后经第一串口发送到上位机;数据采集模块中由UART3串并转换后的串行IMU数据和IMU采样次数以及导航解算结果通过电平转换芯片进行转换后经第二串口发送到上位机;来自导航解算模块中DSP的数据通过网口发送到上位机;上位机通过数据输出模块中的HPI接口访问导航解算模块中DSP内的IMU数据、IMU采样次数、GPS数据和导航解算结果,并与第一串口、第二串口、网口和HPI接口实时通信,实现实时监控;第一串口、第二串口、网口和HPI接口实现输出信息冗余。
所采用的时间同步方法为:采用GPS接收机的1PPS秒脉冲信号为基准时钟信号,对其二分频得到占空比为1∶1的时钟信号时钟I,根据GPS接收机数据带宽的不同作如下处理:带宽为1Hz时,以时钟I的高电平和低电平为门限,并依据译码器译码得到的信号对***时钟CLK分频生成IMU数据采集的采样时钟Ts;带宽为2Hz时,将时钟I进行2倍频得到占空比为1∶1的时钟II,然后以时钟II的高电平和低电平为门限,并依据译码器译码得到的信号对***时钟CLK分频生成IMU数据采集的采样时钟Ts;带宽为4Hz时,将时钟I进行4倍频得到占空比为1∶1的时钟III,然后以时钟III的高电平和低电平为门限,并依据译码器译码得到的信号对***时钟CLK分频生成IMU数据采集的采样时钟Ts;带宽为2nHz时,n为大于2的正整数,将时钟I进行2n倍频得到占空比为1∶1的时钟n,然后以时钟n的高电平和低电平为门限,并依据译码器译码得到的信号对***时钟CLK分频生成IMU数据采集的采样时钟Ts;采样时钟Ts前沿与1PPS脉冲前沿对齐,完成GPS数据和IMU数据的时间同步。
所采用的GPS故障诊断方法为:在数据采集模块2内由FPGA内通过VHDL实现的比较器对存储于双口RAM1的GPS数据进行判断,当GPS数据完整时允许导航解算模块3中的DSP访问数据采集模块2中双口RAM1存储的GPS数据,当GPS数据由于GPS接收机故障或因干扰、机动导致失锁而不完整时,不允许DSP访问,DSP获取的GPS数据中的协调世界时不变,同时对GPS数据的可用性进行检测,当检测到协调世界时没有变化或协调世界时虽有变化,但GPS数据不可用时,检测出GPS故障。
所采用的输出信息冗余和实时监控的实现方法为:在IMU脉冲信号采集的同时,通过多路计数器中的一路记录IMU脉冲信号采样次数,数据输出模块中第一串口输出IMU数据和IMU采样次数,第二串口和网口均输出GPS数据和导航解算结果以及第一串口输出的IMU数据、IMU采样次数,上位机通过HPI接口直接访问DSP内部的IMU数据、IMU采样次数、GPS数据和导航解算结果,第一串口、第二串口、网口输出的IMU数据、IMU采样次数和HPI接口获取的IMU数据、IMU采样次数相同,第二串口、网口输出的GPS数据以及导航解算结果与HPI接口获取的GPS数据以及导航解算结果相同,实现输出信息中IMU数据、IMU采样次数的四重冗余,GPS数据和导航解算结果的两重冗余,通过IMU采样次数得到一一对应,并与GPS数据中的协调世界时对应;***通过第一串口、第二串口、网口和HPI接口与上位机实时通信,通过上位机的接收显示软件对***进行实时监控,提高了***的可靠性。
本发明的工作流程为:首先通过数据采集模块的拨码开关选择IMU脉冲信号的采样时钟,FPGA开始采集经数据输入模块输出的CMOS电平形式的IMU脉冲信号和GPS信号,每完成一次采集便触发导航解算模块中DSP外部中断,DSP通过响应该中断来读取数据采集模块中FPGA采集的IMU数据和GPS数据,导航解算模块开始初始对准;对准结束后,在导航解算模块中DSP内对接收到的IMU数据进行判断,如果IMU数据不是与GPS数据同步的数据,则只进行捷联解算,如果为同步数据,除进行捷联解算外,还将解算结果暂存于DSP的内存空间,DSP接收GPS数据在1PPS后固定时刻进行,如果GPS数据可用则调用DSP内存空间存储的捷联解算结果,通过卡尔曼滤波估计出导航参数的误差,并作修正,从而由数据输出模块输出高精度的导航信息,如果GPS数据不可用,则不做卡尔曼滤波,由数据输出模块输出捷联解算结果,直到工作结束。
本发明的原理是:
本发明采用FPGA和DSP实现数据采集、实时导航解算和数据输出功能,由数据输入模块、数据采集模块、导航解算模块和数据输出模块组成。数据输入模块将GPS信号电平、IMU脉冲信号电平转换为与数据采集模块兼容的CMOS电平;数据采集模块利用1PPS秒脉冲信号通过时间同步方法同步采集IMU脉冲信号和GPS信号,并通过拨码开关经过译码器控制IMU脉冲信号采样时钟周期,从而可以通过拨码开关来选择IMU信号采样频率;数据采集模块在采集IMU脉冲信息的同时通过一路计数器对IMU采样次数进行记录;采集的IMU数据和GPS数据暂存于FPGA内部的双口RAM中,导航解算模块通过DSP的EMIF接口高速并行读取数据采集模块采集的IMU数据和GPS数据,并且是采用外部定时中断方式,以中断信号启动导航解算,该过程仅需要数十微秒,DSP获取GPS数据的时间与采用串行接收的方式相比可忽略不计,从而保证了DSP中导航解算流程顺利进行,不会因接收GPS数据而被迫中断;当导航解算模块接收到与GPS数据同步的IMU数据后,进行捷联解算,得到载体的位置、速度、姿态等信息,当导航解算模块接收到GPS数据后,利用卡尔曼滤波器进行组合滤波,估计导航参数误差,对捷联解算结果进行修正,从而获得高精度的导航信息。
为避免因数据传输或上位机接收不稳定等原因导致的数据接收错误,提高可靠性,本发明在信息的输出上采用了冗余方案,并通过上位机对接收的信息进行实时监控:数据采集模块采集的IMU数据不经任何处理,直接通过第一串口输出到上位机;第二串口和网口均输出IMU采样次数、IMU数据、GPS数据和组合导航结果;上位机通过HPI接口直接访问DSP内部的上述数据;第一串口、第二串口、网口输出的IMU数据、GPS数据和组合导航结果和上位机通过HPI接口获取的IMU数据、GPS数据和组合导航结果通过IMU采样次数而得到一一对应,并与协调世界时对应,实现信息冗余,为事后处理提供严格的同步依据;***通过第一串口、第二串口、网 口和HPI接口与上位机实时通信,对***进行实时监控。
本发明与现有技术相比的优点在于:
1.采用FPGA+DSP的并行结构,FPGA完成GPS数据与IMU脉冲信号的集中同步采集,从而提高了集成度,减小了体积和功耗;DSP获取GPS数据时不会中断DSP内导航解算流程,DSP得以专注于导航解算,保证了实时性。
2.输出信息具有多重冗余,为事后处理提供严格同步的冗余信息,可靠性高。
3.所采用的时间同步方法适用于以脉冲方式输出的IMU数据与不同带宽GPS数据的同步,具有很好的通用性。
4.通过FPGA可以扩展更多的输入输出接口和更多的UART、RAM等功能模块,具有良好的可扩展性,移植升级方便。
附图说明
图1为本发明的***结构框图。
图2为本发明的时间同步时序图。
图3为本发明的工作流程图。
具体实施方式
如图1所示,本发明由数据输入模块1、数据采集模块2、导航解算模块3和数据输出模块4组成。
所述的数据输入模块1包括电平转换芯片和光电耦合芯片组,电平转换芯片采用一片MAX3232,GPS信号经过电平转换芯片转换后输出CMOS电平形式的GPS信号;光电耦合芯片组采用7片HCPL063L,其中一片将1PPS秒脉冲信号去除噪声后输出CMOS电平形式的1PPS信号,其余6片将IMU脉冲信号(包括三个加速度计、三个陀螺仪输出的共6路脉冲信号)去除噪声后输出CMOS电平形式的IMU脉冲信号。
所述的数据采集模块2包括FPGA、配置芯片和拨码开关,其中,FPGA包括时间同步模块、译码器、多路计数器、UART1、UART2、UART3、双口RAM1、双口RAM2、双口RAM3,各部分均通过VHDL语言实现;数据输入模块1输出的CMOS电平形式的1PPS信号和拨码开关确定的开关量信号经译码器译码得到的信号作为时间同步模块的输入信号,由时间同步模块通过时间同步方法得到IMU脉冲信号采集的采样时钟,该采样时钟决定IMU脉冲信号采集的采样频率;FPGA通过UART1和多路计数器以及时间同步模块完成GPS信号和IMU脉冲信号的同步采集;数据输入模块1输出的CMOS电平形式的GPS信号经过UART1串并转换为并行数据,存储于双口RAM1;多路计数器根据时间同步模块输出的采样时钟对IMU脉冲信号计数,并通过一路计数器记录IMU采样次数,将IMU脉冲信号计数结果(即IMU数据)及IMU采样次数存储于双口RAM2,然后送入UART2进行并串转换;并输出串行IMU数据和IMU采样次数;双口RAM3存储导航解算模块送来的IMU数据、IMU采样次数、GPS数据与导航解算结果,然后送入UART3进行并串转换,并输出串行IMU数据、IMU采样次数、GPS数据与导航解算结果。FPGA采用Xilinx公司的XC3S400,配置芯片采用XCF02S。
所述的导航解算模块3包括DSP和Flash,DSP通过EMIF定时读取数据采集模块2中双口RAM1存储的GPS数据和双口RAM2存储的IMU数据和IMU采样次数,读取到IMU数据时进行捷联解算,读取到GPS数据时,通过GPS故障诊断方法对GPS数据进行判断,GPS数据可用则进行组合滤波和反馈校正,然后将IMU数据、IMU采样次数、GPS数据和导航解算结果通过EMIF送到数据采集模块2的双口RAM3和数据输出模块4中的网口;同时,上位机通过数据输出模块中的HPI接口与DSP的HPI通信,获取IMU数据、IMU采样次数、GPS数据和导航解算结果;Flash保存DSP运行之程序。DSP采用TI公司TMS320C6713B系列产品,主频选用300MHz。
所述的数据输出模块4包括电平转换芯片组、第一串口、第二串口、网口和HPI接口,数据采集模块2中由UART2并串转换后的串行IMU数据和IMU采样次数通过电平转换芯片组进行转换后经第一串口发送到上位机;数据采集模块2中双口RAM3接收来自导航解算模块3的IMU数据、IMU采样次数、GPS数据以及导航解算结果,由UART3串并转换后通过电平转换芯片进行转换后经第二串口发送到上位机;来自导航解算模块3中DSP的IMU数据、IMU采样次数、GPS数据以及导航解算结果通过网口发送到上位机;上位机通过数据输出模块4中的HPI接口访问导航解算模块3中DSP内部的IMU数据、IMU采样次数、GPS数据以及导航解算结果;第一串口、第二串口、网口发送的IMU数据、IMU采样次数和HPI接口获取的IMU数据、IMU采样次数是相同的,而且第二串口、网口发送的GPS数据以及导航解算结果与HPI接口获取的GPS数据以及导航解算结果也是相同的。并与第一串口、第二串口、网口和HPI接口实时通信,实现实时监控;第一串口、第二串口、网口和HPI接口实现输出信息冗余。电平转换芯片组由2片MAX3232和3片MAX3488组成,第一串口、第二串口可以是RS232串口或RS422/485串口。
由于GPS接收机故障或因干扰、机动导致GPS信号失锁时,GPS接收机输出的GPS数据仅包括少量信息(GPS数据不完整),与GPS接收机无故障而GPS信号完好时(GPS数据完整)的数据量大为减少,此时的信息告知用户当前GPS数据不可用。基于前述信息,采用以下的GPS故障诊断方法对GPS故障进行诊断:在数据采集模块2内由FPGA内通过VHDL语言实现的比较器对存储于双口RAM1的GPS数据的数据量进行判断,当GPS数据量与GPS信号完好时的GPS数据量相同时允许导航解算模块3中的DSP访问数据采集模块2中双口RAM1存储的GPS数据,当GPS数据量小于GPS信号完好时的GPS数据量时,不允许DSP访问,DSP获取的GPS数据中的协调世界时不变;同时获取GPS数据中给出的判断GPS数据是否可用的信息,据此信息对GPS数据的可用性进行检测,当检测到协调世界时没有变化或协调世界时虽有变化,但GPS数据不可用时,检测出GPS故障。
输出信息冗余的实现方法为:在IMU脉冲信号采集的同时,通过多路计数器中的一路记录IMU脉冲信号采样次数,数据输出模块4中第一串口输出IMU数据和IMU采样次数,第二串口和网口均输出GPS数据和导航解算结果以及第一串口输出的IMU数据、IMU采样次数,上位机通过HPI接口直接访问DSP内部的IMU数据、IMU采样次数、GPS数据和导航解算结果,第一串口、第二串口、网口输出的IMU数据、IMU采样次数和HPI接口获取的IMU数据、IMU采样次数是相同的,而且第二串口、网口输出的GPS数据以及导航解算结果与HPI接口获取的GPS数据以及导航解算结果也是相同的,实现输出信息中IMU数据、IMU采样次数的四重冗余,GPS数据和导航解算结果的两重冗余,而且通过IMU采样次数而得到一一对应,并与GPS数据中的协调世界时对应;该方法为事后处理提供冗余信息和严格的同步依据。
实时监控方法为:通过第一串口、第二串口、网口和HPI接口与上位机实时通信,通过上位机的接收显示软件对输出的导航信息进行实时监控,当***出现严重的错误时以便进行及时的相关处理。
如图2所示,本发明所采用的时间同步方法为:采用GPS接收机的1PPS秒脉冲信号为基准时钟信号,对其二分频得到占空比为1∶1的时钟信号时钟I,根据GPS接收机数据带宽的不同作如下处理:带宽为1Hz时,以时钟I的高电平和低电平为门限,并依据译码器译码得到的信号(决定采样频率)对***时钟CLK分频生成IMU数据采集的采样时钟Ts;带宽为2Hz时,将时钟I进行2倍频得到占空比为1∶1的时钟II,然后以时钟II的高电平和低电平为门限,并依据译码器译码得到的信号对***时钟CLK分频生成IMU数据采集的采样时钟Ts;带宽为4Hz时,将时钟I进行4倍频得到占空比为1∶1的时钟III,然后以时钟III的高电平和低电平为门限,并依据译码器译码得到的信号对***时钟CLK分频生成IMU数据采集的采样时钟Ts;带宽为2nHz时,n为大于2的正整数,将时钟I进行2n倍频得到占空比为1∶1的时钟n,然后以时钟n的高电平和低电平为门限,并依据译码器译码得到的信号对***时钟CLK分频生成IMU数据采集的采样时钟Ts;采样时钟Ts前沿与1PPS脉冲前沿对齐,完成GPS数据和IMU数据的时间同步。
如图3所示,本发明的工作流程为:首先通过数据采集模块的拨码开关选择IMU脉冲信号的采样时钟,开始采集经数据输入模块输出的CMOS电平形式的IMU脉冲信号和GPS信号,每完成一次采集便触发导航解算模块中DSP外部中断,DSP通过响应该中断来读取数据采集模块中FPGA采集的IMU数据和GPS数据,导航解算模块开始初始对准;对准结束后,在导航解算模块中的DSP内对接收到的IMU数据进行判断,如果IMU数据不是与GPS数据同步的数据,则只进行捷联解算,如果为同步数据,除进行捷联解算外,还将解算结果暂存于DSP的内存空间,DSP接收GPS数据是在1PPS后固定时刻进行,如果GPS数据可用则调用DSP内存空间存储的捷联解算结果,通过卡尔曼滤波估计出导航参数的误差,并作修正,从而由数据输出模块输出高精度的导航信息,如果GPS数据不可用,则不做卡尔曼滤波,由数据输出模块输出捷联解算结果,直到工作结束。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (5)
1.一种基于DSP和FPGA的组合导航计算机,由数据输入模块(1)、数据采集模块(2)、导航解算模块(3)和数据输出模块(4)组成,其特征在于:
所述的数据输入模块(1)包括电平转换芯片和光电耦合芯片组,1PPS秒脉冲信号经过光电耦合芯片组去除噪声后输出CMOS电平形式的1PPS信号;GPS信号经过电平转换芯片转换后输出CMOS电平形式的GPS信号,IMU脉冲信号经过光电耦合芯片组去除噪声后输出CMOS电平形式的IMU脉冲信号;
所述的数据采集模块(2)包括FPGA、配置芯片和拨码开关,其中FPGA包括时间同步模块、译码器、多路计数器、UART1、UART2、UART3、双口RAM1、双口RAM2、双口RAM3;数据输入模块(1)输出的CMOS电平形式的1PPS信号和拨码开关确定的开关量信号经译码器译码得到的信号作为时间同步模块的输入信号,时间同步模块通过时间同步方法得到IMU脉冲信号采集的采样时钟,FPGA通过UART1和多路计数器以及时间同步模块完成GPS信号和IMU脉冲信号的同步采集;数据输入模块(1)输出的CMOS电平形式的GPS信号经过UART1串并转换为并行数据,存储于双口RAM1;多路计数器根据时间同步模块输出的采样时钟对CMOS电平形式的IMU脉冲信号计数,并记录IMU采样次数,将IMU脉冲信号计数结果及IMU采样次数存储于双口RAM2,然后送入UART2进行并串转换,输出串行IMU数据和IMU采样次数;双口RAM3接收导航解算模块(3)输出的IMU数据、IMU采样次数、GPS数据与导航解算结果,然后送入UART3进行并串转换,输出串行IMU数据、IMU采样次数、GPS数据与导航解算结果;
所述的导航解算模块(3)包括DSP和Flash,DSP通过EMIF定时读取数据采集模块(2)中双口RAM1存储的GPS数据和双口RAM2存储的IMU数据和IMU采样次数,读取到IMU数据时进行捷联解算,读取到GPS数据时,通过GPS故障诊断方法对GPS数据的可用性进行判断,若可用则进行组合滤波和反馈校正,然后将IMU数据、IMU采样次数、GPS数据和导航解算结果通过EMIF送到数据采集模块(2的双口RAM3和数据输出模块(4)中的网口;
所述的数据输出模块(4)包括电平转换芯片组、第一串口、第二串口、网口和HPI接口,数据采集模块(2)中由UART2并串转换后的串行IMU数据和IMU采样次数通过电平转换芯片组进行转换后经第一串口发送到上位机;数据采集模块(2)中由UART3串并转换后的串行IMU数据、IMU采样次数、GPS数据以及导航解算结果通过电平转换芯片进行转换后经第二串口发送到上位机;来自导航解算模块(3)中DSP的IMU数据、IMU采样次数、GPS数据以及导航解算结果通过网口发送到上位机;上位机通过数据输出模块(4)中的HPI接口访问导航解算模块(3)中DSP内部的IMU数据、IMU采样次数、GPS数据以及导航解算结果,并与第一串口、第二串口、网口和HPI接口实时通信,实现实时监控;第一串口、第二串口、网口和HPI接口实现输出信息冗余。
2.根据权利要求1所述的基于DSP和FPGA的组合导航计算机,其特征在于:所述的时间同步方法为:采用GPS接收机的1PPS秒脉冲信号为基准时钟信号,对其二分频得到占空比为1∶1的时钟信号时钟I,根据GPS接收机数据带宽的不同作如下处理:带宽为1Hz时,以时钟I的高电平和低电平为门限,并依据译码器译码得到的信号对***时钟分频生成IMU数据采集的采样时钟;带宽为2nHz时,n为正整数,将时钟I进行2n倍频得到占空比为1∶1的时钟n,然后以时钟n的高电平和低电平为门限,并依据译码器译码得到的信号对***时钟分频生成IMU数据采集的采样时钟;采样时钟前沿与1PPS脉冲前沿对齐,完成GPS数据和IMU数据的时间同步。
3.根据权利要求1所述的基于DSP和FPGA的组合导航计算机,其特征在于:所述的GPS故障诊断方法为:在数据采集模块(2)中通过比较器对存储于双口RAM1的GPS数据进行判断,当GPS数据完整时允许导航解算模块(3)中的DSP访问数据采集模块(2)中双口RAM1存储的GPS数据,当GPS数据由于GPS接收机故障或因干扰、机动导致失锁而不完整时,不允许DSP访问,DSP获取的GPS数据中的协调世界时不变,同时对GPS数据的可用性进行检测,当检测到协调世界时没有变化或协调世界时虽有变化,但GPS数据不可用时,检测出GPS故障。
4.根据权利要求1所述的基于DSP和FPGA的组合导航计算机,其特征在于:所述第一串口、第二串口、网口和HPI接口实现输出信息冗余的方法为:数据输出模块(4)中第一串口输出IMU数据和IMU采样次数,第二串口和网口均输出GPS数据和导航解算结果以及第一串口输出的IMU数据、IMU采样次数,上位机通过HPI接口直接访问DSP内部的IMU数据、IMU采样次数、GPS数据和导航解算结果,第一串口、第二串口、网口输出的IMU数据、IMU采样次数和HPI接口获取的IMU数据、IMU采样次数相同,第二串口、网口输出的GPS数据以及导航解算结果与HPI接口获取的GPS数据以及导航解算结果相同,实现输出信息中IMU数据、IMU采样次数的四重冗余,GPS数据和导航解算结果的两重冗余,通过IMU采样次数得到一一对应,并与GPS数据中的协调世界时对应。
5.根据权利要求1所述的基于DSP和FPGA的组合导航计算机,其特征在于:工作流程为:首先通过数据采集模块(2)的拨码开关选择IMU脉冲信号的采样时钟,FPGA开始采集经数据输入模块(1)输出的CMOS电平形式的IMU脉冲信号和GPS信号,每完成一次采集便触发导航解算模块(3)中DSP的外部中断,DSP通过响应该中断来读取数据采集模块(2)中FPGA采集的IMU数据和GPS数据,导航解算模块(3)开始初始对准;对准结束后,在导航解算模块(3)中DSP内对接收到的IMU数据进行判断,如果IMU数据不是与GPS数据同步的数据,则只进行捷联解算,如果为同步数据,除进行捷联解算外,还将解算结果暂存于DSP的内存空间,DSP接收GPS数据是在1PPS后固定时刻进行,如果GPS数据可用则调用DSP内存空间存储的捷联解算结果,通过卡尔曼滤波估计出导航参数的误差,并作修正,由数据输出模块输出导航信息,如果GPS数据不可用,则不做卡尔曼滤波,由数据输出模块输出捷联解算结果,直到工作结束。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2008101008289A CN101261129B (zh) | 2008-02-22 | 2008-02-22 | 一种基于dsp和fpga的组合导航计算机 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2008101008289A CN101261129B (zh) | 2008-02-22 | 2008-02-22 | 一种基于dsp和fpga的组合导航计算机 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101261129A CN101261129A (zh) | 2008-09-10 |
CN101261129B true CN101261129B (zh) | 2010-09-01 |
Family
ID=39961732
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2008101008289A Expired - Fee Related CN101261129B (zh) | 2008-02-22 | 2008-02-22 | 一种基于dsp和fpga的组合导航计算机 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101261129B (zh) |
Families Citing this family (39)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101833536B (zh) * | 2010-04-16 | 2012-02-08 | 北京航空航天大学 | 一种冗余仲裁机制的可重构星载计算机 |
CN102299722B (zh) * | 2010-06-24 | 2014-12-10 | 中兴通讯股份有限公司 | 一种外置接收机转接板 |
CN102567280B (zh) * | 2010-12-17 | 2015-01-21 | 西安奇维科技股份有限公司 | 一种基于dsp和fpga的计算机硬件平台设计方法 |
CN102128624B (zh) * | 2010-12-28 | 2012-05-23 | 浙江大学 | 一种高动态捷联惯性导航并行计算装置 |
CN102360218A (zh) * | 2011-10-14 | 2012-02-22 | 天津大学 | 基于arm和fpga的无人直升机导航与飞行控制*** |
CN102608625B (zh) * | 2012-03-30 | 2014-04-16 | 武汉大学 | 基于惯性辅助定位接收机的实时形变监测预警***及方法 |
CN102831090B (zh) * | 2012-05-07 | 2015-06-10 | 中国科学院空间科学与应用研究中心 | 一种用于星载dsp与fpga通讯接口的地址线及其优化方法 |
CN102798582A (zh) * | 2012-05-22 | 2012-11-28 | 山东理工大学 | 基于dsp环形缓冲区的比例光子相关器 |
CN103116175B (zh) * | 2013-01-18 | 2015-06-03 | 东南大学 | 基于dsp和fpga的嵌入式导航信息处理器 |
CN104080042A (zh) * | 2013-03-30 | 2014-10-01 | 北京百度网讯科技有限公司 | 一种用于移动定位服务的无线信号采集方法和*** |
CN103323006A (zh) * | 2013-05-29 | 2013-09-25 | 哈尔滨工程大学 | 基于omap的光纤陀螺捷联***的导航计算机 |
CN103323008A (zh) * | 2013-06-28 | 2013-09-25 | 哈尔滨工程大学 | 基于dsp的光纤陀螺捷联惯导计算机及其导航解算方法 |
CN103389092B (zh) * | 2013-08-13 | 2016-03-02 | 湖南航天机电设备与特种材料研究所 | 一种系留飞艇姿态测量装置及测量方法 |
CN104423417A (zh) * | 2013-08-26 | 2015-03-18 | 上海工程技术大学 | 一种同步相量准确定时*** |
CN104422948A (zh) * | 2013-09-11 | 2015-03-18 | 南京理工大学 | 一种嵌入式组合导航***及其方法 |
CN103475413A (zh) * | 2013-09-12 | 2013-12-25 | 成都成电光信科技有限责任公司 | Fpga可配置的光纤网络数据卡 |
CN103591961B (zh) * | 2013-11-26 | 2016-07-06 | 北京航空航天大学 | 一种基于dsp和fpga的捷联罗经导航计算机 |
CN103616710A (zh) * | 2013-12-17 | 2014-03-05 | 靳文瑞 | 基于fpga的多传感器组合导航时间同步*** |
CN103868513B (zh) * | 2014-03-17 | 2016-09-28 | 北京航空航天大学 | 一种分布式pos用数据处理计算机*** |
CN104132663A (zh) * | 2014-05-27 | 2014-11-05 | 北京遥测技术研究所 | 一种基于fpga的导航计算机协处理器 |
CN104330082B (zh) * | 2014-10-22 | 2017-06-20 | 哈尔滨工程大学 | 一种mems/gnss组合导航***实时数据同步方法 |
CN104880190B (zh) * | 2015-06-02 | 2018-05-25 | 无锡北微传感科技有限公司 | 一种用于惯导姿态融合加速的智能芯片 |
CN105182377B (zh) * | 2015-08-21 | 2018-06-19 | 上海海积信息科技股份有限公司 | 一种接收机板卡及接收机 |
CN106774637A (zh) * | 2015-12-22 | 2017-05-31 | 中国电子科技集团公司第二十研究所 | 一种利用1pps信号进行计算机校时的装置及方法 |
CN105806334B (zh) * | 2016-03-07 | 2018-11-16 | 苏州中德睿博智能科技有限公司 | 一种惯性传感器和视觉传感器数据同步采集*** |
CN106289256A (zh) * | 2016-07-25 | 2017-01-04 | 湖北师范大学 | 基于双dsp与fpga架构的计算信号处理*** |
CN106646575A (zh) * | 2016-11-15 | 2017-05-10 | 南京航空航天大学 | 一种基于fpga双核的组合导航***及其构建方法 |
CN106707874A (zh) * | 2017-01-18 | 2017-05-24 | 上海航天控制技术研究所 | 一种多源导航计算机电路 |
CN107796389A (zh) * | 2017-10-17 | 2018-03-13 | 北京航天发射技术研究所 | 一种基于多核dsp的定位导航方法 |
CN108535755B (zh) * | 2018-01-17 | 2021-11-19 | 南昌大学 | 基于mems的gnss/imu车载实时组合导航方法 |
CN109443362A (zh) * | 2018-10-30 | 2019-03-08 | 中国船舶重工集团公司第七〇九研究所 | 基于dsp和fpga的导航计算机 |
CN110134177B (zh) * | 2018-11-30 | 2024-07-12 | 中电普瑞科技有限公司 | 一种应用于智能电网的嵌入式***校时***及其方法 |
CN109581440A (zh) * | 2018-12-18 | 2019-04-05 | 中国电子科技集团公司第五十四研究所 | 一种集中分布式多***导航信号处理平台 |
CN109470244A (zh) * | 2018-12-21 | 2019-03-15 | 中国船舶重工集团公司第七0七研究所 | 基于fpga的光纤捷联惯导多信息同步采集***及方法 |
CN111355913A (zh) * | 2018-12-21 | 2020-06-30 | 刘松林 | 一种pos数据和视频数据的同步方法及装置 |
CN109631893A (zh) * | 2019-01-31 | 2019-04-16 | 西安深瞳智控技术有限公司 | 一种基于多核处理器的导航控制***及其控制方法 |
CN110553645B (zh) * | 2019-09-20 | 2023-01-10 | 湖南航天机电设备与特种材料研究所 | 一种基于周期脉冲基准的双***时钟同步处理方法 |
CN110686670B (zh) * | 2019-09-25 | 2023-04-28 | 天津津航计算技术研究所 | 一种嵌入式***的双路导航通讯装置 |
CN111885431B (zh) * | 2020-08-03 | 2022-06-17 | 北京环境特性研究所 | 一种通信控制方法和装置 |
-
2008
- 2008-02-22 CN CN2008101008289A patent/CN101261129B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN101261129A (zh) | 2008-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101261129B (zh) | 一种基于dsp和fpga的组合导航计算机 | |
CN103116175B (zh) | 基于dsp和fpga的嵌入式导航信息处理器 | |
CN100498232C (zh) | 一种sdins/gps组合导航***时间同步及同步数据提取方法 | |
CN102866621B (zh) | 一种航天器gps整秒脉冲高精度校时器及其校时方法 | |
CN103868513B (zh) | 一种分布式pos用数据处理计算机*** | |
CN104330082A (zh) | 一种mems/gnss组合导航***实时数据同步方法 | |
CN109922260B (zh) | 图像传感器和惯性传感器的数据同步方法和同步装置 | |
CN102291169B (zh) | 一种卫星星上高精度时间同步方法 | |
CN102109351B (zh) | 一种激光陀螺pos数据采集及预处理*** | |
CN103591961B (zh) | 一种基于dsp和fpga的捷联罗经导航计算机 | |
CN103207851A (zh) | 串行数据实时采集标时方法 | |
CN100442016C (zh) | 一种基于双dsp的集成化组合导航计算机 | |
CN104899167A (zh) | 一种基于fpga的便携式高速数据采集方法 | |
CN103248364B (zh) | 一种惯性传感器imu信号模数转换模块 | |
CN102109604B (zh) | Gps/galileo导航基带处理芯片及导航接收机 | |
CN105955299A (zh) | 一种可重构测控、导航、飞行控制一体化***及重构方法 | |
CN102495132A (zh) | 一种用于海底管道漏磁内检测器的多通道数据采集装置 | |
CN101520640A (zh) | 基于fpga的时间间隔测量仪 | |
CN103323008A (zh) | 基于dsp的光纤陀螺捷联惯导计算机及其导航解算方法 | |
CN101228724A (zh) | 串行通信中的时间同步 | |
CN107014381A (zh) | Pld、dsp、组合导航***、数据处理方法和装置 | |
CN103235500A (zh) | 基于北斗的卫星授时方法及计时装置 | |
CN106444351A (zh) | 多源解码授时***及其工作方法 | |
CN103034236B (zh) | 一种基于时分复用的多星敏感器时序同步处理方法 | |
CN103017761B (zh) | 一种航天器多星敏感器数据采集器及采集方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20100901 Termination date: 20190222 |