车载捷联惯导系统定位测姿算法研究

车载捷联惯导系统定位测姿算法研究
车载捷联惯导系统定位测姿算法研究

第15卷第l期2007年2月

中国惯性技术学报

JoumalofChineseInertialTcchnology

Vbl.15No.1

Feb.2007

文章编号:1005-6734(2007)01一0024-04

车载捷联惯导系统定位测姿算法研究

陈允芳1,叶泽田2,钟若飞3

(1.山东科技大学地球信息科学与工程学院,青岛266510;2.中国测绘科学研究院,北京100039;

3.首都师范大学,北京100037)

摘要:GPs/INs组合精确测定平台的位置和姿态是移动测图系统中的重要模块。对陀螺仪和加速度计所测角速度和比力进行两次积分得载体姿态、速度和位置即sINs力学机械编排。目前该过程大多在地理坐标系进行。

这里详细推导了地球坐标系中完整的解算过程,以四元数姿态矩阵更新及重力计算为核心,由IMu原始观测值解算出了载体位置、速度和姿态等参数,可快速高效与GPs输出的位置速度信息进行组合滤波处理,可据此编程进行工程应用数据处理。

关键词:捷联惯导系统;姿态矩阵;坐标转换;力学编排;四元数

中图分类号:u666.1文献标识码:A

PositioningandorientationcomputationonVehicle-borne

SINSanddiscussofcalculationerror

cHENYun.‰91,YEze-tian2,zHONGRuo.fei3

(1.Geo?info衄ationScience&EngineeringCollege,ShandongUniverSi哆ofScienceaIldTbchnology,Qingdao

266510,China;2.SurveyingaTldMappingScienceResearchInStituteofChina,Beijing100039,China;3.C印ital

NomlalUniverSi劬Beijing100037,China)

Abstract:GPSandINSintegratedtoaccuratelydeteminingpositionaIldattitudeofnatI‘oofisVitalmoduleinmobilemappingSystem.Specincforcc行omspeedometer蚰d舭glerate矗om留roareinte铲atedtwicerespectiVelytoachievean沁de,veloc时aIldpositionn锄elySINSmechaIlization.Currentlythistookplacedingeogr印hiccoordinate,whiIeheredemonstratedindetailmewholemechaJlizationineanll-centclrcdearth-fixedcoordinate,mostlyquatemiona钍itudematrixupdating锄dgravit)rcaIculation.Ultimatelyvehiclenavigationpar锄eterssuchaSattitude,veIocity锄dpositionwercgahed丘omIMUorigin“0bservations.Mathematicsplatfo眦isfomlcdinSrNStocarryoutsuⅣeyingaJldcalculatingpreciselythenavigationmoVement

par锄cterS.Theresultsarcpronetointe黟atewitllsimilarpammeters疔omGPStofilterprocessing.Pro可锄minghercbyc锄pmcessdatainengineeringapplication

Keywords:SINS;attitudematrix;coordinatetransfomation;mechanization;quatemion

随着惯性技术与卫星导航定位技术的发展,由GPS/INs不同程度组合而成的定位定姿传感器已成为移动测图系统中确定载体轨迹和平台姿态的重要工具,其中GPs多用于定位而INS则用于测姿。捷联惯导系统(sINs)是将惯性仪表直接固联在载体上而无须采用机械陀螺稳定平台,通过导航计算机中相应程序建立“数学的”陀螺稳定平台,即计算机处理测量值得到载体位置、速度和运动方向估计值以实现导航平台功能。尽管sINS于20世纪50年代即在美国获得专利,但因受限于惯性设备和计算机技术的发展而一直未能实用。近年来,电子和高速计算机技术的发展使得捷联技术得以实现和充分发展,这是惯性技术在近20年内发展的一个重要的标志。

INS的核心部件是惯性测量单元(IMU),按照其陀螺仪和加速计等元件的精度,可将惯导分为不同等级:战略级(<0.000l(o)/}l,l岖)、导航级(0:000l~0.015)(o)/Il,5~100嵋)、低成本((1~10(。冲,(0.1~1)n培)。考虑到惯性设备出口管制政策及需求与成本等问题,民用INs精度范围一般为低成本级别。

收稿日期:2006—06—16;修回日期:2006—12—22

基金项目:国家863基金课题(2006AAl22324);教育部三维信息获取与应用重点实验室开放基金

作者简介:陈允芳(1977一),女,博士生,讲师,主要从事移动测图与组合导航。

25陈允芳等:车载捷联惯导系统定位测姿算法研究第1期1惯性导航初始对准

因INs系统属航位推算系统(DR,DeadReckoning),它是依赖于前一时刻导航参数估计值的递推更新运算,故位置、速度和姿态等初始导航参数等信息是准确进行解算的基础。惯导系统初始化包括给定初始速度和位置、惯导平台初始对准、陀螺仪测漂定标等。重点是确定INs的初始姿态矩阵,水平对准可由加速度计的量测输出获得水平方位,即俯仰角和横滚角来实现,但因低成本IMu的陀螺仪精度不足以感受地球自转角速率,无法获得航向信息,只能引入外部航向信息,如利用GPS所测速度进行匹配对准,或引入其它方位测量方法,如磁航向或双天线GPs定向系统等来获得初始航向信息。为得到较高精度初始姿态数据,本研究中水平对准由倾角仪提供横滚角和俯仰角来完成,方位对准采用vEcTOR航向测量系统实现,其2m基线方位精度可达O.10(RMS),足以满足方位对准的精度要求。由此可获取三个初始姿态角。可利用卡尔曼滤波对平台误差角进行估计出并校正系统,使载体坐标系与导航坐标系对准f51。对低成本INS,一般需要进行动基座对准”1。

2地球坐标系力学编排

本研究所用IMu的陀螺仪和加速计分辨率分别为0.0006(。)/s和O.15m毋属低成本精度级别INS。它包括三个FOGs陀螺(测量角速率)和三个iMEMS加速度计(测量比力),将陀螺仪和加速度计输出信息进行捷联姿态解算,即可求得运动载体不断变化的姿态角及速度、位移增量。

2.1导航坐标系及导航方程

因陀螺仪敏感的是相对于惯性空间的运动,而要测量的是载体相对于某个参照系的运动,故必须进行坐标变换。此外,加速度计所测加速度输出信号中往往包含重力加速度分量和有害加速度分量,必须对重力加速度分量进行修正,对有害加速度分量进行补偿,然后经过积分运算得到运载体的速度和所在的地理位置。

惯性导航的基础是精确定义的一系列右手参考坐标系,较常用的是惯性坐标系(j系)、地球坐标系(e系)、地理坐标系(n系)、载体坐标系(b系)及计算坐标系(k系)等,详细定义参见文献【3】。如图1所示,其中e和n系都三轴

定义为东北天方向,b系三轴定义为右前天方向。

下面重点考虑k系的合理选取问题。工程应用中,常选取e、n坐标系中的任一系作为k。若选取n系,计算时可直接输出地理坐标(五,仍办)和运行姿态,且重力计算模型简单,但因n系本身随载体运动而旋转,需要附加大量计算工作来补偿由此产生的影响,且须不断进行e系和n系间的坐标转换,即将n系的INS导航结果转换到e系中,或将e系中的GPS定位测速结果转换到n系中,此频繁转换势必影响计算精度;在e系计算时,e系本身不随载体运动变化,计算过程及公式简单,可直接获三鼓二豫妄孕地理坐标系

图l各坐标系示意图

F培1CoordinatesSketchMap

得载体在地心直角坐标系(如wGS84)中的三维直角坐标(置y,z),直接用于修正INs,适合与GPs数据进行组合处理,且省去了反复的坐标变换,程序更简洁和模块化,导航计算精度也较n系稍优,但正常重力计算模型和姿态角的提取计算较复杂。考虑到要用GPs,INS进行组合导航,而GPS定位是在e系进行,故本文选e系作为计算坐标系【1】【31。

导航方程可从任何坐标系导出,不同坐标系导航方程会有不同形式。选e系后,根据牛顿第二定律和科里奥里定律,载体相对于b系的速度变化可由惯性轴系的速度变化来表示,载体相对于地球的加速度由三部分加速度组成哺1:

壬Kl。=茂,t《×y。+g。

,6为加速度计所得比力加速度,∞:×y。为科里奥里加速度,g。是e系表示的正常重力。因GPs观测量、引力常量都是e系的值,由上式可推得e系表示的SINS导航方程“¨”:

『,。¨y。]

.Y‘=l矿。}=l群,。一2球y。+窖。I

I农lⅨ(蹴一球)

其中,,。=《厂6即转化至e系后的比力值。上述方程又称为INS力学(或机械)编排,它描述了待求导航信息与各观测量间的数学关系,其中比力和角速度是动态系统输入的观测值,位置、速度及姿态信息是状态变量。注意,上标(如b)表示向量各分量所对应的坐标系,下标ib则代表b系相对于i系的旋转,

