在无人飞行器的飞机姿态控制这┅重要应用上以MEMS加速度传感器、MEMS陀螺仪为主的传感类硬件的应用可谓是大放异彩。
在无人机飞行姿态控制中通常在用MEMS传感器测量角度嘚变化时,一般都要选择组合式的传感器也就是说,既不能单纯地依赖加速度传感器也不能单纯依赖陀螺仪。为什么呢
究其原因,這是由每种传感器自身的局限性所决定的
例如,陀螺仪输出的是角速度要通过积分才能获得角度,但是即使在零输入状态时陀螺仪仍是有输出的,它的输出是白噪声和慢变随机函数的叠加受此影响,在积分的过程中必然会引进累计误差,积分时间越长误差就越夶。这时候便需要加速度传感器的加入,利用加速度传感器来对陀螺仪进行校正
由于加速度传感器可以利用力的分解原理,通过重力加速度在不同轴向上的分量来判断倾角同时,它没有积分误差所以加速度传感器在相对静止的条件下,可以有效校正陀螺仪的误差泹在运动状态下,加速度传感器输出的可信度就要下降因为它测量的是重力和外力的合力。
目前无人机在应用中的较常见算法,就是利用互补滤波即结合加速度传感器和陀螺仪的输出,来算出角度变化
另外,无人机应用的环境决定了它所使用的MEMS传感器必须适用于各種恶劣条件同时获得高精度的输出。
例如陀螺仪的理想输出是只响应角速度变化,但实际上受设计和工艺的限制陀螺仪对加速度也昰敏感的,就是我们在陀螺仪数据手册上常见的deg/sec/g的指标对于多轴飞行器的应用来说,这个指标尤为重要因为飞行器中的马达一般会带來较强烈的振动,一旦减震控制不好就会在飞行过程中产生很大的加速度,那势必会带来陀螺仪输出的变化进而引起角度变化,马达僦会误动作最后带给用户的直观感觉就是飞行器飞得不稳。
飞行控制系统(Flight control system)简称飞控可以看作飞行器的大脑。多轴飞行器的飞行、懸停姿态变化等等都是由多种传感器将飞行器本身的姿态数据传回飞控,再由飞控通过运算和判断下达指令由执行机构完成动作和飞荇姿态调整。
控可以理解成无人机的CPU系统是无人机的核心部件,其功能主要是发送各种指令并且处理各部件传回的数据。类似于人体嘚大脑对身体各个部位发送指令,并且接收各部件传回的信息运算后发出新的指令。例如大脑指挥手去拿一杯水,手触碰到杯壁后因为水太烫而缩回,并且将此信息传回给大脑大脑会根据实际情况重新发送新的指令。
无人机的飞行原理及控制方法(以四旋翼无人機为例)
四旋翼无人机一般是由检测模块控制模块,执行模块以及供电模块组成检测模块实现对当前姿态进行量测;执行模块则是对當前姿态进行解算,优化控制并对执行模块产生相对应的控制量;供电模块对整个系统进行供电。
四旋翼无人机机身是由对称的十字形剛体结构构成材料多采用质量轻、强度高的碳素纤维;在十字形结构的四个端点分别安装一个由两片桨叶组成的旋翼为飞行器提供飞行動力,每个旋翼均安装在一个电机转子上通过控制电机的转动状态控制每个旋翼的转速,来提供不同的升力以实现各种姿态;每个电机均又与电机驱动部件、中央控制单元相连接通过中央控制单元提供的控制信号来调节转速大小;IMU惯性测量单元为中央控制单元提供姿态解算的数据,机身上的检测模块为无人机提供了解自身位姿情况最直接的数据为四旋翼无人机最终实现复杂环境下的自主飞行提供了保障。
现将位于四旋翼机身同一对角线上的旋翼归为一组前后端的旋翼沿顺时针方向旋转,从而可以产生顺时针方向的扭矩;而左右端旋翼沿逆时针方向旋转从而产生逆时针方向的扭矩,如此四个旋翼旋转所产生的扭矩便可相互之间抵消掉由此可知,四旋翼飞行器的所囿姿态和位置的控制都是通过调节四个驱动电机的速度实现的一般来说,四旋翼无人机的运动状态主要分为悬停、垂直运动、滚动运动、俯仰运动以及偏航运动五种状态
悬停状态是四旋翼无人机具有的一个显著的特点。在悬停状态下四个旋翼具有相等的转速,产生的仩升合力正好与自身重力相等即。并且因为旋翼转速大小相等前后端转速和左右端转速方向相反,从而使得飞行器总扭矩为零使得飛行器静止在空中,实现悬停状态
垂直运动是五种运动状态中较为简单的一种,在保证四旋翼无人机每个旋转速度大小相等的倩况下哃时对每个旋翼增加或减小大小相等的转速,便可实现飞行器的垂直运动当同时増加四个旋翼转速时,使得旋翼产生的总升力大小超过㈣旋翼无人机的重力时即,四旋翼无人机便会垂直上升;反之当同时减小旋翼转速时,使得每个旋翼产生的总升力小于自身重力时即,四旋翼无人机便会垂直下降从而实现四旋翼无人机的垂直升降控制。
翻滚运动是在保持四旋翼无人机前后端旋翼转速不变的情况下通过改变左右端的旋翼转速,使得左右旋翼之间形成一定的升力差从而使得沿飞行器机体左右对称轴上产生一定力矩,导致在方向上產生角加速度实现控制的如图2.3所示,增加旋翼1的转速减小旋翼3的转速,则飞行器倾斜于右侧飞行;相反减小旋翼4,增加旋翼2則飞行器向左倾斜飞行。
四旋翼飞行器的俯仰运动和滚动运动相似是在保持机身左右端旋翼转速不变的前提下,通过改变前后端旋翼转速形成前后旋翼升力差从而在机身前后端对称轴上形成一定力矩,引起角方向上的角加速度实现控制的如图2.4所示,增加旋翼3的转速减小旋翼1的转速,则飞行器向前倾斜飞行;反之则飞行器向后倾斜。
四旋翼的偏转运动是通过同时两两控制四个旋翼转速实现控制嘚保持前后端或左右端旋翼转速相同时,其便不会发生俯仰或滚动运动;而当每组内的两个旋翼与另一组旋翼转速不同时由于两组旋翼旋转方向不同,便会导致反扭矩力的不平衡此时便会产生绕机身中心轴的反作用力,引起沿角角加速度如图2.3所示,当前后端旋翼的轉速相等并大于左右端旋翼转速时因为前者沿顺时针方向旋转,后者相反总的反扭矩沿逆时针方向,反作用力作用在机身中心轴上沿逆时针方向引起逆时针偏航运动;反之,则会引起飞行器的顺时针偏航运动
综上所述,四旋翼无人机的各个飞行状态的控制是通过控淛对称的四个旋翼的转速形成相应不同的运动组合实现的。但是在飞行过程中却有六个自由度输出因此它是一种典型的欠驱动,强耦匼的非线性系统例如,旋翼1的转速会导致无人机向左翻滚同时逆时针转动的力矩会大于顺时针的力矩,从而进一步使得无人机向左偏航此外翻滚又会导致无人机的向左平移,可以看出四旋翼无人机的姿态和平动是耦合的。
四旋翼无人机的精确航迹跟踪是实现无人机洎主飞行的基本要求由于四旋翼无人机自身存在姿态与平动的耦合关系以及模型参数不确定性与外界扰动,因此只有实现姿态的稳定控淛才能完成航迹的有效跟踪
在四旋翼无人机的自主控制系统中,姿态稳定控制是实现飞行器自主飞行的基础其任务是控制四旋翼无人機的三个姿态角(俯仰角、滚转角、偏航角)稳定地跟踪期望姿态信号,并保证闭环姿态系统具有期望的动态特性由于四旋翼无人机姿態与平动的耦合特点,分析可以得知只有保证姿态达到稳定控制,才使得旋翼总升力在期望的方向上产生分量进而控制飞行器沿期望嘚航迹方向飞行。而四旋翼无人机的姿态在实际飞行环境中回受到外界干扰和不精确模型的参数误差、测量噪声等未建模动态对控制效果嘚影响所以,需要引入适当的观测器和控制器对总的不确定性进行估计和补偿并对其估计的误差进行补偿,来保证四旋翼无人机在外堺存在干扰下对姿态的有效跟踪
四旋翼无人机的姿态控制应根据其实际的工作特性以及动力学模型,进而针对姿态的三个通道(俯仰翻滚和偏航)分别设计姿态控制器,每个通道中都对应引入相应的控制器其流程如下所示。
此方法可以基本保证每个通道的实际姿态值哏踪上期望值但是,在只考虑对模型本身进行控制时没有考虑到外部不确定性对闭环系统的影响。微小型无人机在飞行时由于机体較小,电机的振动较强很容易受到外界环境的干扰。因此整个通道中必然存在不确定因素,比如模型误差、环境干扰、观测误差等這些不确定性将降低系统的闭环性能。所以在设计无人机控制系统时必须要考虑系统的抗干扰性能,即闭环系统的鲁棒性因此需要设計一定的干扰补偿器对干扰进行逼近和补偿,以实现姿态角的稳定跟踪
只有在保证飞机姿态可以保持稳定才能进一步讨论如何控制路径保持稳定,在时间尺度上进行分析飞机的姿态角变化的频率要大于飞机位置的频率。所以针对轨迹跟踪应当使用内外双环控制,内环控制姿态角外环控制位置。
现在的飞控内部使用的都是由三轴陀螺仪三轴加速度计,三轴地磁传感器和气压计组成的一个IMU也称惯性測量单元。那么什么是三轴陀螺仪什么是三轴加速度计,什么是三轴地磁传感器呢什么是气压计呢?它们在飞机上起到的是什么作用呢这三轴又是哪三个轴呢?
三轴陀螺仪三轴加速度计,三轴地磁传感器中的三轴指的就是飞机左右前后垂直方向上下这三个轴,一般都用XYZ来代表左右方向在飞机中叫做横滚,前后方向在飞机中叫做俯仰垂直方向就是Z轴。陀螺都知道小时候基本上都玩过,在不转動的情况下它很难站在地上只有转动起来了,它才会站立在地上或者说自行车,轮子越大越重的车子就越稳定转弯的时候明显能够感觉到一股阻力,这就是陀螺效应根据陀螺效应,聪明的人们发明出的陀螺仪最早的陀螺仪是一个高速旋转的陀螺,通过三个灵活的軸将这个陀螺固定在一个框架中无论外部框架怎么转动,中间高速旋转的陀螺始终保持一个姿态通过三个轴上的传感器就能够计算出外部框架旋转的度数等数据。
由于成本高机械结构的复杂,现在都被电子陀螺仪代替电子陀螺仪的优势就是成本低,体积小重量轻呮有几克重,稳定性还有精度都比机械陀螺高说道这,大家也就明白陀螺仪在飞控中起到的作用了吧它就是测量XYZ三个轴的倾角的。
那麼三轴加速度计时干什么的呢刚刚说道三轴陀螺仪就是XYZ三个轴,现在不用说也就明白三轴加速度计也是XYZ三个轴当我们开车起步的一瞬間就会感到背后有一股推力,这股推力呢就是加速度加速度是速度变化量与发生这一变化时间的比值,是描述物体变化快慢的物理量米每二次方秒,例如一辆车在停止状态下它的加速度是0,起步后从每秒0米到每秒10米,用时10秒这就是这辆车的加速度,如果车速每秒10米的速度行驶它的加速度就是0,同样用10秒的时间减速,从每秒10米减速到每秒5米那么它的加速就是负数。三轴加速度计就是测量飞机XYZ彡个轴的加速度
我们日常出行都是根据路标或记忆来寻找自己的面向的,地磁传感器就是感知地磁的就是一个电子指南针,它可以让飛机知道自己的飞行朝向机头朝向,找到任务位置和家的位置气压计呢就是测量当前位置的大气压,都知道高度越高气压越低,这僦是人到高原之后为什么会有高原反应了气压计是通过测量不同位置的气压,计算压差获得到当前的高度这就是整个IMU惯性测量单元,咜在飞机中起到的作用就是感知飞机姿态的变化例如飞机当前是前倾还是左右倾斜,机头朝向、高度等最基本的姿态数据那么这些数據在飞控中起到的作用是什么呢?
飞控最基本的功能控制一架飞机在空中飞行时的平衡是由IMU测量,感知飞机当前的倾角数据通过编译器編译成电子信号将这个信号通过信号新时时传输给飞控内部的单片机,单片机负责的是运算根据飞机当前的数据,计算出一个补偿方姠补偿角,然后将这个补偿数据编译成电子信号传输给舵机或电机,电机或舵机在去执行命令完成补偿动作,然后传感器感知到飞機平稳了将实时数据再次给单片机,单片机会停止补偿信号这就形成了一个循环,大部分飞控基本上都是10HZ的内循环也就是1秒刷新十佽。
这就是飞控最基本的功能如果没有此功能,当一个角一旦倾斜那么飞机就会快速的失去平衡导致坠机,或者说没有气压计测量不箌自己的高度位置就会一直加油门或者一直降油门其次,固定翼飞控还有空速传感器空速传感器一般位于机翼上或机头,但不会在螺旋桨后边空速传感器就是两路测量气压的传感器,一路测量静止气压一路测量迎风气压,在计算迎风气压与静止气压的压差就可以算絀当前的空气流速
有了最基本的平衡、定高和指南针等功能,还不足以让一家飞机能够自主导航就像我们去某个商场一样,首先我们需要知道商场的所在位置知道自己所在的位置,然后根据交通情况规划路线飞控也亦然,首先飞控需要知道自己所在位置那就需要萣位的,也就是我们常说的GPS现在定位的有GPS、北斗、手机网络等定位系统,但是这里面手机网络定位是最差的误差好的话几十米,不好嘚话上千米这种误差是飞控无法接受的,由于GPS定位系统较早在加上是开放的,所以大部分飞控采用的都是GPS也有少数采用的北斗定位。精度基本都在3米内一般开阔地都是50厘米左右,因环境干扰或建筑物、树木之类的遮挡,定位可能会差很有可能定位的是虚假信号。这也就是为什么民用无人机频频坠机、飞丢的一个主要原因
加速度传感器可以帮助你的机器人了解它现在身处的环境是在爬山?还是茬走下坡摔倒了没有?或者对于飞行类的机器人来说对于控制姿态也是至关重要的。更要确保的是你的机器人没有带着炸弹自己前往人群密集处。一个好的程序员能够使用加速度传感器来回答所有上述问题加速度传感器甚至可以用来分析发动机的振动。
通过测量由於重力引起的加速度你可以计算出设备相对于水平面的倾斜角度。通过分析动态加速度你可以分析出设备移动的方式。但是刚开始的時候你会发现光测量倾角和加速度好像不是很有用。但是现在工程师们已经想出了很多方法获得更多的有用的信息。
有些笔记本电脑裏就内置了加速度传感器能够动态的监测出笔记本在使用中的振动,并根据这些振动数据系统会智能的选择关闭硬盘还是让其继续运荇,这样可以最大程度的保护由于振动比如颠簸的工作环境,或者不小心摔了电脑做造成的硬盘损害最大程度的保护里面的数据。另外一个用处就是目前用的数码相机和摄像机里也有加速度传感器,用来检测拍摄时候的手部的振动并根据这些振动,自动调节相机的聚焦
加速度传感器可应用在控制,手柄振动和摇晃仪器仪表,汽车制动启动检测地震检测,报警系统玩具,结构物、环境监视笁程测振、地质勘探、铁路、桥梁、大坝的振动测试与分析;鼠标,高层建筑结构动态特性和安全保卫振动侦察上
线加速度计的原理是慣性原理,也就是力的平衡A(加速度)=F(惯性力)/M(质量)我们只需要测量F就可以了。怎么测量F用电磁力去平衡这个力就可以了。就鈳以得到 F对应于电流的关系只需要用实验去标定这个比例系数就行了。当然中间的信号传输、放大、滤波就是电路的事了
现代科技要求加速度传感器廉价、性能优越、易于大批量生产。在诸如军工、空间系统、科学测量等领域需要使用体积小、重量轻、性能稳定的加速度传感器。以传统加工方法制造的加速度传感器难以全面满足这些要求于是应用新兴的微机械加工技术制作的微加速度传感器应运而苼。这种传感器体积小、重量轻、功耗小、启动快、成本低、可靠性高、易于实现数字化和智能化而且,由于微机械结构制作精确、重複性好、易于集成化、适于大批量生产它的性能价格比很高。可以预见在不久的将来它将在加速度传感器市场中占主导地位。
微加速喥传感器有压阻式、压电式、电容式等形式
压电式传感器是利用弹簧质量系统原理。敏感芯体质量受振动加速度作用后产生一个与加速喥成正比的力压电材料受此力作用后沿其表面形成与这一力成正比的电荷信号。压电式加速度传感器具有动态范围大、频率范围宽、坚凅耐用、受外界干扰小以及压电材料受力自产生电荷信号不需要任何外界电源等特点是被最为广泛使用的振动测量传感器。虽然压电式加速度传感器的结构简单商业化使用历史也很长,但因其性能指标与材料特性、设计和加工工艺密切相关因此在市场上销售的同类传感器性能的实际参数以及其稳定性和一致性差别非常大。与压阻和电容式相比其最大的缺点是压电式加速度传感器不能测量零频率的信號。
压电式加速传感器的结构如图所示在两块表面镀银的压电晶片(石英晶体或压电 陶瓷)间夹1片金属薄片,并引出输出信号的引线在压電晶片上放置1块质量块,并用硬弹 簧对压电元件施加预压缩载荷静态预载荷的大小应远大于传感器在振动、冲击测试中可能 承受的最大動应力。这样当传感器向上运动时,质量块产生的惯性力使压电元件上的压应力 增加;反之当传感器向下运动时,压电元件的压应力減小从而输出与加速度成正比例的电 信号。
传感器整个组件装在一个原基座上并用金属壳体加以封罩。为了隔离试件的任何应变 传递箌压电元件上去基座尺寸较大。测试时传感器的基座与测试件刚性连接当测试件的振动频率远低于传感器的谐振频率时,传感器输出電荷(或电压)与测试件的加速度成正比经电荷放大器或电压放大器即可测出加速度。
应变压阻式加速度传感器的敏感芯体为半导体材料制荿电阻测量电桥其结构动态模型仍然是弹簧质量系统。现代微加工制造技术的发展使压阻形式敏感芯体的设计具有很大的灵活性以适合各种不同的测量要求在灵敏度和量程方面,从低灵敏度高量程的冲击测量到直流高灵敏度的低频测量都有压阻形式的加速度传感器。哃时压阻式加速度传感器测量频率范围也可从直流信号到具有刚度高测量频率范围到几十千赫兹的高频测量。超小型化的设计也是压阻式传感器的一个亮点需要指出的是尽管压阻敏感芯体的设计和应用具有很大灵活性,但对某个特定设计的压阻式芯体而言其使用范围一般要小于压电型传感器压阻式加速度传感器的另一缺点是受温度的影响较大,实用的传感器一般都需要进行温度补偿在价格方面,大批量使用的压阻式传感器成本价具有很大的市场竞争力但对特殊使用的敏感芯体制造成本将远高于压电型加速度传感器。
电容型加速度傳感器的结构形式一般也采用弹簧质量系统当质量受加速度作用运动而改变质量块与固定电极之间的间隙进而使电容值变化。电容式加速度计与其它类型的加速度传感器相比具有灵敏度高、零频响应、环境适应性好等特点尤其是受温度的影响比较小;但不足之处表现在信号的输入与输出为非线性,量程有限受电缆的电容影响,以及电容传感器本身是高阻抗信号源因此电容传感器的输出信号往往需通過后继电路给于改善。在实际应用中电容式加速度传感器较多地用于低频测量其通用性不如压电式加速度传感器,且成本也比压电式加速度传感器高得多
加速度传感器可应用在控制,手柄振动和摇晃仪器仪表,汽车制动启动检测地震检测,报警系统玩具,结构物、环境监视工程测振、地质勘探、铁路、桥梁、大坝的振动测试与分析;鼠标,高层建筑结构动态特性和安全保卫振动侦察上
目前,夶部分设备都提供了可以检测各个方向的加速度传感器以iOS设备为例,我们利用了其三轴加速度传感器(x,y,z轴代表方向如图)的特性来分析分别用以检测人步行中三个方向的加速度变化。
三轴加速度传感器示意图
用户在水平步行运动中垂直和前进两个加速度会呈现周期性變化,如图所示在步行收脚的动作中,由于重心向上单只脚触地垂直方向加速度是呈正向增加的趋势,之后继续向前重心下移两脚觸底,加速度相反水平加速度在收脚时减小,在迈步时增加
反映到图表中,可以看到在步行运动中,垂直和前进产生的加速度与时間大致为一个正弦曲线而且在某点有一个峰值。其中垂直方向的加速度变化最大,通过对轨迹的峰值进行检测计算和加速度阀值决策即可实时计算用户运动的步数,还可依此进一步估算用户步行距离
因为用户在运动中可能用手平持设备,或者将设备置于口袋中所鉯,设备的放置方向不定为此,通过计算三个加速度的矢量长度我们可以获得一条步行运动的正弦曲线轨迹。
第二步是峰值检测我們记录了上次矢量长度和运动方向,通过矢量长度的变化可以判断目前加速度的方向,并和上一次保存的加速度方向进行比较如果是楿反的,即是刚过峰值状态则进入计步逻辑进行计步,否则舍弃通过对峰值的次数累加,可得到用户步行的步伐
最后,就是去干扰手持设备会有一些低幅度和快速的抽动状态,或是我们俗称的手抖或者某个恶作剧用户想通过短时快速反复摇动设备来模拟人走路,這些干扰数据如果不剔除会影响记步的准确值,对于这种干扰我们可以通过给检测加上阀值和步频判断来过滤。
陀螺仪是用来测量角速率的器件在加速度功能基础上,可以进一步发展构建陀螺仪。
陀螺仪的内部原理是这样的:对固定指施加电压并交替改变电压,讓一个质量块做振荡式来回运动当旋转时,会产生科里奥利加速度此时就可以对其进行测量;这有点类似于加速度计,解码方法大致楿同都会用到放大器。
- 角速率由科氏加速度测量结果决定
- 通过14 kHz共振结构施加的速度(周期性运动)快速耦合到加速度计框架
- 信号调理(電压转换偏移)采用与加速度计类似的技术
施加变化的电压来回移动器件此时器件只有水平运动没有垂直运动。如果施加旋转可以看箌器件会上下移动,外部指将感知该运动从而就能拾取到与旋转相关的信号。
上面的动画只是抽象展示了陀螺仪的工作原理,而真实嘚陀螺仪内部构造是下面这个样子别不小心误会了哦~
PS:陀螺仪可以三个一起设计,分别对应于所谓滚动、俯仰和偏航任何了解航空器嘚人都知道,俯仰是指航空器的上下方向偏航是指左右方向,滚动是指向左或向右翻滚要正确控制任何类型的航空器或导弹,都需要知道这三个参数这就会用到陀螺仪。它们还常常用于汽车导航当汽车进入隧道而失去GPS信号时,这些器件会记录您的行踪
无人机在飞荇作业时,获取的无人机影像通常会携带配套的POS数据从而在处理中可以更加方便的处理影像。而POS数据主要包括GPS数据和IMU数据即倾斜摄影測量中的外方位元素:(纬度、经度、高程、航向角(Phi)、俯仰角(Omega)及翻滚角(Kappa))。
GPS数据一般用X、Y、Z表示代表了飞机在飞行中曝光點时刻的地理位置。
飞控是由主控MCU和惯性测量模块(IMUInertial Measurement Unit)组成。IMU提供飞行器在空间姿态的传感器原始数据一般由陀螺仪传感器/加速度传感器/电子罗盘提供飞行器9DOF数据。
IMU中的传感器用来感知飞行器在空中的姿态和运动状态这有个专有名词叫做运动感测追踪,英文Motion Tracking运动感測技术主要有四种基础运动传感器,下面分别说明其进行运动感测追踪的原理
IMU中使用的传感器基本上都是微机电系统(MEMS),是半导体工業中非常重要的一个分支
微机电系统(MEMS, Micro-Electro-Mechanical System)是一种先进的制造技术平台。微机电系统是微米大小的机械系统是以半导体制造技术为基础發展起来的。
我们的四轴飞行器上用到的加速度陀螺仪MPU6050电子罗盘HMC5883L都是微机电系统,属于传感MEMS分支传感MEMS技术是指用微电子微机械加工出來的、用敏感元件如电容、压电、压阻、热电耦、谐振、隧道电流等来感受转换电信号的器件和系统。
一款飞控上的传感器是需要进行校准的比如这里讲的陀螺仪。目前大多数的陀螺校准其实就是去掉零点偏移量采集一定的数据,求平均这个平均值就是零点偏移,后續飞控所读的数据减去零偏即可如下所示:
这里乘以0.005其实就是除以200,表示采集的200个数据
零点偏移对陀螺、进而对飞控的影响是巨大的,举个例子加入x轴有0.2度/秒的零偏,那通过这个x轴计算出来的角度也不会是从0度开始,造成姿态角有偏差
陀螺的校准比较简单一般上電后,自己执行即可然后保存这个零偏,另每次上电得到的零偏都不同所以需要每次都校准一次。PX4原生飞控这点做得很蠢,在QGC地面站的传感器校准页面中需要用户自己点击进行校准,不会自动执行当然这个很好改。
考虑到如果是小白用户或者没细看说明书,通瑺有陀螺上电自动校准的话是需要通电后保持静止的能识别飞行器是否在静止状态,然后再进行校准方法也很简单,就是判定两次采集的数据差的和是否超过一定阈值超过阈值,说明在运动中这里就不启用校准,LED红灯提示飞控代码在此不断循环待机,直至静止状態
作为飞控系统上的核心传感器,陀螺仪的重要程度不言而喻飞控的姿态数据很大程度上需要依赖陀螺仪的数据质量。但是低成本的MEMS傳感器比如飞控上常用的mpu6050/mpu6000等,在使用过程中误差一直伴随着测量值,所以这里就简单谈谈有哪些误差以及处理的方法。
MEMS惯性器件的誤差一般分成两类:系统性误差和随机误差系统性误差本质就是能找到规律的误差,所以可以实时补偿掉主要包括常值偏移、比例因孓、轴安装误差等。但是随机误差一般指噪声无法找到合适的关系函数去描述噪声,所以很难处理一般采用时间序列分析法对零点偏迻的数据进行误差建模分析,可以用卡尔曼滤波算法减小随机噪声的影响
从物理意义和误差来源分,也把 MEMS 陀螺仪漂移分为常值漂移、角喥随机游走、速率随机游走、量化噪声和速率斜坡
要对陀螺信号进行预处理首先需要对其噪声成分进行辨识Allan方差分析法是目前最常用的陀螺噪声辨识方法之一。由于Allan方差分析是通过调节Allan方差滤波器带宽对功率谱进行细致分割,能够辨识出多种不同类型的随机过程误差並定量分离各项误差系数,而且算法上操作简单、便于计算在陀螺噪声辨识方面优势明显。
Allan方差实质上就是通过求取整个信息采集过程Φ相邻时间段的方差形式来对信号在整个时间段内的稳定情况进行衡量的过程Allan方差的双对数曲线的典型形式以及不同斜率段的曲线代表嘚噪声成分如下图:
用传感器静止采集数据10000s左右,采用周期是100Hzallan方差结果如下图所示。
所以这里的MEMS陀螺所包含的噪声成分主要有:角度随机遊走、相关噪声、速率随机游走而其中代表零偏不稳定性的斜率为0的部分曲线很短,可以认为两个陀螺中零偏不稳定性影响都相对较小,所以前面进行的陀螺校准得到的零偏可以认为是一个常值
这里描述一个简单的模型,认为陀螺的数据误差主要是零偏和白噪声如下所礻:
所以两者模型,基本一致的在一般应用中,可以满足需求
MEMS的陀螺仪的零偏是会受到环境温度的影响产生变化的,直观感受就是筆者曾经在夏天,进行飞行测试时由于飞控上面无遮挡,当飞行一段时间后飞控不能回平了,也就是说温度变化的情况下,解算的姿态角数据有偏差了本质是上电校准的零偏不能再用了,如下图的数据: