[发明专利]一种基于四元数夹角的惯导精度检测方法

说明书

技术领域

本发明涉及姿态测量与处理的技术领域，具体涉及一种基于四元数夹角的惯导精度检测方法。

背景技术

由于不同的惯导采用的不同的陀螺，同时处理的算法也各不相同，因而使得输出的姿态数据误差也有不同的变化。传统上对惯导进行精度评价的方法主要采用欧拉角比对后的误差统计方法(如图1所示流程)，主要有两种形式：

一、将惯导固定在高精度摇摆台上，标定惯导与摇摆台之间的旋转关系。然后开启摇摆台，记录摇摆台和惯导输出的姿态数据。事后，通过之前的标定关系，将两种姿态数据统一到同一坐标系内。最后，通过欧拉角对比，分别计算欧拉角航向、俯仰和横滚的误差状况；

二、将要比对的惯导和高精度惯导都固定于摇摆台上，标定两个惯导的数据关系；然后转动摇摆台，记录两个惯导输出的姿态数据。事后，通过标定关系将两个姿态数据统一到同一个坐标系内。最后，通过对欧拉角进行比对，分别计算三个欧拉角航向、俯仰和横滚的误差状况。

为了得到准确可信的误差比对数据，在以上两种形式中都需要惯导安装位置的标定精度能达到要求，即标定精度要远小于欧拉角的误差值。否则标定误差将会耦合在三个欧拉角当中——使得误差增大，进而影响对惯导的精度检测。但在现实中，对惯导的标定相对较为困难，尤其是受到摇摆台安装或者其它因素影响的情况下。同时采用三个欧拉角误差评估惯导的精度，虽然相对比较直观，但却缺少整体性评估概念。即当某个欧拉角的误差相对较大，其它两个误差角较小时，不能直观判断惯导设备的精度量级或者误差范围。

发明内容

本发明要解决的技术问题为：针对惯导精确标定安装位置相对较为困难的情况，采用直接计算的方法来进行精度检测。本发明可以充分利用传统的测试形式，但不需要对惯导设备的安装位置进行精确标定，因而不会带来因为标定误差而产生的耦合误差。

本发明采用的技术方案为：一种基于四元数夹角的惯导精度检测方法，具体实现步骤为：

步骤(1)、将被测的惯导固定在摇摆平台上；

步骤(2)、转动摇摆台，记录同一时刻摇摆台的姿态数据和惯导输出的姿态数据；

步骤(3)、将摇摆台(或者高精度惯导)的姿态数据和被测惯导的姿态数据转换为两组四元数数据；

步骤(4)、计算两组两个四元数之间的夹角，形成夹角序列；对四元数夹角序列求均方误差，作为惯导的精度指标；

步骤(5)、计算每组四元数数据和各自第一个四元数数据的夹角，形成两组夹角序列；两组夹角序列相减求误差角，并求均方误差作为惯导的精度指标。

其中，所述第(3)步中，将相同时刻的被测惯导和摇摆台的姿态数据转换为两组四元数数值。

其中，所述第(4)步中，需要计算相同时刻摇摆台和被测惯导两个姿态数据所代表的四元数的夹角，形成序列，以夹角序列数据的均方误差作为惯导的精度指标。

其中，所述第(5)步中，采用两组四元数数据都和其第一个四元数数据求夹角，形成夹角序列，两组夹角序列相减求误差角，以误差角的均方误差作为惯导的精度指标。

本发明的原理在于：

本发明利用的原理为在摇摆台转动过程中，由于惯导和摇摆台或者高精度惯导之间的关系是固定的——它们之间的标定关系，即在不考虑摇摆台变形的情况下，它们之间的关系不会随着摇摆台姿态的变化而变化。虽然传统上采用3个欧拉角误差作为精度指标，但在使用时三个欧拉角却总是同时使用。因而如果能够采用一个角度数值来表示精度指标，则可以更加直观反映这个惯导的精度。

利用四元数夹角的方法，不仅可以减少复杂的惯导安装位置标定过程，容易操作，而且误差的评价数据有整体性。能够充分反映惯导的误差状况和误差量级范围。其中步骤(4)中，采用的方法的原理为被测惯导相对摇摆台是固联的，即不论摇摆台怎么转动，从四元数物理意义上讲，它们的夹角始终是固定的。其中步骤(5)中，采用的方法的原理为，从四元数物理意义上讲，摇摆台摇摆量和被测惯导摇摆量理论上是相同的，产生的不同都由误差项带来。

本发明与现有技术相比的优点在于：

(1)本发明依赖条件小：传统方法需要对被测惯导的安装要求较高，即要精确测量被测惯导的安装和摇摆台三个姿态角间的关系，而本方法不需要进行精确测量；

(2)本发明结果直观：由于惯导使用的器件不同，计算的算法不同，使得三个姿态角误差的量级不同，因而使得传统方法不直观，而本文所述方法只一个数值来表示检测精度，数据直观。

附图说明

图1是传统精度检测方法的流程图；

图2是基于四元数夹角的精度检测方法的流程图。