2007年2月中国惯性技术学报262.2地固坐标系力学编排过程

slNs姿态解算中,载体的姿态和航向通常描述的是b系和n系之间的方位关系,故将b系和n系间坐标变换矩阵称为姿态矩阵,姿态矩阵解算是smS姿态解算的核心内容。由刚体定点转动理论,解算姿态矩阵的方法有【6】:欧拉角法(三参数法),四元数法(四参数法),方向余弦法(九参数法)。这里选用四元数积分法。

sINs力学编排即利用陀螺仪所得旋转角速度计算出b系至e系坐标变换矩阵;利用该矩阵将所测比力变换至e系并两次积分得速度增量。计算分两个环路:1)角速

度积分环路:将测得的b系对i系的旋转角速度,

减去e系对i系的地球自转角速度,得所需的b系

对e系的旋转角速度;利用该角速度按四元数积分

法修正b系至e系坐标变换矩阵。2)加速度积分

环路:用上述所得坐标变换矩阵,将比力观测值转

换至e系,并从中补偿掉重力加速度和科里奥里加

速度;对转换并补偿后所得比力值进行两次积分可

得位置增量,由此可提取出载体的姿态速度与位置

信息。如图2所示,具体解算步骤如下:1)姿态矩阵计算

图2捷联力学编排计算流程

Fig.2SINSmechanizationnowchart

的旋转角增量△础(硪△f)。首先将角速度础转换至e系破:

站=磷一硅=醚一砖蜕,△皑=砖△户[△砖△砖△醴焉

采样时间△f内转角△破的模:△p=抓压万彳话万F研,其中成=[ooq。】7为地球自转角速度向量,戤=(乓)一1对四元数Q=【q。g?qzq,】有:垂:昙D.Q,Q为角速度哦的反对称矩阵,小采样间隔△f内哦看作常值,令

Q(f+∽:∞。等“竺学趴鳓)

即在初始时刻四元数Q(f)基础上,由采样时间内旋转角速度增量比可算得下一时刻四元数Q(f+△f)。

四元数Q和坐标变换矩阵域有:霹=j2(吼92+g。吼)靠一衍+g;一蠢2(92叮3一吼g。)l,故由更新后的四元数值可解得

l2(q193一%叮2)2(90吼+吼吼)爵一g?一矗+毋J

相应Ⅸ阵,此两值都存储下来作为再次循环初值使用。故四元数更新算法是根据初始时刻坐标转换矩阵霹及四元数Q(f),递推更新计算下一时刻坐标转换矩阵罐及四元数Q(f+△f)。至此,即完成角速度积分环路计算。

利用上述所得坐标变换矩阵霹,将原始比力观测值厂6转换至e系,再从中补偿掉重力加速度和科里奥里加速度即得速度增量。实际中因载体的运动域阵是随时间变化的,在小采样间隔【f,,+△f】内可取一阶近似,并设破在此间隔内

…胁黻…㈠料肼一驯撇∥糨囊蠢胙料

27陈允芳等:车载捷联惯导系统定位测姿算法研究第1期旷(f+△f)=y。(f)+△y。,△,。=【旷(f)+y。(f+△f)】?△f/2,,c(f+△r)=,。(f)+△,。

式中,旷(f)=孵嘭曙r、,c(f)=Lrr2cr分别为载体在e系下初始时刻t的速度和位置,根据速度和位移增量,可计算f+△,时刻相应速度和位置坐标。若需载体的地理坐标(兄,伊,^),可由地球椭球参数及相应公式算得,此处不再详述。此即加速度积分环路。

3)姿态角提取

本研究中因是车载多传感器移动数据采集系统,需提取姿态角以为激光扫描及摄影测量提供三个姿态外方位元素。姿态矩阵计算是姿态角提取的前提,由解算所得e系与n系的坐标变换矩阵,即可得b系与n系的姿态矩阵,从而可得

『一sinzcoszo]

三个姿态角通常的提取公式,分别如下所示:霹=霹式=I—sin妒cosA—sin伊sin旯cos妒lⅨ,y=戤tm[—堞(1,2),霹(2’2)],

lcos卿s兄cos州n五sin妒j‘。p=arcsinf碍(3,2)f,,=arct觚L-臂(3,1)/群(3,3)l。

陆地车载情况下三个姿态角取值范围分别为,航向角y:0~360。、俯仰角P:一90~90。、横滚角,-:一180~180。。实际地面应用中横滚角,.一般较小,仅空中导航会出现横滚角,_为90。的情况,但航向角y随时都会出现90。的情况。根据上式,y趋于90。时会出现砧(3,3)趋于。的情况,此时计算会出现“奇点”,计算精度易受影响且计算不安全,故必须采用合理的姿态角提取方法以保证数值精度和防止数值溢出,提取方法为:

蛙=arct觚[一嚼(1,2)/骘(2,2)],y=脚,2Ⅲ时’{基澡之虢霹c2国一o,{絮i袈%,嚣翟霹(2,2)<0,y=180+如

故由IMu初始对准获得载体初始速度、位置、坐标转换矩阵及姿态矩阵四元数后,以加速度计和陀螺仪输出的原始观测值作为量测更新,通过以上e系力学解算过程可解算出后续相应时刻载体速度、位置和姿态等导航参数。可编程实现以上数字迭代计算过程。

3结束语

1)实践证明,四元数法力学编排解算漂移误差小,计算量小,数值计算稳定,运算时间短,用它求解姿态矩阵能避免欧拉角法的退化现象【6】。

2)因解算中采用了近似积分、离散化或量化等处理,不可避免会产生以下误差:

积分误差:即截断误差,由微分方程数值近似积分引起,采用有限级数时,把高阶项截去,其截去部分即截断误差,低阶算法截断误差大,高阶算法截断误差小。角速度是被测量速率的矢量,只在采样时间间隔内恒定,实际中积分值是用截断的级数来估算的,且解析解输入速率在积分间隔内近似为常数。

不可交换误差:非定轴转动时角加速度方向在空间变化而非矢量,仍对它按矢量积分计算,即将刚体的有限转动看成矢量按矢量合成和分解来处理转动从而产生了此误差,因两次以上不同轴的转动不能相加,只有积分区间很小时,上式才近似成立。

3)实际解算中数据处理过程都是按固定顺序进行,每次更新姿态矩阵元素时,计算机依次接收陀螺仪输出的角增量来处理信息,以提取姿态角速度,此顺序与载体实际姿态角变化历程不相符。可采用将角速度矢量等效为旋转矢量,圆锥效应补偿算法,或加大角速度采样频率等方法来减弱此误差。

参考文献:

【l】WeiM,Sch撕忆KP.As唧downincftialal90ri吐埘usiIlg锄caml-矗xcdC疵cSi锄丘锄e川.Navigation,1990,37(2):153-167.【2】SchwarzKP,El-SheimyN.Mobilem印pingsystems—stateoftlleartalldfIlturetrends【z】,仃ntemational心chiVesofPhotogr锄me廿y,RemoteSensing锄dSpatialInfomationSci∞ces,2004,V01.35,PanB:10.

【3】董绪荣.GPs/INS组合导航定位及其应用【M】.长沙:国防科技大学出版社,1998

【4】孙丽,秦永元.捷联惯导系统姿态算法比较【J】.中国惯性技术学报,2006,14(3).

SUNLi,QINY0ng-”锄.Comp州sonofattitudealgorimmsofSINS【J】.JoumalofChineseInertialTechnolo秭2006,14(3).

车载捷联惯导系统定位测姿算法研究

作者:陈允芳, 叶泽田, 钟若飞, CHEN Yun-fan, YE Ze-tian, ZHONG Ruo-fei

作者单位:陈允芳,CHEN Yun-fan(山东科技大学,地球信息科学与工程学院,青岛,266510), 叶泽田,YE Ze-tian(中国测绘科学研究院,北京,100039), 钟若飞,ZHONG Ruo-fei(首都师范大学,北京

,100037)

刊名:

中国惯性技术学报

英文刊名:JOURNAL OF CHINESE INERTIAL TECHNOLOGY

年,卷(期):2007,15(1)

被引用次数:0次

参考文献(4条)

1.Wei M.Schwarz K P A strapdown inertial algorithm using an earth-fixed Cartesian frame 1990(02)

2.Schwarz K P.El-Sheimy N Mobile mapping systems-state of the art and future trends 2004(10)

3.董绪荣.张守信.华仲春GPS/INS组合导航定位及其应用 1998

4.孙丽.秦永元捷联惯导系统姿态算法比较[期刊论文]-中国惯性技术学报 2006(03)

相似文献(10条)

