[发明专利]一种姿态检测系统标定方法

摘要

本发明公开了一种姿态检测系统标定方法，属于管道姿态检测技术领域。本发明中，根据姿态检测系统中陀螺仪与加速度传感器误差特性，建立误差模型，在通过位置标定和速率标定来标定上述误差模型中的误差系数，该标校方法简单易用，可操作性强，适于工程应用。

主权项

1.一种姿态检测系统标定方法，其特征在于，包括以下步骤：步骤一、根据姿态检测系统中陀螺仪与加速度传感器误差特性，建立误差模型：式中，Ngrx为陀螺仪的脉冲输出，脉冲数/s；Ngx、Ngy、Ngz分别为加速度传感器在X轴、Y轴、Z轴的脉冲输出，脉冲数/s；Dfx为陀螺仪的常值漂移，脉冲数/s；Sgrx为陀螺仪的标度因数，脉冲数/°；Kgx1、Kgx2、Kgy1、Kgy2、Kgz1，Kgz2为加速度传感器的安装误差系数，脉冲数/°；Kgx0、Kgy0、Kgz0为加速度传感器的偏值，脉冲数/S；Sgx、Sgy、Sgz为加速度传感器的标度因数，脉冲数/S/g；步骤二、标定，包括位置标定和速率标定，位置标定设计6个位置对加速度传感器的误差系数进行标定，6个标定位置分别为令转台的X轴、Y轴、Z轴分别与地球坐标系的天、地重合的六个位置，让姿态检测系统依次处于6个位置，调整好转台后，连续记录一定时间T1内加速度传感器的脉冲输出；速率标定，设计至少4个角速度对陀螺仪的误差系数进行标定，采集陀螺仪在4个角速度下且在一定时间T2内的脉冲输出，其中两个角速度分别为同一速率下的沿顺时针和逆时针的角速度，另两个角速度分别为另一相同速率下的沿顺时针和逆时针的角速度；步骤三、解算首先，利用步骤二的位置标定中获得的数据对加速度传感器误差系数进行解算，再利用下列公式(5)和(6)解算陀螺仪的误差系数：式中，Ngx(2)、Ngx(3)、Ngx(4)、Ngx(5)为步骤二的位置标定中的除转台的X轴与地球坐标系的地、天重合外的4个位置下加速度计X轴脉冲输出，Ngrx+(1')、Ngrx‑(2')、Ngrx+(3')、Ngrx‑(4')为陀螺仪在4个角速度下的脉冲输出，且其中Ngrx+(1')、Ngrx‑(2')为陀螺仪在同一速率的分别沿顺时针和逆时针的角速度下的的脉冲输出，Ngrx+(3')、Ngrx‑(4')为陀螺仪在同一速率的分别沿顺时针和逆时针的角速度下的的脉冲输出。