一种抗磁干扰的方法技术

本发明专利技术涉及抗磁干扰领域，尤其涉及一种抗磁干扰方法。本发明专利技术公开设计的一种抗磁干扰方法，通过同时使用了磁场强度变化、磁倾角变化及地理系的磁场分量变化这几个量的变化来判断是否有磁场干扰，能够更为准确的判断是否有磁场干扰；当磁场存在磁场干扰并且磁场干扰持续时间较长时，避免了长期单纯使用陀螺仪积分计算航向角，导致航向角发散的问题，在此种情况下，记录利用磁强计数据对航向角进行修正，从而避免了航向角发散，且当有磁场干扰并且磁场干扰持续时间较长时，提出的航向角修正过程不仅能够有效的削弱和控制磁场干扰对航向角测量精度的干扰，同时保证了航向角的测量精度。

【技术实现步骤摘要】

本专利技术涉及抗磁干扰领域，尤其涉及一种抗磁干扰的方法。
技术介绍
在MEMS姿态测量系统中，仅使用MEMS加速度计和MEMS陀螺仪组成的惯性测量单元，由于陀螺仪的角速度漂移以及缺乏航向角的观测和修正信息，航向角的输出精度无法满足姿态测量系统的长时间精度要求。因此，近几年将磁强计与惯性测量单元集成后组成的MEMS航姿参考系统得到了广泛的研究和应用，特别是应用在微小型无人机中。MEMS航姿参考系统是一种由相互正交的三轴陀螺仪、三轴加速度计以及三轴磁强计组成，通过数据融合算法精确测量空间姿态的传感系统。MEMS航姿系统中集成的MEMS磁强计主要是用于修正姿态测量系统的航向角误差，提高航向角测量精度和长期稳定性。当MEMS航姿系统应用于微小型无人机时，其工作环境主要为低空区域，系统中集成的MEMS磁强计极易受地面局部磁场干扰以及机载电机磁场等的干扰而导致航向角测量不准确。一般的磁强计校准方法包括硬件校准及软件校准方法，如通过最小二乘拟合或最佳椭圆拟合补偿等软件校准方法，都是在地球磁场固定不变或未受干扰时对磁强计进行的校准，当磁强计受到磁场干扰时，常规的校准补偿方法将无法消除干扰引起的航向本文档来自技高网...

【技术保护点】
一种抗磁干扰的方法，其特征在于，所述方法包括：于无磁场干扰环境中对无人飞行器中的MEMS磁强计进行校准；根据预先设定的磁场变化阈值判断当前环境是否有磁场干扰，并根据预先设定的磁场干扰持续时间阈值判断磁场干扰时间；若无磁场干扰，则使用所述MEMS磁强计对无人飞行器进行航向角修正，若有磁场干扰，且磁场干扰时间小于所述磁场干扰持续时间阈值，则通过所述无人飞行器内置陀螺仪积分计算得出所述无人飞行器的航向角，若磁场干扰时间大于等于所述磁场干扰持续时间阈值，利用机体系航向误差修正角速率与所述陀螺仪输出的差值对所述无人飞行器的航向角进行修正。

【技术特征摘要】
1.一种抗磁干扰的方法，其特征在于，所述方法包括：于无磁场干扰环境中对无人飞行器中的MEMS磁强计进行校准；根据预先设定的磁场变化阈值判断当前环境是否有磁场干扰，并根据预先设定的磁场干扰持续时间阈值判断磁场干扰时间；若无磁场干扰，则使用所述MEMS磁强计对无人飞行器进行航向角修正，若有磁场干扰，且磁场干扰时间小于所述磁场干扰持续时间阈值，则通过所述无人飞行器内置陀螺仪积分计算得出所述无人飞行器的航向角，若磁场干扰时间大于等于所述磁场干扰持续时间阈值，利用机体系航向误差修正角速率与所述陀螺仪输出的差值对所述无人飞行器的航向角进行修正。2.根据权利要求1所述的方法，其特征在于，所述方法还包括：记录当前时刻所述MEMS磁强计的输出值、所述陀螺仪的输出值和加速度计的输出值；根据所述陀螺仪的输出值和所述加速度计的输出值计算出当前时刻所述无人飞行器的姿态转移矩阵。3.根据权利要求2所述的方法，其特征在于，所述方法还包括：根据磁强计输出以及当前时刻所述无人飞行器的姿态转移矩阵计算地理系磁场分量，同时根据磁强计输出计算磁场强度、磁倾角。4.根据权利要求3所述的方法，其特征在于，所述方法还包括：将当前环境中的所述磁场强度、所述磁倾角和所...

【专利技术属性】
技术研发人员：杭义军，邢丽，贾文峰，吕印新，
申请(专利权)人：极翼机器人上海有限公司，
类型：发明
国别省市：上海;31