捷联惯性组合导航系统的工程设计

发布者:悠闲时光最新更新时间:2014-03-19 来源: 21ic关键字:惯性组合导航系统  汽车导航 手机看文章 扫描二维码
随时随地手机看文章

捷联惯性组合导航系统是一种完全自主的定位导航系统,它可以连续实时地提供位置、速度和姿态信息,短时精度较高,但误差随时间增长而不断积累。GPS导航系统能够全天候提供信息,且误差不随时间积累。因此,将它们组合起来,利用卡尔曼滤波技术进行融合,可以发挥各自优势,提高导航精度。由于捷联系统没有稳定的物理平台,惯性器件测量的数值不能直接进行导航计算,必须先经过大量、实时、精确的数学运算建立起数学平台,才能得到导航参数,在计算上较复杂,对计算机的性能要求高。为减小体积、重量和增加可靠性。文中提出利用PC104嵌入式工控机和FPGA设计一种双CPU结构的捷联惯性组合导航系统。系统中PC/104总线结构的嵌入式工控机来承担姿态解算任务,采用FPGA控制组合系统的采集模块,并利用其内部资源,设计了双口RAM模块、串口接口模块等。双CPU系统使PC104可以专注于解算,保证了系统的实时性。

1 捷联惯性组合导航系统总体方案
捷联惯导系统是将加速度计和陀螺仪沿载体坐标系安装,在进行导航参数计算时,需要是导航坐标系中的量。因此应先将惯性器件测得的比力和角加速度误差补偿后送入计算机进行实时计算,可以得到将比力从载体坐标系转换到导航坐标系的姿态矩阵。通过姿态矩阵可以确定载体的姿态信息。姿态矩阵常用的即时修正方法有欧拉角法、方向余弦法和四元数法,设计采用四元数法。为进行导航解算,选取地理坐标系为导航坐标系,三轴分别指向东向、北向和天向。



根据捷联惯性组合导航系统的特点,提出采用PC104总线嵌入式工控机的捷联惯性组合导航系统的硬件设计方案,系统包括数据采集和数据解算模块。数据采集模块由FPGA负责控制A/D转换将陀螺仪和加速度计输出的模拟信号转换为数字信号。在FPGA内部开辟一块存储单元,FPGA读取A/D的转换结果存放在内嵌的双口RAM中。FPGA通过双口RAM与PC104进行实时通信,FPGA把采集的数据进行处理后送入双口RAM中,然后发中断信号给PC104,通知其已经有数据可以处理。PC104收到中断信号后,将双口RAM中的数据取走进行处理和解算。FPGA和PC104同时工作,提高了系统的运行速度。系统要求数据采样频率为1kHz,数据解算频率为100Hz,外加时钟频率为40MHz。

2 系统硬件设计
数据采集部分采用Altera公司的EP2C35F672,它是CycloneⅡ系列产品之一,一个LAB中有16个LE,增加了乘法器模块,增强了DSP处理能力。由33 216个LE组成,片上有105个M4K RAM块,片内有35个18 x 18个硬件乘法器,片上有4个PLL,可以实现多个时钟域。PC104总线结构嵌入式工控机具有功耗低、单5 V供电、工作温度范围宽、可靠性高、抗震性好、结构小巧紧凑、浮点运算能力强、运算速度快等显著特点。最适合在嵌入式控制系统中应用。因此它是开发导航计算机的理想方案。
2.1 数据采集模块
数据采集部分由惯性测量元件、GPS接收机、信号调理部分、A/D转换电路和FPGA控制器等构成。在这部分中,FPGA主要完成同步产生A/D转换的时序,数字滤波和存储经A/D转换后的陀螺和加表的数据。惯性测量元件主要包括3个加速度计和3个陀螺仪,正交安装于坐标系的X轴、Y轴和Z轴,用于提供载体在载体坐标系上的比力和角速度,采用模拟信号输出,加速度计采用差分输出。由于惯性器件安装在一个密闭的容器中,受温度影响也比较大,必须采集温度信号对惯性器件进行补偿。A/D转换电路采用TI公司的A/D芯片ADS1258,ADS1258是一个灵活的、24位低噪声最优化的、快速的、多通道的、高分辨率的模拟/数字转换芯片。24位的精度是0.000 000 06,其理论值较16位A/D有较大的提高。根据芯片资料,ADS1258中的转换器可以提供最大23.7ksample/s的通道扫描速度,可以在<700μs的时间里完成一个完整的16通道扫描。模拟电压输入范围为±2.5V。
数据采集部分的功能之一是将加速度计和陀螺仪输出的模拟信号转换为数字信号,并将这一数字信号送入导航计算机。为提高系统的精度,在A/D转换前要先将加速度计和陀螺仪输出的信号进行放大,通过减法电路和低通滤波电路进行调理,然后再通过FPGA控制AD1258进行转换。读取转换数据,利用FPGA内部逻辑设计FIR数字滤波器,将处理后的数据送入FPGA内部的双口RAM,向主CPU发出数据准备好中断。这些由FPGA控制,保证了PC104实时处理和接收到的数据。用FPGA这种纯硬件结构实现的数据采集系统比用MCU等器件用软件控制的数据采集系统速度快,且容易修改。



