针对四轴飞行器飞行性能不稳定和惯性测量单元(IMU)易受干扰、存在漂移等问题,利用惯性传感器MPU6050采集实时数据,以经典互补滤波为基础,提出一种可以自适应补偿系数的互补滤波算法,该算法在低通滤波环节加入PI控制器,依据陀螺仪测得的角速度实时调节PI控制器补偿系数。飞行器姿态控制系统采用双闭环PID控制方法,姿态解算的欧拉角作为系统外环,陀螺仪角速度作为系统内环。最后,搭建以NI my RIO为核心控制器的四轴飞行器,通过Lab VIEW实现算法和仿真,实验结果表明,自适应互补滤波算法可以准确解算姿态信息,双闭环PID控制超调量小、反应灵敏,控制系统基本满足飞行要求。
标签: mpu6050 互补滤波 四旋翼飞控系统 双闭环PID LabVIEW语言
上传时间: 2022-06-13
上传用户:bluedrops
高度数据的准确获取是飞控系统研制过程中极其重要的一环,是保证无人飞行器按照一定高程工作、平稳着陆的先决条件。但对于低成本惯性导航解算,位置漂移严重[],虽可通过加速度计姿态校正来抑制部分漂移,但解算出的速度与位置仍然不准确。因此需利用除惯导外的其它传感器测量值作为位置观测量参与滤波,在抑制位置漂移的情况下,修正速度与加速度,提高高程数据的精度。目前文献中大多是将惯性导航作为一个整体,对惯导的三维位置及速度进行滤波。如SINS/GPS组合导航,通过组合导航对SINS速度及位置漂移进行抑制[2][3]。但是当只需要高度方向上的数据时,此种做法往往计算量大,步骤繁琐,且整体滤波兼顾经度、纬度、高程等多个因素,反而影响了高度方向的滤波效果,且当SINS/GPS组合导航中的GPS信号较差时,得到的高度观测量误差也大。可见,当单一的高度传感器观测数据出现异常时,滤波后的高度也会出现异常。针对单传感器无法适应复杂工作环境的缺点,本文结合GPS、气压计及惯导系统的优点,来抑制惯导高度方向上的发散。通过构建GPS与气压计数据的权重模型获得高度方向观测量,使用互补滤波算法融合惯导数据与求得的观测量得到更为精确的高度观测值。算法简易,鲁棒性好,可在嵌入式飞控板中实时运行。
上传时间: 2022-07-16
上传用户:
永磁同步电机是同步电机的一个重要类型,其转子一般采用稀土永磁材料做激磁磁极,与传统同步电机相比,体积和重量大为减小,而且结构简单,运行可靠,维护更方便。现代电气传动控制的发展趋势之一是开发新的交流调速与伺服系统。无论在矢量控制还是标量控制中,转速与位置的闭环控制都需要在电机轴上安装一个速度传感器,但是由于速度传感器的引进不仅增加了成本,降低了系统可靠性,还存在安装问题,效果并不十分理想。因此高性能无速度传感器控制成为近年来电机研究的热点。 本文在系统介绍卡尔曼滤波器的基础上,将其引入到永磁同步电机无速度传感器状态观测中。由于永磁同步电机是一个强耦合的多阶非线性系统,本文采用了工程实际中普遍采用的泰勒展开式截断的方法,对电机方程线性化处理,将卡尔曼滤波算法推广至非线性系统,并加入了反映电机系统模型误差和环境干扰的系统噪声和测量噪声模型,形成扩展卡尔曼滤波算法。扩展卡尔曼滤波器将电机转子位置与转速作为系统状态变量进行实时估算,并将所得信息反馈到永磁同步电机控制系统中。通过仿真,与电机实际运行状态进行比较,证明了扩展卡尔曼滤波具有良好的动态跟踪能力和抗噪声能力。 针对扩展卡尔曼滤波算法在无速度传感器控制中存在的不足,本文给出了降阶线性卡尔曼滤波算法。降阶线性卡尔曼滤波算法重新选择了系统状态变量,建立新的完全线性化的系统方程,并且卡尔曼滤波算法中的系统协方差矩阵成为时不变序列,因此可以直接应用线性卡尔曼滤波算法。仿真结果证明,与扩展卡尔曼滤波算法相比,新的算法更加简单,减轻了繁重的参数调节任务,易于数字化实现,不仅具备扩展卡尔曼滤波算法的优势,而且在某些性能方面超越了扩展卡尔曼滤波算法。 通过分析得知,由于将系统模型不确定性与测量噪声体现在系统方程中,因此卡尔曼滤波算法在状态估算方面具有良好的性能。本文以降阶线性卡尔曼滤波 算法为理论基础,以永磁同步电机为对象,以数字信号处理器(DSP)为核心,设计了电机状态观测系统的设计方案。整个方案在不增加成本的基础上,充分利用数字信号处理器(DSP)丰富的资源和强大的运算能力,通过检测电机相电流,实时估算出电机转子位置与转速。本系统可以代替传统速度传感器,为电机控制系统提供转子位置和转速反馈信息。本文的下一步主要工作便是将此系统付诸实践,应用于实际工程中,对卡尔曼滤波算法在永磁同步电机无速度传感器控制方面的性能进行进一步研究。关键词:永磁同步电机;无速度传感器;卡尔曼滤波
上传时间: 2013-04-24
上传用户:lifangyuan12
极值型中值滤波算法在高噪声率下的滤波效果不是很好,主要原因有以下两个:首先,滤波窗口中过多的噪声点会使窗口中的点在排序时产生中值偏移;其次是高噪声率环境下,可能序列中值本身就是是噪声点。对此,本文提出
上传时间: 2013-06-26
上传用户:小小小熊
·改进的中值滤波算法在图像处理中的应用
上传时间: 2013-04-24
上传用户:Raymond
·摘要: 陀螺仪漂移数据经过处理后将是一组高度相关的平稳随机时间序列.在对陀螺仪漂移数据建立时间序列AR模型的基础上,考虑到精度与实时性的要求,采用卡尔曼滤波算法对捷联陀螺模拟漂移数据进行了处理,并运用基于TI公司的TMS320C32型DSP对算法进行了实验.通过实时考察实验系统算法程序的运行情况可以看出,卡尔曼滤波算法能有效地提高陀螺精度,并且对于实时性要求高而计算量大的卡尔曼滤波算法
上传时间: 2013-06-22
上传用户:koulian
C语言十大滤波算法,别处转载的~~~C语言十大滤波算法,别处转载的~~~
上传时间: 2013-06-01
上传用户:hanli8870
提取基波分量的高精度快速滤波算法
上传时间: 2013-10-09
上传用户:brilliantchen
十大滤波算法程序大全,经典不解释
上传时间: 2014-12-31
上传用户:taa123456
滤波算法
标签: 滤波算法
上传时间: 2013-10-15
上传用户:daxigua