1.一种惯性导航系统安装误差校正方法,用于校正惯性导航系统与三轴磁力仪组装形成的捷联式三分量磁测系统的安装误差,其特征在于,所述安装误差校正方法包括:获取所述捷联式三分量磁测系统进行姿态变动后所述三轴磁力仪的实测三分量磁场值和所述惯性导航系统的姿态数据,姿态数据包括:航向角、俯仰角、横滚角;
基于所述姿态数据构建姿态变换欧拉角旋转矩阵,构建安装误差欧拉角旋转矩阵;
基于所述实测三分量磁场值、所述安装误差欧拉角旋转矩阵、所述姿态变换欧拉角旋转矩阵以及所述捷联式三分量磁测系统所在区域的标准三分量磁场值构建转换模型,基于所述转换模型构建轨迹方程;
以地理坐标系Z轴作为预设法向量,根据所述轨迹方程上若干线向量与所述预设法向量构建安装误差的目标函数;
对所述目标函数进行最小化求解,获取姿态数据偏差以及所述捷联式三分量磁测系统所在区域的标准三分量磁场值,以完成惯性导航系统安装误差的校正,惯性导航系统安装误差包括:航向角偏差、俯仰角偏差、横滚角偏差;
所述以地理坐标系Z轴作为预设法向量,根据所述轨迹方程上若干线向量与所述预设法向量构建安装误差的目标函数的步骤为:在所述轨迹方程上获取至少三个轨迹点,基于至少三个所述轨迹点构建轨迹平面;
对所述轨迹平面上的轨迹点进行两两差分,获取若干所述轨迹平面的线向量;
将所述预设法向量分别与若干所述线向量进行向量积运算并求和,构建安装误差的目标函数;
所述目标函数的表达式为:
式中,为预设法向量,为所述轨迹平面内的第个线向量,为所述轨迹平面的第个轨迹点,为所述轨迹平面内选取的轨迹点数目。
2.根据权利要求1所述的惯性导航系统安装误差校正方法,其特征在于,所述姿态变换欧拉角旋转矩阵的表达式为:式中,为姿态变换欧拉角旋转矩阵,、、分别为所述姿态数据中的航向角、俯仰角、横滚角;
所述安装误差欧拉角旋转矩阵的表达式为:
式中,为安装误差欧拉角旋转矩阵,为航向角偏差、为俯仰角偏差、为横滚角偏差。
3.根据权利要求2所述的惯性导航系统安装误差校正方法,其特征在于,所述转换模型的表达式为:式中,为实测三分量磁场值,为联合旋转矩阵,为姿态变换欧拉角旋转矩阵,为安装误差欧拉角旋转矩阵,为标准三分量磁场值;
所述轨迹方程的表达式为:
。
4.根据权利要求1所述的惯性导航系统安装误差校正方法,其特征在于,所述对所述目标函数进行最小化求解,获取姿态数据偏差以及所述捷联式三分量磁测系统所在区域的标准三分量磁场值,以完成惯性导航系统安装误差的校正的步骤包括:对所述目标函数进行最小化求解,当所述目标函数取得最小值时,所述轨迹平面与所述地理坐标系的Z轴垂直;
基于所述目标函数的最小值求解计算对应的安装误差欧拉角旋转矩阵;
对所述捷联式三分量磁测系统进行若干次姿态调整,求解若干个对应的安装误差欧拉角旋转矩阵;
采用非线性最小二乘法对若干个所述安装误差欧拉角旋转矩阵进行参数优化,对参数优化后的安装误差欧拉角旋转矩阵进行重合复原;
根据重合复原后的结果获取所述标准三分量磁场值以及所述惯性导航系统与所述三轴磁力仪之间的航向角偏差、俯仰角偏差、横滚角偏差,以完成惯性导航系统安装误差的校正。
5.一种惯性导航系统安装误差校正系统,其特征在于,包括:第一获取模块,用于获取捷联式三分量磁测系统进行姿态变动后三轴磁力仪的实测三分量磁场值和惯性导航系统的姿态数据,姿态数据包括:航向角、俯仰角、横滚角;
第一构建模块,用于基于所述姿态数据构建姿态变换欧拉角旋转矩阵,构建安装误差欧拉角旋转矩阵;
第二构建模块,用于基于所述实测三分量磁场值、所述安装误差欧拉角旋转矩阵、所述姿态变换欧拉角旋转矩阵以及捷联式三分量磁测系统所在区域的标准三分量磁场值构建转换模型,基于所述转换模型构建轨迹方程;
第三构建模块,用于以地理坐标系Z轴作为预设法向量,根据所述轨迹方程上若干线向量与所述预设法向量构建安装误差的目标函数;
校正模块,用于对所述目标函数进行最小化求解,获取姿态数据偏差以及捷联式三分量磁测系统所在区域的标准三分量磁场值,以完成惯性导航系统安装误差的校正,惯性导航系统安装误差包括:航向角偏差、俯仰角偏差、横滚角偏差;
所述以地理坐标系Z轴作为预设法向量,根据所述轨迹方程上若干线向量与所述预设法向量构建安装误差的目标函数的步骤为:在所述轨迹方程上获取至少三个轨迹点,基于至少三个所述轨迹点构建轨迹平面;
对所述轨迹平面上的轨迹点进行两两差分,获取若干所述轨迹平面的线向量;
将所述预设法向量分别与若干所述线向量进行向量积运算并求和,构建安装误差的目标函数;
所述目标函数的表达式为:
式中,为预设法向量,为所述轨迹平面内的第个线向量,为所述轨迹平面的第个轨迹点,为所述轨迹平面内选取的轨迹点数目。
6.一种存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现如权利要求1至4任一所述的惯性导航系统安装误差校正方法。
7.一种计算机,包括存储器、处理器以及存储在所述存储器上并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至4任一所述的惯性导航系统安装误差校正方法。