采集模块的另一个功能是进行GPS数据采集。GPS输出经度、纬度和速度等信息。设计采用Jupitre21 GPS OEM模块,体积小、重量轻、功耗低,首次定位和重新捕获时间短,具有强大的抗干扰、抗遮挡能力。OEM板的输入、输出格式均按RS232串口通信协议,设定为8个数据位,1个起始位,1个停止位,无奇偶校验。GPS接收机数据输出通过RS-232串行口,它信号输出的频率比较低,大约每秒更新一次,接收的数据要完成解码才能用于组合系统的修正。本系统用FPGA实现RS232接口,用于接收GPS的数据。[page]

2.2 导航解算模块
导航解算模块是捷联惯性组合导航系统的核心。该部分的功能主要完成姿态矩阵的即时修正、位置姿态信息的求取和卡尔曼滤波等运算。要求导航计算机对浮点数据的处理能力强,并且整个导航计算中涉及大量的矩阵计算,运算量较大。PC104采用中断机制工作,需要处理FPGA数据准备好中断请求、导航计算、滤波计算。
2.3 FPGA和PC104之间的通信
设计采用两个控制器结构,PC104要进行导航解算,就要将FPGA采集处理后的数据接收。若通过FIFO来传递数据,由于FIFO的先进先出原则,则存在一个采用频率和解算速率的配合问题。而系统又要求较好的实时性,即每次要进行解算都能立即得到最新的实时数据。双口RAM方式无论是通信速率还是硬件实现的难易程度上都是处理器问高速通信的最佳选择。系统采用双口RAM实现FPGA和PC104之间的数据共享。



双口RAM存储器具有两套独立的读写控制线、地址线和数据线。可以自由访问,互不干扰。用FPGA实现双口RAM的功能可以较好地解决并行性和速度问题,而且其灵活的可配置特性使得基于FPGA的双口RAM易于进行修改、测试及系统升级,可降低设计成本,缩短开发周期,减小了导航计算机的体积。因此本设计直接采用FPGA构建双口RAM,同时进行读写操作控制。PC104总线上的I/O地址范围为0000H~FFFFH,选取地址段0200H~027FH作为双口RAM的地址段,共128个地址单元。FPGA与PC104引脚电平不同,FPGA的I/O口供电电压为3.3 V,PC104的总线为5 V TTL电平。因此,为使系统安全稳定地工作,需要一个电平转换器件。在PC104和FPGA之间使用起电平转换作用的CPLD,同时由它产生地址译码电路。###反应###

3 软件设计
软件设计以满足导航参数解算为主,采集模拟的惯性测量器件及GPS数据,通过双CPU之间的软硬件形成呼叫和应答机制。由FPGA负责加速度计和陀螺仪输出信息的采集及数据处理,采用FPGA接收读取GPS的数据;PC/104工控机负责对FPGA采集到的数据进行解算。对控制采样及数据处理模块的软件设计主要是控制A/D转换,构建内部存储器、数字滤波器和串行接口等,采用硬件描述语言Verilog HDL。组合系统的解算由PC104完成,对PC104的软件设计采用C语言在DOS系统下在Turbo C中编写,导航解算应有不同的解算周期。因此,导航计算机系统软件设计分为FPGA软件和PC/104主控系统软件两部分。


3.1 FPGA软件设计
FPGA是按照主CPU的指令来执行对加速度计的数据采集和数据处理任务,然后将预处理的结果写入双端口RAM,供PC/104使用。FPGA内部的逻辑块包括时钟、A/D控制器、数字滤波器、双口RAM、接口单元等。数字滤波器的设计直接采用设计好的FIR滤波器的IP核。通过Verilog HDL语言对双口RAM的描述可以在FPGA内部实现双口RAM,并且进行读写控制。双口RAM在使用上需要注意的问题就是,可能会发生共享冲突,出现写入值和读出值出现混乱的状态。设计采用文献的方法设计双口RAM冲突解决方案。


在FPGA内部实现一个串口模块,采用GPS接收机默认的4 800 bit·s-1,首先将系统的40 MHz时钟进行分频,一般对数据进行过采样,以便正确接收GPS接收机的数据。取过采样频率为波特率的8倍。有了4 800×8 Hz的频率之后,进行串并转换。为防止毛刺信号被误认为是起始信号,定义一个2位的计数器进行判断起始位4次。接着用状态机实现对起始位、数据和停止位的检测,就可进行数据的接收。通过Verilog HDL语言编写接收GPS数据程序,采用状态机方法检测GPS数据起始符,本系统采用$GPRMC,(UTC时间),A,(纬度信息),N,(经度信息),E,(速度信息),289.0,020710,10.3,W×5B协议,本系统只用位置和速度信息对捷联惯导系统进行校正。接收到的GPS数据为对应ASCII值的二进制数。



