提高IMU的精度和速度的硬件设计和程序优化

来源 :今日财富 | 被引量 : 0次 | 上传用户:BBQChris
下载到本地 , 更方便阅读
声明 : 本文档内容版权归属内容提供方 , 如果您对本文有版权争议 , 可与客服联系进行内容授权或下架
论文部分内容阅读
  【摘要】在导航系统中,惯性测量组件(IMU)的精度和速度严重影响到导航计算机的性能。为了提高IMU系统的精度和速度,提出了在硬件方面采用高速AD转换器和DSP,同时在程序中采用了基于LD分解的Kalman滤波技术,并采用线性汇编语言对滤波程序进行了优化。系统的可靠性和速度得到很大的提高。
  【关键词】IMU DSP Kalman滤波 线性汇编语言
  【中图分类号】TP314 【文献标识码】A 【文章编号】1009-8585(2011)01-00-03
  
  1 引言
  捷联惯性测量组件(IMU)在捷联导航系统中所起的作用是相当重要的,其误差参数标定的准确性以及速度直接影响着导航精度。载体的导航信息包括角速度和加速度,当这种导航信息发生变化时,陀螺仪和加速度计就会检测到这种变化量,并进行相关的转化,最后以脉冲数大小的形式来表示这种变化量的大小。数据采集卡就是用于在采样时间内统计脉冲的数目,并利用预先测定的标度因子进行解算处理,进而得出直观的导航信息。因而,这里对采集卡速度和精度就有较高的要求。然而,随着对IMU体积的要求,仅仅依靠硬件电路的设计来提高系统的速度和精度已经难以达到要求,这就需要改进算法程序。
  2 系统硬件电路
  本系统主要采用了三个陀螺和三个加速度计、高速AD器件和核心处理器DSP。由于需要采集六路模拟量,而系统空间有限以及节省硬件开销,故需要对输入的信号进行依次选通,最后当所有的数据都采集完毕以后,再对数据进行补偿处理,其基本框图如图1所示:
  为了提高系统的速度,本系统采用了高速AD器件ADS5521和高性能核心处理器件TMS320C6713。ADS5521是一种高性能12位模数转换器,它的采样速度可以达到105MSPS,仅采用3.3V单电源供电,并且是内置参考电压。TMS320C6713芯片的关键性能特点是:最高可达225MHz的时钟频率;264K的在上数据存储器,存储资源足够大;凭借超常指令字结构和二级高速缓存,DSP的性能可达2400MIPS,最大1800MFLOPS,速度非常快;
  该系统采用这两种芯片,在很大程度上可以提高系统的速度,但是系统的运行程序也会影响整个IMU的速度和精度,因此必须充分考虑程序的执行时间和效率。
  3 系统软件设计以及优化
  DSP程序是系统进行数据处理的核心模块。根据AD输入的陀螺和加速度计信号进行误差补偿,然后转化为RS422形式并发送给外部设备。整个系统根据功能要求主要分为两个模块:引导程序bootloader模块和用户程序模块。
  软件结构如图2所示。
  引导程序Boot模块:DSP的系统引导装载(Boot)是指在系统加电时,由DSP将一段存储在外部非易失存储器中的代码移植到高速存储器单元中执行。引导程序负责将中断向量表和用户代码段从片外FLASH移植到其它高速存储器中。
  用户程序模块:首先数据采集程序采集陀螺和加速度计的数据,然后对陀螺和加速度计的数据进行误差补偿处理,最后将补偿后的数据通过RS422发送程序发送到系统的外部。参见图3。
  程序中最消耗时间的是数据处理程序中的误差补偿部分,在补偿滤波程序中,为了防止发散,我们采用了LD分解的Kalman滤波技术,该技术的应用同时也提高的系统的精度。但是,该方法不仅增加了代码的长度,而且消耗了大量的时间,因此要对次部分程序做大量的优化工作。
  3.1 利用编辑器选项优化
  C6000的C优化器是TI 公司的一个创新,它对程序循环的流水处理使得C代码的效率得到很大的提高,,只要在编译时加入优化项即可。
  使用-mt编译选项,使用此选项是函数在参数传递过程中,C编译器会假设存储器关联消除,从而能够更好的优化。该系统中采用最高级别的优化选项进行编译: cl6x-o3-pm file.c-z。
  3.2 采用C程序和汇编程序混合编程
  混合编程的一般方法有三种:一是对C程序编译后形成的汇编程序进行手工的修改与优化。二是直接在C语言程序中嵌入汇编语句。三是分别编写C程序和汇编程序,再独立编译成目标代码模块,再进行链接。第三种方式是混合编程最常用的方式之一,也是我们系统采用的方式。在这种方式下,C程序与汇编程序均可使用另一方定义的函数与变量。
  变量定义的规则与数组、指针的使用变量定义是混合编程的基本问题。C程序与汇编程序定义的变量相互之间可以进行访问。在汇编程序中定义时,需要在变量前加下划线“_”,然后再用.global定义为全局变量,在C程序中则需要说明为extern变量。
  以下程序是为了完成LD分解的Kalman滤波的线性汇编程序而编写的部分程序:
  程序1:矩阵乘法
  线性汇编程序
  
  .global _mpyMatix
  _ mpyMatrix:
   .cproc a,b,c,n
   .reg l_out,l_mid,l_in,i,j,sum,k,
   v1,v2,v11,v21,v12,a_i,b_i,c_i
   MV n,l_out
   ZEROi
  outloop: ZERO j
   MV n,l_mid
  midloop: ZEROsum
   ZEROk
   MV n,l_in
  inloop:MPY i,n,v1
   MPY k,n,v2
   ADDv1,k,v11
   ADDv2,j,v21
   ADDv1,j,v12
   LDW*+a[v11],a_i
   LDW*+b[v21],b_i
   MPYa_i,b_i,c_i
   ADDsum,c_i,sum
   ADDk,1,k
  [l_in] SUBl_in,1,l_in
  [l_in] B inloop
   STWsum,*+c[v12]
   ADDj,1,j
  [l_mid]SUBl_mid,1,l_mid
  [l_mid]B midloop
   ADDi,1,i
  [l_out]SUBl_out,1,l_out
  [l_out]B outloop
  .endproc
  C程序中的声明和调用
  double mpyMatix(double *a, double *b, double *c,int n);
  mpyMatix (&a[0][0],&b[0][0],&c[0][0],n);
  程序2:LD分解
  .global _LDdis
  _LDdis:
  .eproc n,pmatrix,lmatrix,dmatrix
   .reg i,j,k,m_loop1,m_loop2,m_loop3,
  m_loop4, sum1,constant1,constant2, v1,v2,v3,
  v, x,x1,y
  ZERO i
   MVn,m_loop1
  Loop1:MPYn,i,x
   ADDx,i,x
   MVK1,constant1
   STWconstant1,*+lmatrix[x]
   ADDi,1,i
  [m_loop1] SUBm_loop1,1,m_loop1
  [m_loop1] B loop1
   LDW*+pmatrix[0],x
   STWx,*+dmatrix[0]
  MVn,m_loop2
   SUBm_loop2,1,m_loop2
   MVconstant1,i
   RCPDP x,constant2
  Loop2:MPYn,i,x
   LDW*+pmatrix[x],v1
   MPYv1,constant2,v2
   STWv2,*+lmatrix[x]
   ADDi,1,i
  [m_loop2] SUBm_loop2,1,m_loop2
  [m_loop2] B loop2
  MVn,m_loop3
  SUBm_loop3,1,m_loop3
  MVK 1,j
  Loop3: MPYj,n,x1
  MPYk,n,y
  ZERO sum1
  ZERO k
  MVj,m_loop4
  Loop4: ADDx1,k,x
  ADDy,k,y
  LDW*+lmatrix[x],v1
  LDW*+dmatrix[y],v2
  MPYv1,v2,v
  MPYv,v1,v
  ADDsum1,v,sum1
  ADDk,1,k
  [m_loop4]SUBm_loop4,1,m_loop4
  [m_loop4]B m_loop4
  ADDx1,j,x1
  LDW*+pmatrix[x1],v3
  SUBv3,sum1,v3
  STWv3,*+pmatix[x1]
  ADDj,1,j
  [m_loop3]SUBm_loop3,1,m_loop3
  [m_loop3]B loop3
  …
  …
  由于空间有限,只列写了一部分该程序。
  4 结论
  本系统在硬件电路上采用了高速AD器件和DSP芯片,同时在程序设计上也采取了适当的优化措施,对于消耗时间比较长的误差处理补偿程序,采用了线性汇编语言编写,虽然增加了代码的长度,但是却大大提高了系统的时间。
  参考文献
  [1] 裴听国,李汉舟.全数字IMU方案[J].中国惯性技术学报.2003.12:69-83.
  [2] 李璞,蔡同英.捷联测量装置的数据采集技术[J].应用科技.2004.4:48-50.
  [3] 阳明晔, 张志勇. 基于TMS320C6000系列DSP的C代码优化方法研究[J].微处理机.2004.4:59-64.
  [4] 张淑艳,刘伟宁.TIC6200系列DSP代码优化技术研究[J].计算机工程.2006.1:82-86.
  [5] 李方慧,王飞等.TMS320C600系列DSPs原理与应用[M].北京:电子工业出版社.2003.197-314.