1.学位论文李振惯性导航定位系统数据处理技术的研究2007

惯性导航定位系统分为平台式惯导系统和捷联式惯导系统两种。捷联式惯导系统是近年来惯性导航技术的一个发展方向。由于捷联式惯导一系列的优点,捷联惯导系统取代平台式惯导系统,已成为新世纪惯性技术发展的一种大趋势。在国外捷联式惯导系统在石油管道检测中早已经得到了成功的应用,但是在国内还是一片空白。本论文以实际的工程为背景,主要讨论并研究了捷联式惯导系统在石油管道检测中的应用。提出适合于工程应用的捷联式惯导系统的设计,并着重点对捷联式惯导的算法实现进行了研究。

本文首先介绍了惯性导航系统发展现状,详细阐明了惯性导航系统的两种划分-平台式惯导系统与捷联式惯导系统的基本工作原理,给出了捷联惯性导航系统的硬件实现。主要是建立了捷联惯性导航系统的实现方案并且详细的介绍了系统的硬件组成部分,包括计算机、陀螺仪、加速度计、A/D转换器的选择及陀螺仪和加速度计的设计;捷联惯导系统中加速度计和陀螺仪信号的预处理和数据采集的硬件电路。然后阐明了捷联惯导系统的软件构成,并据此研究了捷联惯导系统的数据处理技术和姿态矩阵解算算法。主要内容包括捷联惯导系统所用坐标系及其之间的关系;捷联惯导系统姿态矩阵的解算算法;详细分析了捷联惯导系统的数据处理技术,重点讨论了方向余弦法、四元数等两种经典的解算方法和计算周期的划分。

本文最后给出了软件的编写和实验结果。实验结果证明了本论文提供的捷联惯导系统的设计方法在实际管道检测中是可行的,是有一定的应用价值的。

2.期刊论文徐晓苏.孙学慧.扶文树.XU Xiao-su.SUN Xue-hui.FU Wen-shu弹载捷联惯导系统快速两位置自对准-

中国惯性技术学报2007,15(2)

通过分析发现,影响自对准快速性的只是航向失准角估计速度.文中提出了快速两位置对准,即第一位置对准30 s以后引入第二位置,从而提高了对准速度而又不影响对准的精度,并结合实际应用提出了通过改变俯仰角的快速两位置对准,具有较好的实践意义.文中综合利用了自对准中姿态矩阵求解的新方法和快速两位置对准的方法,这些将大大提高了对准的精度和快速性,最后通过仿真验证了所提方法的可行性.

3.期刊论文贺娟.袁颂岳.HE Juan.YUAN Song-yue捷联惯导系统姿态算法的仿真模拟-金陵科技学院学报

2005,21(3)

在捷联惯性导航系统中,姿态矩阵可用四元数来表示,从而常常需要计算四元数矩阵微分方程的问题.4阶龙格-库塔法和3阶泰勒展开递推式法对捷联惯导系统的四元数姿态矩阵作仿真,结果表明:在短步长条件,3阶泰勒展开递推式法比4阶龙格-库塔法更有效.本文为改进捷联惯导系统算法提供了参考依据.

4.学位论文马文国捷联系统的计算机控制仿真及算法研究1996

该文主要对捷联惯导系统的算法进行了研究.在捷联惯性导航系统中,捷联惯导算法是整个系统的关键.而姿态矩阵的计算又是整个关键之关键.该文讨论了姿态矩阵的求解、实时计算等一系列问题.就实时性和计算精度对欧拉角法、四元数法和方向余弦法进行了理论上的分析,并进行了大量仿真.通过仿真,作者看到:四元数法在实时性和计算精度方面要比其它两种方法高得多.在此基础上,作者得出了船用捷联式惯导系统的姿态矩阵的首选算法为四元数法的结论.该文还建立了船用捷联式惯导系统的误差模型.为分析系统误差传播特性和实现对系统误差进行补偿提供了依据.通过理论分析和数学模拟

,验证了数学模型的正确性.

5.会议论文刘恒春捷联惯导系统姿态矩阵计算周期的优选方法

讨论捷联惯导系统姿态矩阵计算周期问题,分析计算周期与计算误差之间的关系及误差产生的原因,推导出估计误差及补偿误差的公式,提出姿态矩阵计算周期的优选方法。最后,给出数学模拟结果,说明误差补偿公式和周期优选方法是有效的。(本刊录)

6.期刊论文吕伟.王艳东.Lv Wei.Wang Yan-dong车载捷联惯导系统动基座粗对准方法的研究-战术导弹控制技术

2005(2)

以某型号车载地空导弹垂直发射的实际应用为背景,对两种捷联惯导在动基座条件下解析粗对准方法进行了理论分析与实验仿真,指出直接计算法更适合导弹在垂直发射状态下姿态角的正确计算,并提供了采样数据的处理方法和姿态矩阵的正交化方法,形成了一整套车载捷联惯导系统初始对准的方案.

7.学位论文刘畅轨道检测车光纤陀螺捷联系统的初始对准2005

道轨检测机是用于高速铁路平顺性检测的设备,它具有可以连续测量,自主测定基准检测效率高的特点。该设备的核心部分是捷联式光纤陀螺惯性测量系统,该系统利用光纤陀螺输出的角速度和加速度信息经过运算得到道轨的几何特性。

惯性测量系统的测量精度不可能优于对准误差所限定的精度,因此初始对准是捷联惯导系统的研制与应用中一个关键的问题。本论文主要研究捷联惯导系统的初始对准问题,力求获得高精度,高可靠性的初始对准方法。

2.从捷联惯导系统初始对准的基本原理出发推导了捷联惯导系统初始对准的误差模型、给出了二位置初始对准方法。

3.利用小波变换所具有的时频局部化优点对光纤陀螺信号进行消噪处理,得到了满意的对准结果,为实际的测量提供了一种有效手段。

8.期刊论文于飞.翟国富.高伟.李倩.YU Fei.ZHAI Guo-fu.GAO Wei.LI Qian舰船捷联惯导系统粗对准方法研究-

传感器与微系统2009,28(5)

提出适合于舰船系泊、锚泊状态下的捷联惯性导航系统惯性凝固粗对准方法.在惯性凝固坐标系和惯性坐标系上对重力向量分别进行积分,并利用重力向量随地球旋转在惯性卒间的方向变化信息,粗略计算初始捷联姿态矩阵.该方法通过积分抵消掉舰船线性位移引入的干扰加速度,同时,避免了舰船姿态摇摆引入的干扰角速度.仿真分析表明:在舰船系泊、锚泊状态下,惯性凝固粗对准方法比较传统算法优势明显.

9.学位论文杨阳捷联惯导系统动基座初始对准研究与仿真2002

该文《捷联惯导系统动基座初始对准研究与仿真》,较为系统和全面的研究了捷联工惯导系统动基座的初始对准,并对卡尔曼滤波在初始对准中的应用,系统可观测性和可观测度的分析方法和仿真进行了较深入的研究.论文的主要工作如下:1、捷联惯导系统的研究:首先概要介绍了惯导系统的相关知识,阐述了捷联惯导系统的优点;分析了初始对准姿态确定的几种坐标系,为建模定义了坐标系选择和姿态矩阵.2、该文对捷联式惯导系统动基座初始对准这种时变系统,研究和分析了PWCS(分段线性定常系统)方法来判断系统的可观测性,奇异值分解的分析方法判断系统各状态的可观测度,并通过大量的仿真实验,验证了这两种方法,得出了一些重要信息.3、该文采用卡尔曼滤波进行捷联惯导系统动基座的初始对准.首先介绍了卡尔曼滤波理论及相关技术,建立了系统卡尔曼滤波的状态方程和观测方程;首先采用速度误差作为观测值,详尽的研究了系统机动特性对可观测性和可观测度的影响

,并做了大量仿真实验.该文对捷联惯导系统动基座初始对准进行了研究,对卡尔曼滤波技术在动基座初始对准中的研究与应用具有一定的参考意义. 10.期刊论文吕伟.王艳东.王丽娜.LV-Wei.YAN Yang-Dong.WANG Li-na动机座弹用捷联惯导系统快速初始对准方

法的研究-弹箭与制导学报2005,25(4)

以地空导弹在战车上垂直发射为背景,得出针对在战车转塔变速转动、规定发射坐标系的情况下,文中所给出的直接计算法是一种较好的弹用捷联惯导系统快速初始对准方法.通过理论分析与仿真验证,证明该方法在发射基座变速转动情况下是一种既简单又有效的地空导弹捷联惯导系统的快速初始对准方法,可以满足实际系统对初始对准的快速性和精度的要求.

本文链接:https://www.360docs.net/doc/be18573235.html,/Periodical_zggxjsxb200701007.aspx

授权使用:郭永健(wfxbgy),授权号:80f0b934-7fb7-499b-8e4a-9ea900c0d06b