3.2 PC104软件设计
数据解算采用PC104为核心处理器。采集的陀螺和加速度计的信息经过误差补偿后,将陀螺仪测量的角速度数据进行解算,得到姿态矩阵,再用姿态矩阵将沿载体坐标系的加速度测量的比力信息转换到导航坐标系上,进行积分运算,同时根据姿态矩阵中的元素可以解算出姿态角信息。再用GPS测量得到的位置、速度信息和捷联惯导系统解算得到的位置、速度的差值作为观测量,通过卡尔曼滤波,修正导航系统的参数,为惯性元件提供误差修正,以提高导航精度。将得到的位置、速度、姿态等信息输出,进行控制载体。PC104对双口RAM的端口地址读/写操作的函数为inport(int protid)和outport(int portid,int value),protid为端口地址,value为要发送数据。

4 结束语
文中以PC104为核心处理器,辅以FPGA控制采集和A/D转换,形成双CPU协作模式,通过双口RAM进行通信,主CPU可以专心进行导航计算,避免了因数据采集工作而降低效率。双CPU并行工作,相互配合,大大地提高了系统的整体效率。系统体积小、精度高、结构简单、功耗小。将导航参数通过串口输出,可应用于船舶、车辆、飞机等,能满足导航和定位的要求。

关键字:惯性组合导航系统  汽车导航 引用地址:捷联惯性组合导航系统的工程设计

上一篇:英飞凌车门模块的驱动策略综述
下一篇:热建模设计应对汽车电子散热三大挑战

推荐阅读最新更新时间:2024-05-02 23:02

智能交通实现平安出行,无线电管理大有可为
  千里之行,始于交通。交通是经济的命脉,我们每天都得和各种交通工具打交道,交通安全事关重大。在对工业和信息化部无线电管理局局长谢飞波的采访时,谢飞波说,无线电技术为保障人们的出行安全、提高交通系统的运行效率发挥着越来越重要的作用。在公路交通方面,包括不停车收费、雷达交通流量监测、交通路况信息采集、汽车导航定位等在内的无线电应用,使汽车行驶更加畅通高效。在轨道交通方面,列车无线调度通信、车辆车号自动识别系统、安全监护和防护、列车运行控制系统等无线电应用和系统,保障着包括高铁在内的列车的安全行驶。   排查GSM-R频段干扰,护航高铁   对铁路无线电专用频率,尤其是GSM-R频段,必须加快完善保护标准、规范和机制。   经过近
[嵌入式]
智能交通实现平安出行,无线电管理大有可为
汽车导航系统的DC/DC转换器选择指南
汽车环境的宽工作电压要求、大瞬变电压以及大温度漂移等因素共同作用下,电子系统面临着严酷的条件,本文介绍如何在性能要求变得愈加苛刻的条件下,设计多个电源电压以满足汽车电子系统不同部分的要求。  目前生产的大多数中高档汽车都配置了基于DVD的GPS导航系统作为标准设备(图1)。然而可以证实,如果想设计一个用于控制此类系统内不同电压轨的电源,其复杂程度丝毫不亚于设计笔记本电脑用的电源系统。一个标准的汽车导航系统有可能具有6个或更多的电源,包括8V、5V、3.3V、2.5V、1.5V和1.2V。8V电源用于给使光盘旋转的DVD电机供电;这常常需要高达2A的峰值电流。5V和3.3V电源轨通常为系统总线,一般要求各提供2A~3A的电流。2.
[嵌入式]
数字广播技术和汽车信息娱乐及导航解决方案
  数字广播技术   三大国际地面数字广播标准:   1. DAB/DMB   2. DRM   3. HD Radio   DAB(数字音频广播标准)被许多国家特别是欧洲国家的广播系统所采用,在市面上可供挑选的DAB收音机非常多。除无失真接收和CD级音质外,DAB的音频编码标准还允许用同一发射机发射多个数字广播和视频信道。目前全球有5亿多用户接收近1000个不同的DAB广播节目。   数字多媒体广播( DMB)是从DAB演化出来的,使用现有的DAB基础设施广播节目。DMB标准允许在同一频谱范围内提高频道的数量,并提供像数据和视频文件传输等新服务,第一个商用DMB已经在韩国开播,欧洲正在进行DMB试播。   DRM(世界数字广播)
