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

权利要求书

1.一种基于四元数夹角的惯导精度检测方法，其特征在于实现步骤如下：

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

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

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

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

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

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

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

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