《多旋翼无人机磁罗盘校准方法.docx》由会员分享，可在线阅读，更多相关《多旋翼无人机磁罗盘校准方法.docx（11页珍藏版）》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、多旋翼无人机磁罗盘校准方法程玮玮;宋延华;王伟【摘 要】为提高多旋翼无人机航向角解算精度,争论磁罗盘校准和罗差补偿方法;通过具体分析罗差产生缘由,并结合多旋翼应用,将磁罗盘干扰划分为机体坐标系静态干扰、机体坐标系动态干扰、导航坐标系静态干扰、导航坐标系动态干扰四大类; 针对机体坐标系动态干扰,结合多旋翼应用背景,争论干扰的离线测量与在线补偿方法;针对机体坐标系静态干扰,提出一种飞行过程中实时校准方法;针对导航坐标系静态干扰,创性承受 GNSS 模块的速度方向信息修正罗差;导航坐标系动态干扰为原理性误差,这里暂不争论;结果说明:争论内容可有效补偿机体坐标系动态与静态干扰, 以及导航坐标系静态干扰
2、对磁罗盘和航向角解算精度的影响,有助于改善无人机的飞行性能.【期刊名称】计算机测量与掌握【年(卷),期】2023(027)005【总页数】5 页(P236-239,244)【关键词】磁罗盘;静态干扰;动态干扰;罗差补偿【作 者】程玮玮;宋延华;王伟【作者单位】江苏省宿迁经贸高等职业技术学校,江苏宿迁 223600;江苏省宿迁经贸高等职业技术学校,江苏宿迁 223600;南京信息工程大学信息与掌握学院,南京210044【正文语种】中 文【中图分类】TP2420 引言多旋翼无人机凭借其垂直起降、定点悬停、本钱低廉、使用便利、无人员伤亡等优点，在民用与军事领域得到了广泛的应用。随着应用的推广，用户对
3、无人机的飞行性能和安全性能要求也日益提升。多旋翼无人机的自主飞行时，导航坐标系与机体坐标系之间的转换以航向角为根底。航向角偏差会导致飞行时航线变斜、原地画圈等问题，甚至消灭炸机的危急，严峻影响无人机的飞行性能。因此，如何提高航向角的准确性便显得尤为重要1-2。目前，消费级和低端行业应用级飞控系统普遍承受磁罗盘作为航向测量设备。传感器自身的准确性以及周边环境的磁干扰会对航向角推算产生格外大的影响。针对如何校准磁罗盘，猎取准确的航向信息，国内外机构都进展了大量的争论3-6。传统的多旋翼无人机磁罗盘校准方法大都承受三维旋转，并对采集到的磁场数据椭圆拟合校准实现7。然而，在具体应用时，用户往往会无视这
4、个步骤，只有在觉察角度误差较大的状况下才会进展校准地磁。而在飞行过程中觉察角度偏差较大， 存在格外大的安全隐患。随着无人机行业应用进展，无人机轴距越来越大，转圈椭圆拟合校准的方法已经越来越困难。此外，该校准方法仅对磁罗盘零偏和机体上的固定干扰有效，而无视了机体产生的动态干扰以及周边环境的磁场干扰对磁罗盘产生的影响，具有肯定的局限性。本文结合多旋翼无人机的具体应用，从分析磁罗盘干扰的来源着手，进展机体坐标系的动态与静态校准。并结合多旋翼的应用背景，承受 GNSS 模块输出的速度方向信息对航向角进展补偿，得到准确的航向角，保障无人机的飞行性能。1 磁罗盘工作原理与测量误差分析1.1 磁罗盘工作原理
5、磁罗盘是一种可测量环境磁场强度的传感器件，在多旋翼无人机领域应用格外广泛。由于地球外表存在地磁场，且同一地理位置的地磁场的大小和方向根本保持恒定的。地磁场方向与地理北极的夹角称之为磁偏角。通过测量地磁场向量在磁罗盘内部三 个相互垂直的坐标轴的磁场重量即可确定航向角。磁罗盘一般与多旋翼机体固连，为便利争论，建立机体坐标系与导航坐标系如下8：1) 导航坐标系:导航坐标系可选取当地便于导航计算的点为原点 On，Zn 沿重力方向竖直向下，Xn 指向正北方向，Yn 指向正东方向。2) 机体坐标系:机体坐标系以机体的质心为原点 Ob，Zb 垂直于机体平面垂直向下， Xb 指向飞行器前方，Yb 指向飞行器右
6、方。机体坐标系与导航坐标系间的夹角即为机体的姿势角。机体坐标系 Xb 轴与导航坐标系 OnYnZn 平面的夹角定义为俯仰角 ；机体坐标系 Zb 轴与通过机体坐标系Xb 轴的铅垂面间的夹角定义为滚转角 ；机体坐标系 Xb 轴在导航坐标系OnXnYn 平面的投影与正北方向的夹角定义航向角 ，坐标系与姿势角示意图如图 1 所示。图 1 坐标系与姿势角定义导航坐标系下地磁场向量 bNE 与机体坐标系下地磁场向量 bBE 可表示为: (1)(2)式中，bnex、bney、bnez 分别为地磁场在导航坐标系下三轴的磁场强度重量。Bbex、bbey、bbez 分别为地磁场在机体坐标系下三轴的磁场强度重量。假
7、设载体三维空间运动时，其滚转、俯仰、航向角分别为 、，则有关系式:(3)式中，为机体坐标系到导航坐标系的旋转矩阵，令 c=cos，s=sin，则旋转矩阵可表示为:(4)不考虑磁偏角前提下，地磁场方向与地理正北方向重合，其 Y 轴重量 bney 恒等于零，结合式(3)、式(4)则可求得航向角:(5)1.2 磁罗盘误差分析磁罗盘测量误差来源因素很多, 包括硬磁干扰、软磁干扰、传感器仪表误差等9。依据干扰磁场源的相对位置以及干扰磁场强度是否恒定，可将干扰划分为机体坐标系下的静态磁干扰、机体坐标系下的动态磁干扰、导航坐标系下的静态磁干扰、导航坐标系下的动态磁干扰四类。则机体坐标系下磁罗盘示数 bB 可
8、表示为:bB =bBE +bBs +bBd +RBNTbNs +RBNTbNd (6)式中，RBNT 为旋转矩阵的转置，bBs 为机体坐标系下的静态干扰磁场，主要为机体上电机等磁感器件产生的相对机体恒定的磁场，以及磁罗盘自身的零偏等。bBd 为机体坐标系下的动态干扰磁场，主要为多旋翼无人机飞行时，变化的电流产生的时变磁场。bNs 为外部环境中的静态干扰，如飞行环境中存在额外的恒定磁场。bNd 为导航坐标系下动态干扰。当飞行环境消灭动态干扰时，已不适宜承受磁罗盘测量航向，属于原理性问题。因此，论文仅对前三种误差补偿进展具体分析，式(6)即可简化为:bB =bBE +bBs +bBd +RBNTb
9、Ns(7)2 机体坐标系动态干扰校准多旋翼无人机机体坐标系动态干扰校准的核心思想为：飞控系统安装完毕后，磁罗盘位置相对固定。磁罗盘的动态干扰主要为飞行中电机与动力线产生的干扰磁场， 其磁场强度应与电机转速有直接对应关系。因此，可通过事先逐个测试电机在不同转速指令下产生的干扰磁场，拟合出对应关系式。后续飞行过程中，依据每个电机的掌握指令求得其产生的干扰磁场，叠加后即为合成的动态干扰磁场。将磁罗盘原始数据减去合成的动态干扰磁场，即可得到准确的磁场数据。以六轴植保机为例，首先逐个缓慢变化各电机 PWM 指令，其它电机保持静止。采集该电机转动时对三轴磁场数据的影响。测试过程中，电机的转速指令需缓慢变化
10、，如图 2 所示。电机转动引起的 X、Y、Z 轴的磁场强度变化曲线如图 3 所示。图 2 电机转速指令图 3 磁场强度变化曲线图 3 可以觉察，电机转动时，三轴磁场强度有较为明显变化。为猎取其对应关系，承受三阶多项式拟合电机指令到三轴磁场强度变化量的关系式。以1 号电机为例， X、Y、Z 轴的三阶多项式可表示为:(8)式中,bBd1 为 1 号电机产生的动态干扰，mx1、my1、mz1 电机转动引起的三轴磁场的变化量，a、b、c 为三阶多项式系数，u 为电机指令。拟合曲线如图 4 所示。图 4 一号电机拟合曲线图同样方法，可以得到 26 号电机指令与产生的干扰磁场 bBd2-bBd6 关系式，
11、则全部电机的动态干扰磁场 bBd 可表示为:bBd=bBd1+bBd2+bBd3+bBd4+bBd5+bBd6 (9)动态干扰校准后，系统再次依据图 1 的转速指令工作时，三轴磁场强度如图 5 所示。比照与图 2，其磁场强度变化幅度明显减小，并趋于一条稳定直线。因此，该校准方法对电机产生的动态干扰有了明显的改善。实际应用时，依据飞行过程中的实时电机指令，在线求得其产生的动态干扰并校准，以获得更为准确的磁场强度信息。图 5 动态干扰校准后磁场强度变化曲线3 机体坐标系静态干扰校准机体坐标系静态干扰主要包括机体磁感材料产生的恒定磁干扰以及传感器零偏。这类干扰的主要特点是，其干扰磁场向量在机体坐标系
12、下恒定不变。为便利校准，争论一种型的静态干扰磁场校准方法。该方法利用的测量的磁场向量的变化趋势， 实现飞行过程中的实时校准。假设机体坐标系动态干扰校准完成，式(7)可表示为: bB =bBE +bBs +RBNTbNs(10)旋转矩阵的转置等于矩阵的逆:RBNT=RBN- 1(11)结合式(3)、式(10)可得:(12)由于 bNE 与 bNs 在导航坐标系下恒定不变，令:bNE=bNE+bNs(13)矢量大小的平方可由其自身的点积求得，用矩阵表示法表示即为向量的转置乘以本身，则有:|bB -bBs |2= (RBNTbE)T(RBNTbE) = |bE|2 (14)将上式开放，得到:(15)
13、选取任意两个时刻点状态，分别为:(16)(17)将式(16)与式(17)相减得:(18)由式(18)无法直接求得准确的静态磁场干扰，但给出干扰的方向信息。即 bB2 与bB1 模值的相对大小打算了向量(bB2-bB1)与 bBs 之间的夹角为钝角还是锐角， 因此可以依据 bBs 的方向逐步累积补偿其偏差。(19)为估量的静态干扰，ks 为增益参数。通过调整 k 可实现数值稳定性和收敛速度的平衡的每一次更都会进一步向真实的静态干扰收敛。当稳定后，bB2 与 bB1 的模值相等，即为最终推算的机体坐标系静态干扰。试验时，事先人为给定静态偏差:(20)飞行校准过程中，不断转变机头方向，算法推想的静态
14、干扰的变化曲线如图 6 所示。图中可觉察推想量经过约 7 s 可收敛到真实偏差四周，验证了该静态校准方法的有效性。图 6 推想的静态干扰变化曲线4 导航坐标系静态干扰的罗差补偿经机体坐标系静态补偿校准后，式(10)可更为:(21)依据式(5)求得的航向角与真实角度之间的误差即为(bNE+bNs)合成向量在水平面投影与地理正北的夹角。因 bNE 与 bNs 恒定不变，航向角误差亦恒定不变，假设 为推算的航向角 m 和真实的航向角 0 之间的误差，则有:m=0+ (22)由于 恒定，可通过高精度仪器校准补偿10。但是该方法依靠于高精度仪器，不适应于户外作业。因此，本文争论一种飞行过程中的罗差补偿方
15、法。多旋翼无人机速度飞行模式一般基于导航坐标系。以前飞为例，其速度掌握器运行过程可描述为：遥控器操作产生前向速度目标值；测量 GNSS 模块速度反响值； 掌握器运算生成姿势角掌握量并将姿势角掌握量分解到机体坐标系。下面对该过程进展具体推导。遥控器前向操作时，对应的前向速度目标值为 rvx，则北向和东向的速度目标值rvn、rve 可表示为:(23)初始悬停状态下，反响速度为零，PID 掌握器积重量为零，生成的掌握量 uvn、uve 可近似表示为:(24)式中，kp 为比例系数，将 uvn、uve 转换到机体坐标系:(25)由式(23)、式(24)、式(25)可得:(26)因此，无人机初期运动方向
16、即为机头朝向。后续因速度反响以及掌握器积分项作用， 飞机的运动方向会渐渐收敛并稳定与测量航向角 m 方向。算法利用初期阶段飞机运动方向与测量的航向角方向的偏差即用于航向角罗差补偿。补偿算法具体操作流程图如图 7 所示，并可分为以下几个步骤。图 7 航向角补偿算法流程图步骤 1：依据推算误差 k-1 和当前测量航向角 mk 更航向角 k。k=mk-k-1(27)步骤 2：速度飞行模式下，仅操作遥控器 Pitch 通道，并依据误 k 进展掌握分解。采集 GNSS 模块东向和北向的实时速度 vek 和 vnk，计算 vk。(28)步骤 3：计算无人机实际运动方向 vk 与该时刻航向角 k 的误差 e
17、k。ek=vk-k(29)步骤 4：利用 ek 对航向角误差 进展更，积分补偿系数为 k。(30)测试时，人为给定航向角 30的偏移量，为测试便利，机头指向正北方向，经两次飞机前后运动，航向角误差 估量结果如图 8 所示。图中可以觉察航向角误差 可快速收敛到 30，验证了该在线航向角订正方法的有效性。图 8 航向角误差推算结果图5 完毕语本文分析多旋翼无人机磁罗盘罗差产生的缘由，将磁罗盘干扰分为机体坐标系静态 干扰、机体坐标系动态干扰、导航坐标系静态干扰、导航坐标系静态干扰四种类型。针对不同类型干扰进展了动态校准、静态校准、磁航向补偿等争论。得到以下结论。1)机体坐标系动态干扰校准方法可有效补
18、偿无人机飞行时，电机与动力线产生的动 态变化磁场对磁罗盘的影响；2) 机体坐标系静态干扰校准方法可实现飞行过程中实时校准，解决静态固定干扰和磁罗盘零偏的影响；3) 针对外部恒定磁场干扰，承受 GNSS 模块速度方向信息实现在线补偿。因此，通过论文争论的磁罗盘系统化校准与补偿方法，可解决现阶段绝大局部的磁罗盘干扰问题，提高航向角推算精度，保障多旋翼无人机的飞行性能。【相关文献】1 张永宏, 焦 凯, 王 伟. 旋翼无人机的偏航掌握系统设计J. 制造业自动化, 2023, 37(16): 143- 146+156.2 Nguyen H N，Zhou J，Kang H J A calibration
19、 method for enhancing robot accuracy through integration of an extended Kalman filter algorithm and an artificial neural networkJ.Neurocomputing，2023,151: 996-1005.3 徐德昌, 蔡成林, 李思民, 等. 一种手持式电子磁罗盘航向误差校正方法J. 电子器件, 2023, 41(5): 1275-1279.4 何 磊,罗 兵,吴文启.基于 DGPS 航迹偏差的多旋翼无人机磁干扰检测技术争论J. 计算机测量与掌握, 2023, 25(10
20、): 39-42.5 Ousaloo H S, Sharifi G, Mahdian J, et al. Complete calibration of three-axis strapdown magnetometer in mounting frame J. IEEE Sensors Journal, 2023, PP(99):1-1.6 贺云凯,刘卫玲,韦 啸,等.电子罗盘水平状态下航向角误差补偿算法的争论J. 计算机测量与掌握, 2023, 22(8): 2515-2517.7 Kok M，Hol J D，Schn T B Indoor positioning using ultrawideband and inertial measurementsJ IEEE Transactions on Vehicular Technology, 2023, 64( 4): 1293-1303.8 徐金琦. 多旋翼无人机的嵌入式自主飞行掌握系统设计D. 南京:南京信息工程大学, 2023.9 闻秋香, 罗向前, 孙君道. 磁罗盘工程校准方法争论J. 科学技术与工程, 2023, 11(28): 6936- 6939.10 戴 磊, 齐俊桐, 吴 冲, 等. 旋翼飞行机器人磁罗盘误差分析及校准J.机器人, 2023, 34(4): 418- 423.