一种基于姿态基准与总场约束的航磁矢量校准方法与流程
本申请涉及航磁探测领域,特别是涉及一种基于姿态基准与总场约束的航磁矢量校准方法。
背景技术:
1、航空磁力测量是航空物探领域应用最早、最广的磁测方法,通过将磁传感器及配套设备装载于飞行器上,探测由地下矿体磁性差异引起的磁异常,实现对石油、天然气、金属矿产等资源的快速普查与勘探。
2、为了更贴合探测需求,普遍通过矢量航磁探测获取地磁场三分量方向信息。由于飞行器本身会产生干扰磁场,采集磁场数据后需要对数据进行校准。现有的校准方案中,姿态误差会引入观测矩阵中,影响校准经度,当误差耦合时,会导致校准发散,结果不稳定,存在对姿态误差高度敏感,校准稳定性差的问题。
技术实现思路
1、本申请实施例提供了一种基于姿态基准与总场约束的航磁矢量校准方法,以至少解决相关技术中对姿态误差高度敏感,校准稳定性差的问题。
2、第一方面,本申请实施例提供了一种基于姿态基准与总场约束的航磁矢量校准方法,包括:
3、通过机载航磁设备采集磁通门传感器的探测磁场矢量数据;
4、对所述探测磁场矢量数据取模得到探测矢量总场模量,基于预先获取的磁补偿系数对所述探测矢量总场模量进行误差补偿后构建总场比例约束因子;
5、基于预先获取的磁场单位矢量、所述探测磁场矢量数据和所述探测矢量总场模量,构造磁通门地理旋转矩阵,基于所述磁通门地理旋转矩阵将所述探测磁场矢量数据旋转到地理坐标系,得到定向校正矢量;
6、基于所述总场比例约束因子对所述定向校正矢量进行幅值修正,得到校准后的航磁矢量数据;
7、其中,所述磁补偿系数通过控制机载航磁设备在悬停状态下采集磁通门传感器的悬停磁场矢量数据,并基于误差补偿模型对悬停磁场矢量数据进行运算得到;
8、所述磁场单位矢量通过控制机载航磁设备在悬停状态下采集航姿参考系统的姿态角数据及三分量磁场数据,基于所述姿态角数据构建机体地理旋转矩阵后对三分量磁场数据中的方向余弦进行计算得到。
9、在其中一些实施例中,所述基于预先获取的磁补偿系数对所述探测矢量总场模量进行误差补偿后构建总场比例约束因子,包括:
10、基于预先获取的磁补偿系数对所述探测矢量总场模量进行误差补偿,得到补偿后的第一矢量总场模量;
11、基于所述探测矢量总场模量和所述第一矢量总场模量,构建总场比例约束因子。
12、在其中一些实施例中,所述基于预先获取的磁补偿系数对所述探测矢量总场模量进行误差补偿,得到补偿后的第一矢量总场模量,包括:
13、基于所述探测磁场矢量数据和所述探测矢量总场模量的比值,构建探测状态时的瞬时方向余弦;
14、将所述磁补偿系数、探测状态时的所述瞬时方向余弦输入补偿计算模型中,得到误差总量;
15、计算所述探测矢量总场模量与所述误差总量的差值,得到补偿后的所述第一矢量总场模量。
16、在其中一些实施例中,所述瞬时方向余弦包括第一瞬时方向余弦、第二瞬时方向余弦和第三瞬时方向余弦;所述将所述磁补偿系数、探测状态时的所述瞬时方向余弦输入补偿计算模型中,得到误差总量,进一步包括:
17、所述补偿计算模型设置为:
18、;
19、其中,为所述误差总量,为所述第一瞬时方向余弦,为所述第二瞬时方向余弦,为所述第三瞬时方向余弦,为所述第一瞬时方向余弦的变化率,为所述第二瞬时方向余弦的变化率,为所述第三瞬时方向余弦的变化率,所述磁补偿系数包括第一系数、第二系数、第三系数、第四系数、第五系数、第六系数、第七系数、第八系数、第九系数、第十系数、第十一系数、第十二系数、第十三系数、第十四系数、第十五系数和第十六系数。
20、在其中一些实施例中,所述所述磁补偿系数通过控制机载航磁设备在悬停状态下采集磁通门传感器的悬停磁场矢量数据,并基于误差补偿模型对悬停磁场矢量数据进行运算得到,包括:
21、联立补偿计算模型和第一计算公式;
22、根据所述悬停磁场矢量数据,计算得到悬停矢量总场模量;
23、基于所述悬停磁场矢量数据和所述悬停矢量总场模量的比值,构建悬停状态时的瞬时方向余弦;
24、将悬停状态时的所述瞬时方向余弦和所述悬停矢量总场模量代入联立后的公式,计算得到所述磁补偿系数。
25、在其中一些实施例中,所述姿态角数据包括俯仰角、横滚角、航向角;所述所述磁场单位矢量通过控制机载航磁设备在悬停状态下采集航姿参考系统的姿态角数据及三分量磁场数据,基于所述姿态角数据构建机体地理旋转矩阵后对三分量磁场数据中的方向余弦进行计算得到,包括:
26、基于所述俯仰角、所述横滚角和所述航向角,构建机体地理旋转矩阵;
27、基于所述机体地理旋转矩阵,将三分量磁场数据中的的所述方向余弦转换至地理坐标系下,得到所述磁场单位矢量。
28、在其中一些实施例中,所述基于所述机体地理旋转矩阵,将三分量磁场数据中的所述方向余弦转换至地理坐标系下,得到所述磁场单位矢量,包括:
29、分别计算所述机体地理旋转矩阵与在预设时间窗口内的每一帧在所述机体坐标系下的所述三分量磁场数据中的所述方向余弦的乘积,得到每一帧对应的在所述地理坐标系下的单帧磁场单位矢量;
30、将在预设时间窗口内的所有帧的所述单帧磁场单位矢量求平均,得到在所述地理坐标系下的所述磁场单位矢量。
31、在其中一些实施例中,所述机体地理旋转矩阵设置为:
32、;
33、其中,为所述横滚角,为所述航向角,为所述俯仰角,为所述机体地理旋转矩阵。
34、在其中一些实施例中,所述基于所述磁通门地理旋转矩阵将所述探测磁场矢量数据旋转到地理坐标系,得到定向校正矢量,包括:
35、计算所述磁通门地理旋转矩阵与所述所述探测磁场矢量数据的乘积,得到在地理坐标系下的所述定向校正矢量。
36、在其中一些实施例中,所述基于预先获取的磁场单位矢量、所述探测磁场矢量数据和所述探测矢量总场模量,构造磁通门地理旋转矩阵,包括:
37、所述磁通门地理旋转矩阵设置为:
38、;
39、其中,为所述磁通门地理旋转矩阵,为预先获取的的所述磁场单位矢量,为所述探测磁场矢量数据,为探测矢量总场模量。
40、相比于相关技术,本申请实施例提供的一种基于姿态基准与总场约束的航磁矢量校准方法,简化操作流程,通过将地理坐标系作为标准,构建旋转矩阵和比例因子,避免对外部基准设备的依赖,确保校准后的航磁矢量数据与补偿的第一矢量总场模量完全匹配,解决了对姿态误差高度敏感,校准稳定性差的问题。
41、本申请的一个或多个实施例的细节在以下附图和描述中提出,以使本申请的其他特征、目的和优点更加简明易懂。
1.一种基于姿态基准与总场约束的航磁矢量校准方法,其特征在于,包括:
2.根据权利要求1所述的一种基于姿态基准与总场约束的航磁矢量校准方法,其特征在于,所述基于预先获取的磁补偿系数对所述探测矢量总场模量进行误差补偿后构建总场比例约束因子,包括:
3.根据权利要求2所述的一种基于姿态基准与总场约束的航磁矢量校准方法,其特征在于,所述基于预先获取的磁补偿系数对所述探测矢量总场模量进行误差补偿,得到补偿后的第一矢量总场模量,包括:
4.根据权利要求3所述的一种基于姿态基准与总场约束的航磁矢量校准方法,其特征在于,所述瞬时方向余弦包括第一瞬时方向余弦、第二瞬时方向余弦和第三瞬时方向余弦;所述将所述磁补偿系数、探测状态时的所述瞬时方向余弦输入补偿计算模型中,得到误差总量,进一步包括:
5.根据权利要求1所述的一种基于姿态基准与总场约束的航磁矢量校准方法,其特征在于,所述所述磁补偿系数通过控制机载航磁设备在悬停状态下采集磁通门传感器的悬停磁场矢量数据,并基于误差补偿模型对悬停磁场矢量数据进行运算得到,包括:
6.根据权利要求1所述的一种基于姿态基准与总场约束的航磁矢量校准方法,其特征在于,所述姿态角数据包括俯仰角、横滚角、航向角;所述所述磁场单位矢量通过控制机载航磁设备在悬停状态下采集航姿参考系统的姿态角数据及三分量磁场数据,基于所述姿态角数据构建机体地理旋转矩阵后对三分量磁场数据中的方向余弦进行计算得到,包括:
7.根据权利要求6所述的一种基于姿态基准与总场约束的航磁矢量校准方法,其特征在于,所述基于所述机体地理旋转矩阵,将三分量磁场数据中的所述方向余弦转换至地理坐标系下,得到所述磁场单位矢量,包括:
8.根据权利要求6所述的一种基于姿态基准与总场约束的航磁矢量校准方法,其特征在于,所述机体地理旋转矩阵设置为:
9.根据权利要求1所述的一种基于姿态基准与总场约束的航磁矢量校准方法,其特征在于,所述基于所述磁通门地理旋转矩阵将所述探测磁场矢量数据旋转到地理坐标系,得到定向校正矢量,包括:
10.根据权利要求1所述的一种基于姿态基准与总场约束的航磁矢量校准方法,其特征在于,所述基于预先获取的磁场单位矢量、所述探测磁场矢量数据和所述探测矢量总场模量,构造磁通门地理旋转矩阵,包括:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com