其他文献
【摘要】实施人才强企战略,加强人才队伍建设,是事关企业生存发展的大计,是企业贯彻以人为本,全面协调可持续的科学发展观的重要体现,要建立健全人才的选拔、培养、使用和激励机制。  【关键词】企业 人才 战略  【中图分类号】C962【文献标识码】A【文章编号】1009-8585(2011)01-00-02    在市场经济条件下,企业要接受市场竞争的挑战和考验,并在市场竞争中生存和发展。这种竞争表面上
期刊
【摘要】本文从工学结合的概念与理论依据出发,分析了当前我国酒店管理行业人才需求状况和高职酒店管理专业建设存在的问题,在此基础上,提出了工学结合模式下高职酒店管理专业建设的对策与途径。  【关键词】工学结合 人才培养模式 酒店管理  【中图分类号】C45【文献标识码】A【文章编号】1009-8585(2011)01-00-03    高等职业教育培养的是技能型人才,这类人才的知识与技能的获得仅仅依靠
期刊
【摘要】管理学的无数案例表明,一个企业的成功经营不仅仅取决于它所拥有的资源多寡,在很大程度上是与其员工的工作积极性(士气)密不可分的。这不单单是表现在一个企业成功运作的时候需要员工高昂的工作积极性,还表现在当一个企业面临严峻挑战的时候,员工的团结一致和努力工作往往可以使企业转危为安。作为管理企业来说,目前正面临着这样或那样的严峻挑战,既然员工的工作积极性对企业来说如此重要,那么我们应该如何提升工作
期刊
【摘要】我国加入WTO以来,国家经济包括石化行业已日渐融入经济全球化之中。为应对挑战、加快发展,中石化集团公司和胜利石油管理局改革与发展的力度越来越大,对社区补贴逐年下调,2005年零补贴期限日渐临近,作为从事油田社会服务业的社区管理中心,按照“企业化经营、专业化管理、社会化服务”的发展方向,走“自主经营、自负盈亏、自我发展、自我约束”的道路,已是大势所趋。本文试析物业管理的宗旨,融管理、服务、经
期刊
【摘要】随着中央八部委《关于城镇医疗卫生体制改革的指导意见》的出台,标志着城市医疗系统需要在体制上进行较大的变革,整合出一批具有一流水准,极富竞争力的医院和医疗集团,满足人们日益增长的医疗需求。作为占据卫生资源80%的城市医院改革将直接影响到卫生体制改革的成败。为此,先进城市就如何进行功能定位和如何适应新形势的经营策略,探索出了新的方法。  【关键词】经营 社区 医院 城市  【中图分类号】R19
期刊
【摘要】随着我国高等职业教育的迅速发展,高职院校人才培养工作越来越受到社会的广泛关注。作为高职院教师,怎么样才能培养出更多高质量的人才,怎样才能让学生学以致用,在人才高度受重视、网络高速发展的今天,如何有效地利用现代化技术进一步提高教学质量,将是一个关键所在。笔者通过三年来的实践探索,提出了把论坛运用在教学中的若干看法。  【关键词】高等职业教育 教学 网络 论坛 教师  【中图分类号】C41【文
期刊
【摘要】数据挖掘旨在发现数据库中潜在的、人们感兴趣的关系及特征。本文基于基本理论以及概念探索其实践意义。  【关键词】数据库 数据挖掘 管理  【中图分类号】TP311.13【文献标识码】A【文章编号】1009-8585(2011)01-00-02    1 什么是数据库  所谓数据库是指:以同一组织方式将相关数据组织在一起,并存放在计算机存储器上的,能够为多个用户所共享,与应用程序彼此相互独立的
期刊
【摘要】社会实践是正确的理论产生实效性的基础和源泉,大学生社会实践教育,是思想政治理论课教学的重要环节,也是当代大学生思想道德教育的有效方式和重要手段。然而,时下通行的社会实践教育模式与大学生学习生活存在着“代沟”,严重影响着思想政治教育的效果。为了改变这一现状,笔者认为构建大学生社会实践教育社区化模式是重要举措之一。  【关键词】社会实践教育 社区化模式 社区化模式意义  【中图分类号】G42【
期刊
【摘要】在油田开发的历史上,按照地上服从地下的原则,职工的生活区主要依据生产的需要进行建设,随着形势的发展,部分相对偏远的居民区因生活不便居民逐步外迁,向城市中心地带靠拢,形成了资产闲置。充分利用这些闲置资产,使其继续在油田发展中发挥积极作用,是一个迫切需要解决的课题。稻香村闲置资产的再利用给我们提供了有益的借鉴。  【关键词】闲置资产 稻香村 资源管理  【中图分类号】X37【文献标识码】A【文
期刊
【摘要】历来群众工作是我们党的根本政治路线和组织路线,重视做好群众工作是我们党的一大政治优势,也是我们群众路线取得一切胜利的重要法宝。在任何时候任何情况下,加强群众工作都必须作为党建设的突出重点和重要任务。  【关键词】群众工作 新时期 党建  【中图分类号】G24【文献标识码】A【文章编号】1009-8585(2011)01-00-02    党的十六大报告指出,“推进党的作风建设,核心是保持党
期刊