[嵌入式]
当无人驾驶颠覆汽车行业,导航巨头TomTom如何自救?
对于大多数人而言,TomTom几乎就是车载卫星导航设备的代名词。但实际上,这家荷兰地图制作公司正在建立丰富的导航数据库和高清地图,以应对未来联网无人驾驶汽车的竞争。 尽管TomTom在用户中的影响力比不上谷歌地图,但它也为许多日常服务提供支持,包括Uber和和苹果地图。微软也使用了TomTom来支持自己的Azure、必应地图和Cortana等服务。 为了支持庞大的联网车以及移动服务,这家公司的合作对象中包括了不少大名鼎鼎的企业。上个月TomTom和微软以及公共交通数据平台Moovit建立了合作,将汇聚三方的资源为开发人员创建一个多模态的交通平台,这其中就利用到了TomTom的行车和停车的实时数据。在过去的一周里,TomTom宣布和
[机器人]
采用多种新技术更新汽车导航电子地图数据
        从卫星成像到绘制地图的增值网络,新技术和策略的及时完善,确保了汽车导航系统的精度。          在短短的几年前,汽车导航系统已经从罕见的豪华车选项演变为大多数车辆中的主流功能,其速度之快超过了以往任何时候。对于OEM来说,车载导航是一种高利润的汽车电子产品,它能够增强驾驶体验、促销更多的汽车并有提高驾驶安全性。          目前,全球售出的所有新车中,6%以上配备了工厂预装的导航系统。随着这些设备的功能和复杂性的增加,各种形状和类型的车载导航系统将有可能成为未来几年出售的大多数车辆中几乎标准的功能。 市场面临的挑战          然而,尽管汽车导航系统呈现快速普及之势,但是,随着市场的持续成熟,其
[嵌入式]
博世展示一套类似汽车导航的自动驾驶系统
据外媒cnet报道,很快,汽车就能在公路上行驶很长一段路,但是当汽车需要人类驾驶者接管的时候将会发生什么呢?日前,一场由博世资助的活动在德国举行,这家汽车设备供应商展示了一种与当前汽车导航系统相类似的解决方案。Cnet记者在活动上试乘了一辆经过改装过的特斯拉Model S。 当时,他坐在了副驾驶的位置,驾驶室则由博世的测试驾驶员控制。在汽车靠近自动驾驶区域的过程中,中控显示屏则会开始自动驾驶距离的倒计时。一旦进入自动驾驶区域,驾驶者只需按下方向盘上的两个按钮即可让汽车自主驾驶。 而当汽车即将驶出自动驾驶区域之前,中控显示屏又开始距离倒计时。当需要人类驾驶者重新控制汽车之前,屏幕则会跳出警告信息并发出警报。 汽车的这种能力代
[汽车电子]
年底总结:汽车导航市场的发展趋势和走向
  车载信息娱乐市场正在发生着一些细微的变化,导航设备的增幅速度已经超过了汽车音响的增长。GPS应用在经历了军用、仪表导航到便携导航(PND)后将开始分化,一是走向手机等移动网络设备提供定位服务,另一个方向是瞄准了汽车应用,例如C2C(车对车的信息交流)、C2I和ADAS(先进驾驶辅助系统)等。    汽车导航市场中,根据ST公司的估计,2008年PND的出货量同比将增长43%,从2007年的3200万件增长到4600万件。主要增长动力依然来自车载导航市场的低于水准的普及率,对市场的教育和推广的力度依然不够。低成本的OEM导航仪(两用便携导航仪)将会在中级汽车中开辟新的市场,预计到2012年在欧美新售的汽车中,车载导航仪占有率
[汽车电子]
博世开发9D传感器项目 可应用于汽车导航
随着微电子机械传感器(Micro-electromechanical sensors,MEMS)在生活中特别是汽车中的普及率越来越高,使我们能够用更智慧、更简单、更灵活的方式使用电子设备。智能传感器系统中涌现出大量的全新应用嵌入到各式各样的电子消费品和汽车安全技术产品中。但随之而来的问题就是产品的成本、尺寸、质量能否跟上电子产品快速发展的脚步。 博世(Bosch)将与德国联邦教育与研究部(BMBF)和罗伯特博世公司合作开发一项名为“9D传感器”的项目,旨在开发出一款紧凑、低成本、高效且自主的多传感器系统。 9D传感器系统将包含三轴加速计、三轴陀螺仪和三轴磁强计,提供9个方位的自由度。此外,系统中还将包括一个能量供应单元、一块薄膜电
[汽车电子]
小广播
最新嵌入式文章
何立民专栏 单片机及嵌入式宝典

北京航空航天大学教授,20余年来致力于单片机与嵌入式系统推广工作。

换一换 更多 相关热搜器件
随便看看
电子工程世界版权所有 京B2-20211791 京ICP备10001474号-1 电信业务审批[2006]字第258号函 京公网安备 11010802033920号 Copyright © 2005-2024 EEWORLD.com.cn, Inc. All rights reserved