下载时间:2011年3月17日

航姿参考系统AHRS

3DM-GX4-25 是一个高性能的微型航姿参考系统(AHRS),使用最先进MEMS 传感技术。它联合使用一个三向加速度计、一个三向陀螺仪、一个三向磁力计、一个温度传感器、一个气压高度计和一个运算复杂的卡尔曼滤波器的内嵌双核微处理器。从而为用户提供精确的静态和动态姿态估计值和惯性测量。这些技术使得3DM-GX4-25成为同级别产品中体积最小和重量最轻的设备。 优点 ? 高性能陀螺仪 ? 噪声密度: 0.005°/sec/√Hz ? 漂移: 10°/hr ? g 2 灵敏度: 0.003°/s/g 2 rms ? 专用的运算微处理器,提供精确的位置、速度和姿态估值数据 ? 高速采样频率及多种数据输出方式 ? -40 °C to +85 °C 工作环境温度 ? 动态环境下高性能和高稳定性 ? 市场上最小,最轻的带自适应卡尔曼滤波器的微型航姿参考系统(AHRS) ? SDK 软件开发包及开放通信协议,易于集成开发自主系统 应用 在动态环境下为用户提供非常稳定和精确的导航和姿 态数据 ?无人机车导航 ? 平台稳定性和人工地平线 ? 天线和相机指向 ? 机车健康及使用状态监测 ? 侦察, 监视,目标截获 ? 机器人控制 ? 人员追踪 简介 3DM-GX4-25微型航姿参考系统提供各种输出数据参量,从完全标定的惯性测量(加速度,角速度和磁场或角度增量和速度向量增量)到计算的定向估值(欧拉角--俯仰、滚动、偏转;旋转矩阵和四元素。由于使用了复杂的自适应卡尔曼滤波器,运算的估值数据不会受到磁场和直线运动的干扰。偏移追踪和传感器噪声模式可以让用户对自己的设备应用进行微调,从而达到更好的测量效果。所有参量都经过温度补偿和数学运算再转换到正交坐标系统。 系统的架构设计已经充分消除了多种可能的误差源:如由于温度变化引起的增益和补偿误差;由于电源电压波动引起的灵敏度变化等因素。陀螺仪漂移非常小,基于复杂的运算估值技术,3DM-GX4-25性能已经接近满足战术应用级别的要求。

光纤捷联航姿系统在_动中通_的应用

车载“动中通”通信系统的应用极为广泛,从行驶在戈壁搓板路面的“神舟”系列搜救车,到行驶在高楼林立的城市公路的公安系统通信车,再到不可知环境的应急系统通信车,林林总总。“动中通”通信系统工作的前提是通信天线要在载车行驶条件下精确对准卫星,而载车的机动性和路面的复杂性增加了其难度,一方面要求天线响应快,在桥梁、树木、建筑物、山体和隧道等遮挡后迅速完成对卫星目标的重捕,另一方面在载体剧烈扰动时能精确地自动跟踪卫星目标[1]。本文通过高精度单脉冲自跟踪系统和光纤捷联航姿系统在天线控制系统中的联合使用,使这一要求得以实现。 1天线控制系统设计 高精度的“动中通”天线控制系统一般采用的工作方式 为伪单脉冲单通道[2]的自动跟踪模式。所谓单脉冲就是在一个脉冲上可得到完整的目标偏离天线电轴的误差信息,因此响应快;伪单脉冲自跟踪也为零值跟踪,工作在和信号的最大点,差信号的零点,该处差斜率最大[3],所以跟踪精度高,抗颠簸、冲击、振动能力强。“动中通”天线的半功率波束宽度较窄,动态条件下没有航姿系统的引导,自身捕获卫星目标的时效性较差。 光纤捷联航姿系统是一种把光纤陀螺和加速度计直接连接在动载体上测量载体的角加速度分量和角速度分量,航姿处理器根据车体坐标系和导航坐标系的方向余弦阵,计算出沿导航坐标系3个轴上的加速度分量,进而计算出载体的航向和姿态信息[4]。光纤捷联航姿系统是一种辅助式惯性系统,成本低可靠性高[5],它不具备自对准功能,利用单脉冲跟踪系统对卫星目标高精度跟踪的角度数据,实时标定光纤捷联航姿系统初值,可以使航姿系统长期保持在高精度的惯性导航水平上。天线控制系统在进行卫星目标捕获时,工作方式为航姿系统引导天线指向卫星目标[6],目标进入天线电轴的半功率波束宽度内,天线控制系统自动转换到单脉冲自动跟踪模式,完成天线对卫星目标的捕获任务而进入高精度自动跟踪状态。高精度单脉冲自跟踪系统和光纤捷联航姿系统在天线控制系统中的联合使用,使“动中通”通信系统天线控制系统设备同时具备快速捕星和精确跟踪的能力。 “动中通”通信系统天线控制系统框图如图1所示。当单脉冲自跟踪支路故障时,作为一种冗余手段,天线 光纤捷联航姿系统在“动中通”的应用 董蓉霞 (中国电子科技集团公司第39研究所陕西 西安710065) 摘要:为解决各种环境下“动中通”天线对目标的快速捕获和精确跟踪,天线控制系统采用了低成本光纤捷联航姿系统与单脉冲自跟踪系统相结合的控制技术,目标可见时采用单脉冲自跟踪,同时利用单脉冲自跟踪精度高的特点对光纤捷联航姿系统实时标校,使航姿系统长期保持在高精度的惯性导航水平上;目标被遮挡后利用光纤捷联航姿系统引导跟踪,通过试验及数据分析,该技术的使用使“动中通”天线在任何环境下,跟踪精度达1/10半功率波束宽度,对目标的捕获时间小于1s 。 关键词:动中通;光纤捷联航姿系统;单脉冲自跟踪系统;捕获;跟踪中图分类号:TN820.3 文献标识码:A 文章编号:1674-6236(2010)05-0076-02 Application of FOG strapdown attitude and jeading reference system in -motion satellite communication DONG Rong -xia (The 39th Institute ,Electronic Science and Technology Group Corporation of China ,Xi ’an 710065,China ) Abstract :To find a solution to search for communication satellite quickly and track satellite accurately in -Motion satellite communication.There is a new control technique which combines low cost FOG strapdown attitude and heading reference system and monopulse autotracking system in antenna control equipment.Monopulse autotracking system is adopted when communication satellite is seen ,at one time ,FOG strapdown attitude and heading reference system is real time proofread with monopulse autotracking system.When communication satellite is obstructed ,FOG strapdown attitude and heading ref -erence system is adopted for guiding tracking.Finally via test data analysis ,it is achieved that tracking accuracy is 1/10HPBW and capture time is less than 1second in kinds of environment. Key words :in -motion satellite communication ;FOG strapdown attitude and heading reference system ;monopulse auto -tracking system ;search ;track 收稿日期:2009-10-13 稿件编号:200910040 作者简介:董蓉霞(1971—),女,山西临猗人,高级工程师。研究方向:天线控制技术。 电子设计工程 Electronic Design Engineering 第18卷 Vol.18 第5期No.52010年5月May.2010 -76-

3DM-S10X技术手册

微型航姿参考系统MAHRS 3DM-S10A/B 技术手册 Version 1.02a 2011年9月10日

1. 简介 微型航姿参考系统(MAHRS)3DM-S10A/B是一款微型的全姿态测量传感装置,它由三轴MEMS陀螺、三轴MEMS加速度计、三轴磁阻型磁强计等三种类型的传感器构成。三轴陀螺用于测量载体三个方向的的绝对角速率,三轴加速度计用于测量载体三个方向的加速度,在系统工作中,主要作用是感知系统的水平方向的倾斜,并用于修正陀螺在俯仰和滚动方向的漂移,三轴磁阻型磁强计测量三维地磁强度,用于提供方向角的初始对准以及修正航向角漂移。微型航姿参考系统3DM-S10A/B可提供的输出数据有:原始数据、四元数、姿态数据等(产品外形如图1所示)。 图1 微型航姿参考系统(MAHRS)3DM-S10A/B外形(左 A型、右 B型) 2. 特性 实时三轴惯性输出; 大于100Hz的内部更新率; 尺寸小、重量轻; 低功耗; RS-485A串行接口,方便连接。 3. 应用领域 车载控制系统; 航空航天电子系统; 虚拟现实系统; 平台稳定系统; 机器人控制等。 4. 工作原理及软硬件框图 微型航姿参考系统(MAHRS)3DM-S10A/B采用陀螺来测量载体的绝对角速率,然后载体的姿态角(航向角、俯仰角和滚动角)就可以通过陀螺输出数据的特定的解算方法来获得。加速度计用于确定3DM-S10A/B初始的姿态,并修正并确定陀螺在水平方向(俯仰角和滚动角)的漂移。三轴磁阻

型磁强计用于提供方位角的初始对准以及修正陀螺的航向角漂移。微型航姿参考系统(MAHRS)3DM-S10A/B内部的嵌入式处理器中设计有传感器融合算法,重力测量值(通过加速度计)和磁北向测量值(通过磁力计)有机融合并对漂移进行补偿,避免了因为角速率数据的积分运算带来的误差的无限累积。而微型航姿参考系统(MAHRS)3DM-S10A/B比无陀螺的电子罗盘具有很大的优势,在动态情况下它能够精确解算航姿,而一般的电子罗盘只能在静态条件下运用,在动态情况下无法得到精确的航姿信息。微型航姿参考系统(MAHRS)3DM-S10A/B可以可靠提供全姿态信息和原始数据,数据更新率可达到100Hz以上。 图2 微型航姿参考系统(MAHRS)3DM-S10A/B硬件框图 图3 微型航姿参考系统(MAHRS)3DM-S10A/B软件框图

3DM-S10X用户指南(1).

微型航姿参考系统 MAHRS 3DM-S10A/B 用户指南 Version 1.31 2012 年 6 月 10 日 1. 简介 微型航姿参考系统(MAHRS 3DM-S10系列是一款微型的全姿态测量传感装置,它由三轴 MEMS 陀螺、三轴 MEMS 加速度计、三轴磁阻型磁强计等三种类型的传感器构成。三轴陀螺用于测量载体三个方向的绝对角速率,三轴加速度计用于测量载体三个方向的加速度,在系统工作中, 主要作用是感知系统的水平方向的倾斜,并用于修正陀螺在俯仰和滚动方向的漂移,三轴磁阻型磁强计测量三维地磁强度,用于提供方向角的初始对准以及修正航向角漂移。微型航姿参考系统 3DM-S10系列,可提供的输出数据有:原始数据、四元数、姿态数据等(产品外形如图 1所示。 图 1 微型航姿参考系统(MAHRS 3DM-S10系列外形(A 型 / B型 2. 特性 实时三轴惯性输出; 大于 100Hz 的内部更新率; 尺寸小、重量轻;

低功耗; RS-232/RS-485A串行接口,方便连接。 3. 应用领域 车载控制系统; 航空航天电子系统; 虚拟现实系统; 平台稳定系统; 机器人控制等。 4. 工作原理及软硬件框图 微型航姿参考系统(MAHRS 3DM-S10系列采用陀螺来测量载体的绝对角速率,然后载体的姿态角(航向角、俯仰角和滚动角就可以通过陀螺输出数据的特定的解算方法来获得。加速度计用于确定 3DM-S10系列初始姿态角,并修正并确定陀螺在水平方向(俯仰角和滚动角的漂移。 三轴磁阻型磁强计用于提供方位角的初始对准以及修正陀螺的航向角漂移。微型航姿参考系统 (MAHRS 3DM-S10系列内部的嵌入式处理器中设计有传感器融合算法,重力测量值(通过加速度计和磁北向测量值(通过磁力计有机融合并对漂移进行补偿,避免了因为角速率数据的积分运算带来的误差的无限累积。而微型航姿参考系统(MAHRS 3DM-S10系列相比无陀螺的电子罗盘具有很大的优势, 在动态情况下它能够精确解算航姿, 而一般的电子罗盘只能在静态条件下运用, 在动态情况下无法得到精确的航姿信息。微型航姿参考系统(MAHRS 3DM-S10系列可以可靠提供全姿态信息和原始数据,数据更新率可达到 100Hz 以上。

航姿基准系统(AHRS)(英文翻译版)

Number:CTSO-C201 Approved by:Xu Chaoqun China Civil Aviation Technical Standard Order Attitude and Heading Reference Systems (AHRS) 1. Purpose. This China Civil Aviation Technical Standard Order (CTSO) is for manufacturers applying for Attitude and Heading Reference Systems (AHRS) CTSO authorization (CTSOA). This CTSO prescribes the minimum performance standards(MPS) that Attitude and Heading Reference Systems (AHRS) must first meet for approval and identification with the applicable CTSO marking. 2. Applicability. This CTSO affects new application submitted after its effective date. Major design changes to article approved under this CTSO will require a new authorization in accordance with section 21.353 of CCAR-21-R4. 3. Requirements New models of AHRS identified and manufactured on or after the

车载捷联惯导系统基本原理

车载捷联惯导系统基本原理 一、捷联惯导系统基本原理 捷联惯导系统基本原理如图2-1所示: 图中陀螺和加速度计直接与载体系b固联,用来测量载体的角运动信息和线运动信息。导航解算的本质是根据初值进行积分的过程,通过求解姿态微分方程完成对姿态和航向角的积分,通过求解比力微分方程完成对速度的积分,通过求解位置微分方程实现对位置的积分。捷联惯导的姿态矩阵C n 相当于“数学平台”,取代了平台惯导中的实体平台,而ω?相当于对数学平台“施矩”的指令角速率。

二、捷联惯导微分方程 (一)姿态微分方程 在捷联惯导系统中,导航坐标系n 和载体坐标系b 之间的角位置关系通常用姿态矩阵、四元数和欧拉角表示,相应也存在姿态矩阵微分方程、四元数微分方程和欧拉角微分方程三种形式。 姿态矩阵微分方程的表达式为:

在欧拉角微分方程式(2.2-7)中,当俯仰角θ趋于90o时,cosθ趋于0,tanθ趋于无穷,方程存在奇异性,所以这种方法不能在全姿态范围内正常工作;姿态矩阵微分方程式(2.2-1)可全姿态工作,但姿态矩阵更新相当于求解包含9个未知量的线性微分方程组,计算量大;四元数微分方程式(2.2-6)同样可以全姿态工作,且更新算法只需求解4个未知量的线性微分方程组,计算量小,算法简单,是较实用的工程算法。 (二)速度微分方程 速度微分方程即比力方程,是惯性导航解算的基本关系式: 三、捷联惯性导航算法 捷联惯导解算的目的是根据惯性器件输出求解载体姿

态、速度和位置等导航信息,实际上就是求解三个微分方程的过程,相应存在姿态更新算法、速度更新算法和位置更新算法。 (一)姿态更新算法 求解微分方程式(2.2-6)可得四元数姿态更新算法为:

翻译

摘要:诺斯罗普·格鲁曼和利特夫公司正在通过使用目标精度为5°/小时的陀螺仪和2.5毫克的加速度计为未来的航姿参考系统(AHRS)开发基于惯性测量单元(IMU)的MEMS (微机电系统)。在科技发展阶段,原型单轴陀螺仪已经能够实现和广泛的测试包括温度,声音和振动敏感的效果。这些设备采用深反应离子蚀刻(DRIE)来处理微加工全硅陀螺仪传感器芯片。硅熔融粘结确保压力比310-2毫巴小。在复杂的模拟电子和数字信号处理条件中电容拾取信号,并实现全闭环操作。目前的结果与整体偏差小于2°/ h到5°/ h,比例因子误差<1200 ppm,测量范围>1000°/ s和角度随机游走较小<0.4°/√h表明,稳定生产5°/ h的陀螺仪是现实的。电容的制造工艺,摆式加速度计芯片是基于仅在陀螺上增加了封闭的压力来获得过临界阻尼。在一个数字控制环路中的脉冲宽度调制(PWM)被用来实现闭环操作。加速度计芯片已经测试过一个残留偏移误差<2.0毫克和比例因子误差<1400ppm的温度。这些传感器芯片已集成到一个IMU,其中传感器电子的功率预算和尺寸已经进行了优化。本文中的陀螺仪和加速度计的设计的显著特征是与IMU系统架构的概述一起呈现的。测量结果侧重于环保特性和耐用性。 1.引言 航姿参考系统(AHRS)提供相对于地球重力矢量的俯仰角和横滚角和相对于真北方向的偏航角。这样的系统都需要一个惯性测量单元(IMU),其能够测量三轴角速率和加速度。可以采用增强磁力的方法来以提高长期稳定性。迄今为止,角速度测量通常用于使用机械,光纤或环形激光陀螺仪的测量。然而所有三种技术都能够提供AHRS系统所需的性能,它们都有在实现低生产成本的解决方案时的限制。相比之下微机电系统(MEMS),产生了使用间歇过程,有着大幅调低一个AHRS系统成本的潜力。在超过十年的时间里,MEMS传感器测量加速度和角速度已经非常普遍的存在于许多应用领域中,如汽车安全系统和消费电子产品[1]。然而,虽然MEMS加速度计已经成功的应用于AHRS系统[2]本领域迄今仍然是MEMS 陀螺仪的一个挑战。 据我们所知,根据美国联邦航空管理局(FAA)技术标准超五类令(TSO-超五类)关于陀螺(DG)模型的操作方向,没有AHRS利用MEMS陀螺仪就已经被认定为合格。 DG模式用于多种应用包括大型商用飞机,飞行接近地磁北极以及直升机从石油钻井平台或其他大型金属结构来回。IMU被用于DG模式操作所需要的总误差不应超过5°/小时(1σ)。与此相反,典型的汽车传感器在每秒度被指定。 AHRS加速度计需要总误差不超过2.5毫克(1σ)。 MEMS陀螺仪的整体偏移误差由传感器的环境,即温度,振动和噪音的变化造成的。在典型AHRS环境中振动和噪声的电平是中等的并且挑战主要是获得足够低的温度误差。对于在苛刻环境条件下衍生应用的潜在用途的IMU(如战术导弹),它在用于设计传感器元件对振动和声学干扰的高耐用性,同时保持较低的温度敏感性时就成了必不可少的。 2. MEMS陀螺仪 MEMS陀螺仪已经开发并演示了近二十年[1]同时被广泛应用于汽车和消费应用。最近公布的MEMS陀螺仪[3]显示了在角度随机游走(ARW)和偏置稳定性(即闪烁噪声,有时也被称为偏置漂移)方面有显著地提高性能。然而,在结合优秀的ARW和偏置不稳定与其他要求包括带宽与温度稳定性时, MEMS陀螺仪有着困难。首次提出以下的概念,介绍了航空电子/战术级IMU闭环MEMS陀螺仪。 A.基本概念 开盖传感器陀螺仪的一个截面示意图显示在图1(a),一个俯视示意图显示在图1(b),装置的一个显微照显示在图1(c)。微硅陀螺的工作原理是基于一种改性的两平面内振动模式的音叉配置。所谓“双线结构”(DLC)的激发和检测模型是由两个正交,线性反相振荡器组成。由于永久驱动励磁转速绕垂直于被两个振荡模式所定义平面的轴,结果在科里奥

航姿参考系统AHRS

高精度航姿参考系统AHRS 3DT-1000 3DT-1000是一款高性能的小型航姿参考系统,可用于动静态环境下对载体的横滚角、俯仰角和航向角进行高精度测量。高精度360 度全方位位置姿态输出,高效的数据融合算法快速动态响应与长时间稳定性(无漂移,无积累误差)相结合。 1、传感器建模 3DT-1000是一款高性能的小型航姿参考系统,可用于动静态环境下对载体的横滚角、俯仰角和航向角进行高精度测量。 基于三轴陀螺仪、三轴加速度计和三轴磁力计,3DT-1000采用自适应kalman数据融合算法,可实时输出载体的惯性运动信息(三轴角速度、三轴加速度)、最优姿态角(横滚角、俯仰角和航向角)等参数,并且,通过对传感器的安装误差、轴间正交误差和温度误差进行补偿,极大地提高了3DT-1000的测量精度。

2、传感器的数据融合算法 基于对陀螺仪、加速度计和磁力计的性能分析,3DT-1000以积分角速度的姿态角作为状态量、以重力加速度和地球磁场获得姿态角作为观测量、以载体运动状态信息建立增益调整因子,设计了基于四元数的自适应kalman滤波数据融合算法,获得载体在各个状态(静态和动态)下的最优姿态角,从而实现姿态和航向信息的快速动态和长时间稳定性(无漂移、无累计误差)相结合的效果。 为了获得高精度的载体姿态角,3DT-1000在进行传感器数据融合算法之前,对三轴陀螺仪、三轴加速度计和三轴磁力计进行了标定以及温度漂移等误差补偿。 默认情况下,3DT-1000以50Hz的输出频率,连续输出传感器信息,波特率默认为115200。提供的硬件接口为UART232。 3、软硬件设计

自主AHRS系统3DT-1000 荷兰VTi 4、传感器标定 1)俯仰角和横滚角的误差都会影响航向角精度,所以必须进行磁场倾斜补偿;必须提 高姿态角的精度,例如抗震性能; 俯仰角误差造成的航向角误差 2)载体和周围环境的磁场都会影响航向角精度,所以必须进行磁场软硬体补偿;在产品应用过程中,周围肯定或多或少存在磁场干扰,如铁块等硬体; 在应对这些干扰的情况,我们采用了磁场倾斜补偿和软硬体补偿: 提出全新磁场倾斜补偿模型,该模型考虑了俯仰角和横滚角对磁场影响,实现全方位的 磁场补偿;

SPATIAL 惯性导航航姿参考单元

SPATIAL 惯性导航航姿参考单元 SPATIAL是一个坚固耐用的微型GNSS / INS惯性导航和AHRS航姿参考系统单元,在最苛刻的条件下提供精确的位置、速度、加速度和方向。它结合了温度校准的加速度计、陀螺仪、磁场传感器、压力传感器和先进的GNSS接收机。这些组合一个复杂的混合算法,提供准确,可靠的导航和定位。在全球导航卫星系统、惯性导航系统、姿态与航向参考系统和其他3D导航技术处于领先地位。 “空间”精密船级铝合金外壳符合防水和防脏的IP67标准,防冲击达2000g,能够在最极端的条件下使用。先进的通风系统,使“空间”单元能测量空气压力,同时又保持水份排出。“空间”是市场上最小的全球导航卫星系统/ INS,只有28x36x20毫米,亦是最低功耗5伏100mA的电力系统。“空间”OEM只有25x25x6mm、4克重。 “空间”的下一代全球导航卫星系统接收器,支持所有当前和未来的卫星导航系统,包括GPS、GLONASS、GALILEO 和北斗。这些额外的卫星导航系统能让“空间”,在只GPS 的单元不能继续工作——如城市峡谷和室内——的环境中

提供精确的位置和速度数据。 “空间”是第一个在世界上的GNSS/ INS提供温度校准动态范围的传感器。有三个不同幅度水平的加速度计、陀螺仪和磁场传感器,“空间”可以设置高准确度、高动态飞行。“空间”包含一个下一代存储器备份系统,允许它从它的最后的位置在50毫秒内热启动导航,并在约3秒内获得GNSS 定位。存储器备份系统在产品的生命周期内持续工作,并提供24小时断电备份。 “空间”的内部滤波器运行频率800HZ,数据可以以这样的速度在高速RS232接口输出。这允许用于控制动态不稳定的平台。“空间”也非常宽容动态运动和振动。 应用:机器人、运动科学、追踪与保安、赛车、极限运动 导航水平位置准确度2.5 m垂直位置准确度3.0 m速度准确度0.05

捷联惯导详细讲解

捷联惯导系统从20世纪60年代初开始发展起来,在1969年,捷联惯导系统作为"阿波罗"-13号登月飞船的应急备份装臵,在其服务舱发生爆炸时将飞船成功地引导到返回地球的轨道上时起到了决定性作用,成为捷联式惯导系统发展中的一个里程碑。 捷联式惯性导航(strap-downinertialnavigation),捷联(strap-down)的英语原义是“捆绑”的意思。因此捷联式惯性导航也就是将惯性测量元件(陀螺仪和加速度计)直接装在导弹需要诸如姿态、速度、航向等导航信息的主体上,用计算机把测量信号变换为导航参数的一种导航技术。 一、捷联惯导系统工作原理及特点 惯导系统基本工作原理是以牛顿力学定律为基础,通过测量载体在惯性参考系的加速度,将它对时间进行积分,之后将其变换到导航坐标系,得到在导航坐标系中的速度、偏航角和位臵信息等。 捷联惯导系统(SINS)是一种无框架系统,由三个速率陀螺、三个线加速度计和微型计算机组成。由于惯性元器件有固定漂移率,会造成导航误差,因此导弹通常采用指令、GPS或其组合等方式对惯导进行定时修正,以获取持续准确的位臵参数。如采用指令+捷联式惯导 捷联惯导系统能精确提供载体的姿态、地速、经纬度等导航参数,是利用惯性敏感器、基准方向及最初的位臵信息

来确定运载体的方位、位臵和速度的自主式航位推算导航系统。在工作时不依赖外界信息,也不向外界辐射能量,不易受到干扰破坏。它完全是依靠载体自身设备独立自主地进行导航,它与外界不发生任何光、声、磁、电的联系,从而实现了与外界条件隔绝的假想的“封闭”空间内实现精确导航。所以它具有隐蔽性好,工作不受气象条件和人为的外界干扰等一系列的优点。 除此以外捷联惯导系统的最大特点是没有实体平台,即将陀螺仪和加速度计直接安装在机动载体上,在计算机中实时的计算姿态矩阵,通过姿态矩阵把导航加速度计测量的载体沿机体坐标系轴向的加速度信息变换到导航坐标系,然后进行导航计算。同时,从姿态矩阵的元素中提取姿态和航向信息.由此可见,在捷联惯导系统中平台的作用已由计算机及其软件的作用代替了,捷联式惯导系统采用的是数学平台。力学编排就是按照合适的数学模型由观测量计算出导航定位参数。具体地讲,利用陀螺仪测得的载体相对于惯性参照系的旋转角速度,计算出载体坐标系至导航计算坐标系之问的坐标转换矩阵;将测量的比力(加速度计测量载体相对于惯性空间的线加速度)变换至导航坐标系,并经过两次积分得到所需的速度位臵信息。 二、捷联惯导系统有以下独特优点: (1)去掉了复杂的平台机械系统,系统结构极为简单,

AHRS和imu的比较和加速度陀螺仪的融合

AHRS(航姿参考系统)和IMU(惯性测量单元)的区别 分类:算法学习2014-05-28 15:12 565人阅读评论(0) 收藏举报AHRS(航姿参考系统)和IMU(惯性测量单元)的区别【转】 刚开始的时候我总是搞不清楚AHRS和 IMU的区别。。不知道这有什么区别。。后来慢慢的慢慢的,我理解了~AHRS 俗称航姿参考系统,AHRS由加速度计,磁场计,陀螺仪构成,AHRS的真正参考来自于地球的重力场和地球的磁场~~他的静态终精度取决于对磁场的测量精度和对重力的测量精度 ,而则陀螺决定了他的动态性能。 这就是AHRS~在这种前提下。说明AHRS离开了地球这种有重力和磁场环境的时候是没法正常工作的~~而且特别注意。。磁场和重力场越正交,则航姿测量效果越好~~也就是说如果磁场和重力场平行了,比如在地磁南北极。。这里的磁场是向下的,即和重量场方向相同了。。这个时候航线交是没法测出的~~这是航姿系统的缺陷所在。。在高纬度的地方航线角误差会越来越大~~ (IMU)Inertial measurement unit,(非内蒙古大学——Inner Mongolia University)学名惯性测量单元,大学的理论力学告诉我们,所有的运动都可以分解为一个直线运动和一个旋转运动,故这个惯性测量单元就是测量这两种运动,直线运动通过加速度计可以测量,旋转运动则通过陀螺。。 我假设IMU的陀螺和加速度计的测量是没有任何误差的~~那么通过陀螺则可以精确的测量物体的姿态。。通过加速度计可以二次积分得出位移,实现完整的6DOF,也就是说你带着一台这种理论型的IMU在宇宙任何位置运动。。我们都可以知道他当前的姿态和相对位移~~这将不局限于任何场。。 从上面的描述何以看出。实际上AHRS比IMU还多一个磁场传感器,而为什么AHRS 的级别却低于IMU而需要依赖于重力场和磁场呢~~这是由传感器器件架构所决定的。。AHRS的传感器通常是成本低廉的mems传感器。。这种传感器的陀螺仪和加速度计的噪声相对来说很大,以平面陀螺为例用ADI的陀螺仪进行积分一分钟会漂移2度左右,这种前提下如果没有磁场和重力场来修正三轴陀螺的话。。那么基本上3分钟以后物体的实际姿态和测量输出姿态就完全变样了~~所以在这种低价陀螺仪和加速度计的架构下必须运用场向量来进行修正~~ 而IMU实际上也是这样的。。。因为我们知道没有绝对精确的传感器,只有相对精确的传感器,IMU的陀螺仪用的是光纤陀螺或者机械陀螺~~这种陀螺的成本很高。。精度相对mems陀螺也很高~~精度高不代表准确, IMU的姿态精度参数通常是一小时飘多少度,比如xbow的低端的有一小时3度的。。 而用加速度计积分做位置的话。AHRS是不现实的(1分钟就能飘出几十米。。而且是成二次方的速度递增)。。AHRS通常要结合GPS和气压计做位置~~我听说的IMU积分做位置的是一天多少海里。。这样的一个参数数量级。。也许在海上还能用的到~~ 这就是AHRS和IMU在我的理解里的一个差异。。自己给自己梳理

车载捷联惯导系统定位测姿算法研究

第15卷第l期2007年2月 中国惯性技术学报 JoumalofChineseInertialTcchnology Vbl.15No.1 Feb.2007 文章编号:1005-6734(2007)01一0024-04 车载捷联惯导系统定位测姿算法研究 陈允芳1,叶泽田2,钟若飞3 (1.山东科技大学地球信息科学与工程学院,青岛266510;2.中国测绘科学研究院,北京100039; 3.首都师范大学,北京100037) 摘要:GPs/INs组合精确测定平台的位置和姿态是移动测图系统中的重要模块。对陀螺仪和加速度计所测角速度和比力进行两次积分得载体姿态、速度和位置即sINs力学机械编排。目前该过程大多在地理坐标系进行。 这里详细推导了地球坐标系中完整的解算过程,以四元数姿态矩阵更新及重力计算为核心,由IMu原始观测值解算出了载体位置、速度和姿态等参数,可快速高效与GPs输出的位置速度信息进行组合滤波处理,可据此编程进行工程应用数据处理。 关键词:捷联惯导系统;姿态矩阵;坐标转换;力学编排;四元数 中图分类号:u666.1文献标识码:A PositioningandorientationcomputationonVehicle-borne SINSanddiscussofcalculationerror cHENYun.‰91,YEze-tian2,zHONGRuo.fei3 (1.Geo?info衄ationScience&EngineeringCollege,ShandongUniverSi哆ofScienceaIldTbchnology,Qingdao 266510,China;2.SurveyingaTldMappingScienceResearchInStituteofChina,Beijing100039,China;3.C印ital NomlalUniverSi劬Beijing100037,China) Abstract:GPSandINSintegratedtoaccuratelydeteminingpositionaIldattitudeofnatI‘oofisVitalmoduleinmobilemappingSystem.Specincforcc行omspeedometer蚰d舭glerate矗om留roareinte铲atedtwicerespectiVelytoachievean沁de,veloc时aIldpositionn锄elySINSmechaIlization.Currentlythistookplacedingeogr印hiccoordinate,whiIeheredemonstratedindetailmewholemechaJlizationineanll-centclrcdearth-fixedcoordinate,mostlyquatemiona钍itudematrixupdating锄dgravit)rcaIculation.Ultimatelyvehiclenavigationpar锄eterssuchaSattitude,veIocity锄dpositionwercgahed丘omIMUorigin“0bservations.Mathematicsplatfo眦isfomlcdinSrNStocarryoutsuⅣeyingaJldcalculatingpreciselythenavigationmoVement par锄cterS.Theresultsarcpronetointe黟atewitllsimilarpammeters疔omGPStofilterprocessing.Pro可锄minghercbyc锄pmcessdatainengineeringapplication Keywords:SINS;attitudematrix;coordinatetransfomation;mechanization;quatemion 随着惯性技术与卫星导航定位技术的发展,由GPS/INs不同程度组合而成的定位定姿传感器已成为移动测图系统中确定载体轨迹和平台姿态的重要工具,其中GPs多用于定位而INS则用于测姿。捷联惯导系统(sINs)是将惯性仪表直接固联在载体上而无须采用机械陀螺稳定平台,通过导航计算机中相应程序建立“数学的”陀螺稳定平台,即计算机处理测量值得到载体位置、速度和运动方向估计值以实现导航平台功能。尽管sINS于20世纪50年代即在美国获得专利,但因受限于惯性设备和计算机技术的发展而一直未能实用。近年来,电子和高速计算机技术的发展使得捷联技术得以实现和充分发展,这是惯性技术在近20年内发展的一个重要的标志。 INS的核心部件是惯性测量单元(IMU),按照其陀螺仪和加速计等元件的精度,可将惯导分为不同等级:战略级(<0.000l(o)/}l,l岖)、导航级(0:000l~0.015)(o)/Il,5~100嵋)、低成本((1~10(。冲,(0.1~1)n培)。考虑到惯性设备出口管制政策及需求与成本等问题,民用INs精度范围一般为低成本级别。 收稿日期:2006—06—16;修回日期:2006—12—22 基金项目:国家863基金课题(2006AAl22324);教育部三维信息获取与应用重点实验室开放基金 作者简介:陈允芳(1977一),女,博士生,讲师,主要从事移动测图与组合导航。

AHRS

AHRS编辑 本词条缺少名片图,补充相关内容使词条更完整,还能快速升级,赶紧来编辑吧!AHRS称为航姿参考系统包括多个轴向传感器,能够为飞行器提供航向,横滚和侧翻信息,这类系统用来为飞行器提供准确可靠的姿态与航行信息。 中文名 AHRS 称为 航姿参考系统 包括 多个轴向传感器 功能 提供航向,横滚和侧翻信息 目录 1概述 2特点 3输出模式 4应用领域 5参考产品 ?概览 ?LPMSCONTROL ?LPMS C++库 ?开放式运动分析工具(OPENMAT) ?LPMS-B规格 1概述编辑 AHRS 航姿参考系统

航姿参考系统包括基于MEMS的三轴陀螺仪,加速度计和磁强计。航姿参考系统与惯性测量单元IMU的区别在于,航姿参考系统(AHRS)包含了嵌入式的姿态数据解算单元与航向信息,惯性测量单元(IMU)仅仅提供传感器数据,并不具有提供准确可靠的姿态数据的功能。目前常用的航姿参考系统(AHRS)内部采用的多传感器数据融合进行的航姿解算单元为卡尔曼滤波器。 2特点编辑 高精度360 度全方位位置姿态输出,采用欧拉角的会具有万向锁,不能全向转动 高效的数据融合算法快速动态响应与长时间稳定性(无漂移,无积累误差)相结合 3输出模式编辑 三维全姿态数据(四元数 / 欧拉角 / 旋转矩阵/原始数据) 三维加速度 / 三维角速度 / 三维地磁场强度 4应用领域编辑 AHRS 原本起源于飞行器相关技术,但是近几年随着成本的器件成本的不断降低也被广泛的应用于机动车辆与无人机,工业设备,摄像与天线云台,地面及水下设备,虚拟现实,生命运动科学分析,虚拟现实,游戏界面,室内定位等需要三维姿态测量的产品中 5参考产品编辑 AHRS/IMU LPMS-B是新型的高精度超小型姿态动作捕捉传感器,它使用蓝牙技术对数据进行无线通信, 高度满足了在机械系统以及人体动作信息测量应用上的高精度计算,无线传输数据的要求,并为用户提供多方面的软件平台支持。

航姿参考

航向姿态测量系统的工作原理及组成 2.1航向姿态测量系统概述 航向姿态测量系统是多年来惯性技术发展的一个方向,它有多种构成方案,捷联式航向姿态测量系统的工作原理是基于捷联惯性测量系统的测量原理。以惯性测量元件(加速度计、陀螺仪)为敏感元器件测量载体相对于惯性空间的运动参数。由陀螺仪测量载体的角运动和由加速度计测量载体的加速度,在给定运动初始条件下,经转换、处理,输出载体的姿态和航向等参数。它的优点是: (l)自主性强,它可以不依赖任何外界系统的支持,而单独进行导航。 (2)不受环境、载体机动和无线电干扰的影响,可连续的输出包括基准在内的全部导航参数,实时导航数据更新率高。 (3)具有非常好的短期精度和稳定性。 由于其工作的完全自主性,在航空航天、航海及陆地等很多领域,特别是军事领域得到了广泛应用,成为一种主要的导航手段。 基于MEMS器件的航向姿态测量系统主要由微惯性测量单元(Microinertialmeasurementunit)组成。微惯性测量单元为敏感X、Y、Z三个方向的直线加速度,需具有三只微机械加速度计; 微惯性测量单元为敏感X、Y、Z三个方向的磁场强度,需具有三只微机械磁强计;为敏感绕X、Y、Z三个方向的旋转角速度,需具有三只微机械陀螺仪,即共需九只传感器固连在微惯性测量单元装置的支架上。以相互垂直位置进行安装。微机械陀螺仪测取沿载体坐标系三个轴的角速度信号,微机械加速度计测取沿载体坐标系三个轴的加速度信号,

磁强计去沿着载体坐标系三轴的磁场强度,并送入计算机。地理坐标系视为导航坐标系时,计算机用这些测量信息,经误差补偿后进行姿态矩阵计算和由载体坐标系至“平台”坐标的坐标变换。姿态矩阵一方面用于坐标变换,即把沿载体坐标系的加速度信号变换成导航坐标系各轴的加速度信号,以便于导航参数计算;另一方面,利用姿态矩阵的元素以提取姿态角与航向角信息。这样,由系统中的姿态矩阵计算、加速度信号的坐标变换计算以及姿态与航向计算实现了平台式惯导系统中稳定平台的功能,从而构成“数学平台”。航向姿态测量系统由于没有机械平台,不能直接测出姿态角和航向角,故要得到姿态角和航向角,必须在导航计算机中建立“数学平台”,即通过机体坐标系相对地理坐标系的方向余弦阵(又称姿态矩阵)来计算一机体的姿态角和航向角。 2.2航向姿态测量系统的工作原理 基于MEMS器件的航向姿态测量系统实际上就是可以实时提供载体的姿态信息的微型惯性测量系统。它由三轴微机械加速度计,三个单轴微机械陀螺和三轴磁强计组长,提供载体的加速度,角速度信息、磁场强度等信息,这些实时信息经捷联解算后即可获得所需的导航参数,其工作原理框图如图2一1所示: 基于MEMS器件的航向姿态测量系统是一种捷联式的惯性系统,捷联式的航向姿态测量系统具有结构简单、自主性强、短期精度和稳定性比较好等优点。

捷联式惯性导航系统

1 绪论 随着计算机和微电子技术的迅猛发展,利用计算机的强大解算和控制功能代替机电稳定系统成为可能。于是,一种新型惯导系统--捷联惯导系统从20世纪60年代初开始发展起来,尤其在1969年,捷联惯导系统作为"阿波罗"-13号登月飞船的应急备份装置,在其服务舱发生爆炸时将飞船成功地引导到返回地球的轨道上时起到了决定性作用,成为捷联式惯导系统发展中的一个里程碑。 捷联式惯性导航(strap-down inertial navigation) ,捷联(strap-down)的英语原义是“捆绑”的意思。因此捷联式惯性导航也就是将惯性测量元件(陀螺仪和加速度计)直接装在飞行器、舰艇、导弹等需要诸如姿态、速度、航向等导航信息的主体上,用计算机把测量信号变换为导航参数的一种导航技术。现代电子计算机技术的迅速发展为捷联式惯性导航系统创造了条件。惯性导航系统是利用惯性敏感器、基准方向及最初的位置信息来确定运载体的方位、位置和速度的自主式航位推算导航系统。在工作时不依赖外界信息,也不向外界辐射能量,不易受到干扰破坏。它完全是依靠载体自身设备独立自主地进行导航,它与外界不发生任何光、声、磁、电的联系,从而实现了与外界条件隔绝的假想的“封闭”空间内实现精确导航。所以它具有隐蔽性好,工作不受气象条件和人为的外界干扰等一系列的优点,这些优点使得惯性导航在航天、航空、航海和测量上都得到了广泛的运用[1] 1.1 捷联惯导系统工作原理及特点 惯导系统主要分为平台式惯导系统和捷联式惯导系统两大类。惯导系统(INS)是一种不依赖于任何外部信息、也不向外部辐射能量的自主式导航系

统,具有隐蔽性好,可在空中、地面、水下等各种复杂环境下工作的特点。 捷联惯导系统(SINS)是在平台式惯导系统基础上发展而来的,它是一种无框架系统,由三个速率陀螺、三个线加速度计和微型计算机组成。平台式惯导系统和捷联式惯导系统的主要区别是:前者有实体的物理平台,陀螺和加速度计置于陀螺稳定的平台上,该平台跟踪导航坐标系,以实现速度和位置解算,姿态数据直接取自于平台的环架;后者的陀螺和加速度计直接固连在载体上作为测量基准,它不再采用机电平台,惯性平台的功能由计算机完成,即在计算机内建立一个数学平台取代机电平台的功能,其飞行器姿态数据通过计算机计算得到,故有时也称其为"数学平台",这是捷联惯导系统区别于平台式惯导系统的根本点。由于惯性元器件有固定漂移率,会造成导航误差,因此,远程导弹、飞机等武器平台通常采用指令、GPS或其组合等方式对惯导进行定时修正,以获取持续准确的位置参数。如采用指令+捷联式惯导、GPS+惯导(GPS/INS)。美国的战斧巡航导弹采用了GPS+INS +地形匹配组合导航。 惯导系统基本工作原理是以牛顿力学定律为基础,通过测量载体在惯性参考系的加速度,将它对时间进行积分,之后将其变换到导航坐标系,得到在导航坐标系中的速度、偏航角和位置信息等。对捷联惯导系统而言,平台的作用和概念体现在计算机中,它是写在计算机中的方向余弦阵。直接安装在载体上的惯性元件测得相对惯性空间的加速度和角加速度是沿载体轴的分量,将这些分量经过一个坐标转换方向余弦阵,可以转换到要求的计算机坐标系内的分量。如果这个矩阵可以描述载体和地理坐标系之间的关系,那么载体坐标系测得的相对惯性空间的加速度和角速度,经过转换后便可得到沿地理坐标系的加速度和角速度分量,有了已知方位的加速度和角速度分量之后,导航计算机便

相关文档
最新文档