一种基于四元数夹角的惯导精度检测方法技术

本发明专利技术公开了一种基于四元数夹角的惯导精度检测方法，涉及姿态测量与误差检测领域。针对传统上惯导采用欧拉角比对误差进行精度检测的方法，需要惯导安装后进行初始标定或者初始对准等操作。当标定不准确时，惯导所在的平台摇摆后，航向、俯仰和横滚数据会相互耦合，造成精度检测不准确。本发明专利技术介绍了两种采用四元数夹角的方法去检测惯导的精度。方法可以克服传统方法带来的耦合现象。只要惯导和平台进行固联，不需要对惯导进行安装标定，没有数据耦合带来的误差。采用四元数夹角的方法对惯导进行误差评估，其方法更加简单，且数据更加客观且更加符合实际的使用。

【技术实现步骤摘要】

本专利技术涉及姿态测量与处理的
，具体涉及一种基于四元数夹角的惯导精度检测方法。
技术介绍
由于不同的惯导采用的不同的陀螺，同时处理的算法也各不相同，因而使得输出的姿态数据误差也有不同的变化。传统上对惯导进行精度评价的方法主要采用欧拉角比对后的误差统计方法(如图1所示流程)，主要有两种形式：一、将惯导固定在高精度摇摆台上，标定惯导与摇摆台之间的旋转关系。然后开启摇摆台，记录摇摆台和惯导输出的姿态数据。事后，通过之前的标定关系，将两种姿态数据统一到同一坐标系内。最后，通过欧拉角对比，分别计算欧拉角航向、俯仰和横滚的误差状况；二、将要比对的惯导和高精度惯导都固定于摇摆台上，标定两个惯导的数据关系；然后转动摇摆台，记录两个惯导输出的姿态数据。事后，通过标定关系将两个姿态数据统一到同一个坐标系内。最后，通过对欧拉角进行比对，分别计算三个欧拉角航向、俯仰和横滚的误差状况。为了得到准确可信的误差比对数据，在以上两种形式中都需要惯导安装位置的标定精度能达到要求，即标定精度要远小于欧拉角的误差值。否则标定误差将会耦合在三个欧拉角当中——使得误差增大，进而影响对惯导的精度检测。但在现实中，对惯导的标定相对较为困难，尤其是受到摇摆台安装或者其它因素影响的情况下。同时采用三个欧拉角误差评估惯导的精度，虽然相对比较直观，但却缺少整体性评估概念。即当某个欧拉角的误差相对较大，其它两个误差角较小时，不能直观判断惯导设备的精度量级或者误差范围。
技术实现思路
本专利技术要解决的技术问题为：针对惯导精确标定安装位置相对较为困难的情况，采用直接计算的方法来进行精度检测。本专利技术可以充分利用传统的测试形式，但不需要对惯导设备的安装位置进行精确标定，因而不会带来因为标定误差而产生的耦合误差。本专利技术采用的技术方案为：一种基于四元数夹角的惯导精度检测方法，具体实现步骤为：步骤(1)、将被测的惯导固定在摇摆平台上；步骤(2)、转动摇摆台，记录同一时刻摇摆台的姿态数据和惯导输出的姿态数据；步骤(3)、将摇摆台(或者高精度惯导)的姿态数据和被测惯导的姿态数据转换为两组四元数数据；步骤(4)、计算两组两个四元数之间的夹角，形成夹角序列；对四元数夹角序列求均方误差，作为惯导的精度指标；步骤(5)、计算每组四元数数据和各自第一个四元数数据的夹角，形成两组夹角序列；两组夹角序列相减求误差角，并求均方误差作为惯导的精度指标。其中，所述第(3)步中，将相同时刻的被测惯导和摇摆台的姿态数据转换为两组四元数数值。其中，所述第(4)步中，需要计算相同时刻摇摆台和被测惯导两个姿态数据所代表的四元数的夹角，形成序列，以夹角序列数据的均方误差作为惯导的精度指标。其中，所述第(5)步中，采用两组四元数数据都和其第一个四元数数据求夹角，形成夹角序列，两组夹角序列相减求误差角，以误差角的均方误差作为惯导的精度指标。本专利技术的原理在于：本专利技术利用的原理为在摇摆台转动过程中，由于惯导和摇摆台或者高精度惯导之间的关系是固定的——它们之间的标定关系，即在不考虑摇摆台变形的情况下，它们之间的关系不会随着摇摆台姿态的变化而变化。虽然传统上采用3个欧拉角误差作为精度指标，但在使用时三个欧拉角却总是同时使用。因而如果能够采用一个角度数值来表示精度指标，则可以更加直观反映这个惯导的精度。利用四元数夹角的方法，不仅可以减少复杂的惯导安装位置标定过程，容易操作，而且误差的评价数据有整体性。能够充分反映惯导的误差状况和误差量级范围。其中步骤(4)中，采用的方法的原理为被测惯导相对摇摆台是固联的，即不论摇摆台怎么转动，从四元数物理意义上讲，它们的夹角始终是固定的。其中步骤(5)中，采用的方法的原理为，从四元数物理意义上讲，摇摆台摇摆量和被测惯导摇摆量理论上是相同的，产生的不同都由误差项带来。本专利技术与现有技术相比的优点在于：(1)本专利技术依赖条件小：传统方法需要对被测惯导的安装要求较高，即要精确测量被测惯导的安装和摇摆台三个姿态角间的关系，而本方法不需要进行精确测量；(2)本专利技术结果直观：由于惯导使用的器件不同，计算的算法不同，使得三个姿态角误差的量级不同，因而使得传统方法不直观，而本文所述方法只一个数值来表示检测精度，数据直观。附图说明图1是传统精度检测方法的流程图；图2是基于四元数夹角的精度检测方法的流程图。具体实施方式以下是本专利技术的具体实施办法。但以下的实施例仅限于解释本专利技术，本专利技术的保护范围应包括权利要求的全部内容，而且通过以下实施例对该领域的技术人员即可以实现本专利技术权利要求的全部内容。在以下具体实施例中，目的是测量得到的姿态数据，计算被测惯导的精度。假设在摇摆台摇摆后，记录的摇摆台姿态的欧拉角数据为：航向角ψpi，俯仰角θpi和横滚角γpi。其中下标p表示摇摆台，i表示数据个数。记录被测惯导的姿态的欧拉角数据为：航向角ψi，俯仰角θi和横滚角γi。其中下标i相同时表示同一时刻采集到的数据。通过下面公式将欧拉角姿态数据转换为四元数数据：q0=cos(γ2)cos(θ2)cos(ψ2)-sin(γ2)sin(θ2)sin(ψ2)---(1)]]>q1=-cos(γ2)sin(θ2)sin(ψ2)-sin(γ2)cos(θ2)cos(ψ2)---(2)]]>q2=-cos(γ2)cos(θ2)sin(ψ2)-sin(γ2)sin(θ2)cos(ψ2)---(3)]]>q3=-cos(γ2)sin(θ2)cos(ψ2)+sin(γ2)cos(θ2)sin(ψ2)---(4)]]>得到两组四元数序列为：摇摆台四元数序列：Qpi＝{qpi0,qpi1,qpi2,qpi3本文档来自技高网...

【技术保护点】
一种基于四元数夹角的惯导精度检测方法，其特征在于实现步骤如下：步骤(1)、将被测的惯导固定在摇摆平台上；步骤(2)、转动摇摆台，记录同一时刻摇摆台的姿态数据和惯导输出的姿态数据；步骤(3)、将摇摆台的姿态数据和被测惯导的姿态数据转换为两组四元数数据；步骤(4)、计算两组两个四元数之间的夹角，形成夹角序列；对四元数夹角序列求均方误差，作为惯导的精度指标；步骤(5)、计算每组四元数数据和各自第一个四元数数据的夹角，形成两组夹角序列；两组夹角序列相减求误差角，并求均方误差作为惯导的精度指标。

【技术特征摘要】
1.一种基于四元数夹角的惯导精度检测方法，其特征在于实现步骤如下：
步骤(1)、将被测的惯导固定在摇摆平台上；
步骤(2)、转动摇摆台，记录同一时刻摇摆台的姿态数据和惯导输出的姿态数据；
步骤(3)、将摇摆台的姿态数据和被测惯导的姿态数据转换为两组四元数数据；
步骤(4)、计算两组两个四元数之间的夹角，形成夹角序列；对四元数夹角序列求均方
误差，作为惯导的精度指标；
步骤(5)、计算每组四元数数据和各自第一个四元数数据的夹角，形成两组夹角序列；
两组夹角序列相减求误差角，并求均方误差作为惯导的精度指标。
2.根据权利要求1所述的一种基于四元数夹角的...

【专利技术属性】
技术研发人员：张涯辉，江彧，吴琼雁，
申请(专利权)人：中国科学院光电技术研究所，
类型：发明
国别省市：四川;51