简易航模飞机自动滚转平衡控制系统课题组成员:何明捷 张宇航杜雷雨 学院:电子与信息工程学院 指导教师:李延泽 高工 一、课题研究目的 1.验证航模滚转平衡自动控制的可行性; 2.验证平衡控制系统的建立于稳定性收敛性; 3.验证提高角速度传感芯片的信号的可靠性的方法的有效性; 4.实验PID 控制算法在航模飞机上应用的; 5.为下一步研究飞行器自动控制系统,包括自动导航,图像与电子信 息的侦查提供平台。 二、课题背景 目前飞机自动控制系统是飞机飞行系统的重要组成部分,由于气象条 件的不稳定性,空气流速与方向一直处于不断变化之中,飞机姿态自动稳 定系统有一定的发展。 1914 年,美国人斯派雷制成了电动陀螺稳定装置,成为了自动驾驶仪 的雏形。20 世纪30 年代,为减轻驾驶员长时间飞行的疲劳,开始使用三 轴稳定的自动驾驶仪,用于保持飞机平直飞行。50 年代,通过在自动驾驶 仪中引入角速率信号的方法制成阻尼器或增稳系统,改善了飞机的稳定性, 自动驾驶仪发展成飞行自动控制系统。50 年代后期,又出现自适应自动驾 驶仪,能随飞行器特性的变化而改变自身的结构和参数20 世纪60 年代实 现了自动地形跟随系统,它能保持飞机处于50m-60m 的高度上作地形跟随 飞行。 20 世纪60 年代到七十年代初,飞行器设计思想发生了根本的变化, 出现了随空布局飞机(CCV-Control Configuration Vehicle)主动控制技术的 发展是以飞机电传控制系统基础为基础的。目前,电传控制和主动控制已 经在现代飞机研制中得到了广泛的应用,自动飞行控制系统都以是多数飞 机普遍采用的关键系统。 三、课题研究主要内容 3.1 总体设计 本大学生创新性实验项目所设计制作的飞机从机翼到机身再到滚转 平衡控制系统的电路板的设计以及程序的编写均为学生自己完成。飞机采 用常规上单翼前三点式起落架布局,动力系统采用2 冲程的OS55 航模发 动机。飞机相关参数如表1—表3: OS55发动机参数 重量分布3.2 电子控制系统的设计与制作 1.电源系统 电源电路一个LM7805 稳压芯片提供5V 的电压供应单片机和AD 转换芯片; LM1117 提供3.3V 电压,为enc-03传感器提供电源。 C2 、C6、C5、C4 分别是104、103、102、101, 这些电容作用是为了 提高5V 电压的稳定性。 C17 、C16、 C15 分别是104、103、102,作用同上。 传感器与运算放大传感器采用日本村田公司的enc-03MA 角速度传感芯片。价格便宜, 精度高,在控制领域被广泛的应用。 enc-03MA传感器参数 由于enc-03 的输出信号只有0.67mV,难以被AD 转换芯片所识别,所 以在enc-03 后面用了一个由LM358 组成的同向放大电路将信号放大11 0.67*11*99=0.729V,达到了AD转换芯片可以识别的范围。 3.信号转换与MCU 主控电路 信号转换与MCU主控电路 AD 转换采用ADC0804 并行AD 转换芯片,转换与处理速度高,转换时 间小于100us,转换速度远远高于传感器芯片50Hz 的采样速度,能够及时 的将enc-03MA 输出的模拟信号转换成单片机能识别的TTL 电平。 主控芯片采用AT89S52 单片机,采用12Mhz 的晶体振荡器。 单片机通过产生PWM 波来控制单片机。信号输出端采用TLP5-1 进行了隔离,来驱动舵机控制副翼的偏转。JP1 是舵机的插头,插接控制飞机副翼的标准舵机。 4.PCB 电路板的设计 最终的PCB电路板 3.3 程序的调试 1.开机自检 本系统采用的传感器对温度非常的敏感,温漂比较严重。为了适应在 不同的温度保证精确性,系统的中立点由每次开机时自动检测过程确定。 电源打开后的0.5s 内,系统会对现在的传感器输出进行测定,并将其作为 本次工作的中立点电压。这样虽然在不同温度下,传感器的中立点会变化, 但是有了这个自检程序之后,程序能自己适应各种环境温度。 2.卡尔曼滤波 为了减少传感器误差对控制的影响,试验了标准的卡尔曼滤波程序, 由于51 单片机的处理速度有限,虽然矩阵的大小不大,但是依然在51 运行不了,放弃了卡尔曼滤波。各个矩阵的大小如下 mf (double*)f};/*状态转移矩阵*/ mq (double*)q};/*模型噪声的协方差矩阵*/ mr (double*)r};/*观测噪声的协方差矩阵*/ mh (double*)h};/*观测矩阵*/ mp (double*)p};/*初值P,返回估计误差协方差阵*/ mx {20,3,(double*)x}; /*状态向量估值序列*/ my {20,1,(double*)y}; /*观测向量序列*/ mg (double*)g};/*返回稳定增益矩阵*/ 3.PID 算法 由飞机空气动力学公式计算得到的控制率公式,δ x=Kp*(Υ /dt.这里只用到了PD算法即可完成副翼的稳定控制。 这一部分的调试时本程序最复杂的部分,由于空气动力学中一些系数 的不可计算性,必须采用实验和实践来确定,需经过反复的尝试确定Kp 和Kd。 四、结论(成果介绍) 项目组经过了10 个月的讨论设计和精细制作,终于完成了航模滚转 平衡自动控制系统,而且成功地进行了首次试飞。目前,在国外的网站上 也只能查到少数的航模自动控制的演示视频,而且都是地面演示,没有进 行实际飞行。进行实际飞行演示的带自动控制的航模与仅仅进行地面演示 的模型之间最大的不同点就在于前者要求在自动控制的前提下保障其飞 行的安全又要解决结构超重问题。本项目通过使用先进的传感器以及应用 了先进的算法解决了可靠性于稳定性的问题。 在电路的设计过程中充分的考虑到了经济性和高性能性的兼顾。 成果:安装有滚装平衡控制系统的模型飞机项目组于2009 月23日在哈尔滨工业大学体育场对该安装该系统 的飞机进行了试飞,在试飞现场该控制系统的设计制作得到了黑龙江省航 空模型专业委员会的老师的高度评价!