当前位置:首页 > 嵌入式 > 嵌入式软件
[导读]固定翼飞机竖直飞行控制系统的设计

引言

固定翼飞机水平飞行是最常见的飞行状态,让其做大仰角飞行则动作不能一直保持,如让其垂直于地面飞行能保持的时间则更短。本项目要实现的是一个可以让飞机垂直于地面飞行并可以稳定在固定高度的控制系统。利用在机身加入的三轴向加速度传感器来检测垂直于地面飞行的飞机的姿态。当检测到飞机前后摇摆时,控制水平尾翼使飞机保持前后方向的稳定性;当检测到飞机左右摇摆时,控制垂直尾翼使飞机保持左右方向的稳定性;当检测到飞机上下窜动时,控制油门的大小(即螺旋桨的转速)来保持飞机飞行高度的稳定性。当这些控制都很精准到位时,固定翼飞机也可以像直升机一样稳稳地悬停在空中了。利用本文设计的控制系统可以让飞机在做垂直飞行减速的同时顺时针或逆时针转90°(投影面积很小),这样就可以减小暴露给后面飞机的投影面积,减小被击中的几率。

设计概述

为了让飞机能竖直飞行,控制电路需要有以下功能:

判断飞机是否要竖直飞行 对于真飞机,它可能只是一个可防止误触发的拨动开关;在本项目的实验品遥控飞机里,它就是某一个通道的脉宽信号。当脉宽大于某一设定值时,控制电路就知道它该上场了。

判断自身姿态 这是本控制电路的核心部分之一,在控制飞机保持竖直飞行之前必须先判断自身的姿态。本项目用MMA7260QT传感器检测飞机的姿态。

控制 这是本项目设计制作过程中最耗时的部分,但其原理很容易理解:姿态电路已经了解了飞机的姿态,控制电路只要做相应动作就可以了。飞机前倾它就让飞机向前移动一些,后倾就向后移动一些。还有一个需要控制的量——高度,飞机在做此动作时高度是要保持稳定的,机身上冲时要减小油门,下降时要加大油门。要完成如此控制,要用两片MC9S08QG8。为了达到上述功能,本项目应有如图1所示的电路框图。

选用两片MC9S08QG8是因为在本项目里有两处对时间要求比较严格的地方:一是读从遥控器送出的脉宽;二是把经过运算的脉宽精确地发送出去,两处都要10μS以内的误差,如用一片来做即使用中断也会有冲突。本项目里两片MC9S08QG8工作的大体分配是:一片作为主控,用于读取遥控器送来的由接收机收到的脉宽(高实时性)、读取飞机姿态(低实时性)、控制运算(PID运算)和数据发送(把需要对飞机如何控制的数据,也就是PID运算的结果送给另一片MCU);另外一片作为辅助,只要把读到的数据实时发给飞机的执行机构就可以了。

硬件描述

硬件电路如图2所示。

·传感器MMA7260QT输出的三个轴的数据分别送入主控MCU的三个A/D输入端ADP0、ADP1和ADP2,电源接一个电阻和电感可防止电源对传感器的干扰。

·整个电路的电源由J1从接收机引入,通过78FC33变为3.3V后给MCU和传感器供电,J2、J3、J4分别是左右、油门和前后控制。

·主控MCU的第二路TPM的捕捉输入端TPMCH1接接收机的信号输出端。本遥控系统是9通道的,也就是可同时控制9个机构,这种9通道的信号见图3。它是由间隔为20ms的一个个脉冲串组成,每个脉冲串有9个脉冲,连续两个脉冲的上升沿的间隔就是遥控器送出的有效控制信号,此间隔最小1ms、最大2ms。TPM捕捉到9个脉冲的宽度后,就可以根据需要直接送给舵机或经PID运算后再送给舵机了。至于如何识别某一脉冲是上一个脉冲串的结尾还是下一个脉冲串的开头,这里涉及到一个同步脉冲的概念,属于软件内容,在此先不作解释。

·主控MCU的串行输出端接辅助MCU的串行输入端。主控MCU想如何控制飞机动作,只要通过串口把数据发送给辅助MCU就可以了,发送格式如表1所示,共8个字符,其中0xAA、0x55为引导位……

·三个LED,D1是电源指示灯,D3用于指示“我是控制电路,我已经开始控制飞机竖直飞行了”,D2是“出错了,小心出问题,快切换回由你控制吧。”

·辅助MCU有两个工作:一是读主控MCU送来的串行数据,找到引导字符后,把前后左右上下(油门)的数据送入相应的数组贮存;二是每20ms把相应的数组里的数据以脉冲形式发送出去。脉冲最小1ms、最大2ms。这个信号送入飞机的执行机构——舵机后对应的输出规律见图4。1ms的脉冲使舵机摇臂在最左边的位置,1.5ms的脉冲使舵机摇臂位于中位,2ms的脉冲使舵机摇臂在最右边的位置。舵机的摇臂连接飞机的各执行机构,摇臂摇动时飞机的执行机构(如尾翼等)也跟着摆动。

软件描述

主控MCU部分,流程图见图5。

·读取遥控信号:这个遥控信号见图5右上角,是9个脉冲组成的脉冲串,每20ms一串,读取的方法如下,由TPM捕捉到脉冲的上升沿进入模定时器捕捉中断程序后,先看是不是脉冲串里的第一个,若是就把定时器清零,然后把捕捉值存入数组,这样9次后,数组里就由低到高地存下了每个脉冲发生的时间,用减法一算,各脉冲宽度就出来了。为防止出错,附加了脉冲数错误预防,就是对脉冲个数进行计数,如果在一个脉冲串里读到了多于9个脉冲就意味着有干扰了,需要尽快把所有脉宽按中间值1.5ms处理。这样虽然和遥控器发出的指令不一样,但减少了出大问题的机会。

·8ms定时中断:系统有一个模定时器18ms中断程序,因为正常的脉冲串9个脉冲不会超过18ms,所以可以让定时器在第一个脉冲开始时计数,计到18ms就认为一个脉冲串结束,把脉冲数计数器清零。模定时器捕捉中断程序里看到这个计数器被清零了就知道下一个脉冲串开始了。这个中断还为PID的定时运算提供时间标志,每进入一次中断就把标志置位,主程序读到标志被置位就进行PID运算,这样就保证了PID运算的周期是固定的。

·1.67ms中断程序和A/D中断程序:为了读取MMA7260QT输出的数据需要用A/D读值,这里每1.6667ms进入中断一次设定A/D通道,读完三个通道用时5ms,在两个脉冲串的标准间隔20ms内可以各读4次,用滑动平均值算法后可以滤除干扰。

主程序介绍

虽然传感器都是水平放置的,但因为温度电压等的不同,三个轴的输出和计算的输出是不一样的,会有少许偏差,为了解决这个问题,在上电后先对三个轴的值连续读64次后平均,把这个平均值作为飞机要稳定的目标值,这样飞机就基本稳定了。

提到稳定,PID功不可没,主程序里的PID有两处要提一下。一是因为传感器的稳定性问题和飞机的抖动,A/D输出值差2、3个数是很正常的,所以在主程序里要判断一下,如果误差值在3以内,则不进行PID运算,这样就减少了舵机无谓的抖动;二是因为飞机的前后左右重量不一致,所以在飞机前倾后仰左右摆动时要用不同的P值计算。

主程序每20ms更新一次数据,数据就是前后左右上下的控制脉冲的宽度。这个数据是把模定时器捕捉中断程序里捕捉到的数直接拿来用还是要拿PID运算的数据来用?这由一个脉宽(决定此时飞机是否要竖直飞行的脉宽)决定,这里用到的是第7个脉冲的脉宽,也就是遥控器的第7通道,这个参数被命名为Helen,当Helen > 1500(1.5ms)时就是操纵者要竖直飞行,要把PID运算的数据输出;当Helen < 1500时就是正常飞行,直接把模定时器捕捉中断程序里捕捉到的数输出就可以了。

要得到各个脉冲宽度,只要把从低到高的每个脉冲发生的时间做减法就可以了,这个减法运算也是在主程序里完成的。减法完成后还要对脉冲宽度进行出错处理,要检查一下,小于1ms的按1ms算,大于2ms的按2ms算,处理完了就可以调用发送中断发送给辅助MCU了。调用方式是把数组排列好,把发送数据计数器清零,打开发送中断允许位,这时发送缓冲区是空的,发送中断一允许,它就立刻进中断开始发送。

串口发送中断程序:程序进入本中断后首先把发送数据计数器指示的数送到发送缓冲区去发送,如发送完了就把发送中断允许位清零,以防止正在发送的数据发送完后再次进入中断;如没发送完就直接退出,等待下次中断。

辅助MCU程序流程图见图6。

串口接收中断:辅助MCU程序的关键在串口接收中断,接收到的数要存入指定的数组,这个容易实现,而把引导头找出来就不那么容易了,因为作为引导头的0xAA、0x55也有可能是数据,只有连起来的才是引导头,判断方法详见图6。

因为本MCU只有两个定时器,但需要控制三路脉冲,所以有两路脉冲用定时器的PWM功能实现,另外一路需要用软件模拟,本文选用的方法是用一个20ms的中断,进入中断后把I/O口置位,然后在主程序里循环判断定时器的值,当定时器的值大于要送的脉冲值时把I/O复位。

本站声明: 本文章由作者或相关机构授权发布,目的在于传递更多信息,并不代表本站赞同其观点,本站亦不保证或承诺内容真实性等。需要转载请联系该专栏作者,如若文章内容侵犯您的权益,请及时联系本站删除。
换一批
延伸阅读

9月2日消息,不造车的华为或将催生出更大的独角兽公司,随着阿维塔和赛力斯的入局,华为引望愈发显得引人瞩目。

关键字: 阿维塔 塞力斯 华为

加利福尼亚州圣克拉拉县2024年8月30日 /美通社/ -- 数字化转型技术解决方案公司Trianz今天宣布,该公司与Amazon Web Services (AWS)签订了...

关键字: AWS AN BSP 数字化

伦敦2024年8月29日 /美通社/ -- 英国汽车技术公司SODA.Auto推出其旗舰产品SODA V,这是全球首款涵盖汽车工程师从创意到认证的所有需求的工具,可用于创建软件定义汽车。 SODA V工具的开发耗时1.5...

关键字: 汽车 人工智能 智能驱动 BSP

北京2024年8月28日 /美通社/ -- 越来越多用户希望企业业务能7×24不间断运行,同时企业却面临越来越多业务中断的风险,如企业系统复杂性的增加,频繁的功能更新和发布等。如何确保业务连续性,提升韧性,成...

关键字: 亚马逊 解密 控制平面 BSP

8月30日消息,据媒体报道,腾讯和网易近期正在缩减他们对日本游戏市场的投资。

关键字: 腾讯 编码器 CPU

8月28日消息,今天上午,2024中国国际大数据产业博览会开幕式在贵阳举行,华为董事、质量流程IT总裁陶景文发表了演讲。

关键字: 华为 12nm EDA 半导体

8月28日消息,在2024中国国际大数据产业博览会上,华为常务董事、华为云CEO张平安发表演讲称,数字世界的话语权最终是由生态的繁荣决定的。

关键字: 华为 12nm 手机 卫星通信

要点: 有效应对环境变化,经营业绩稳中有升 落实提质增效举措,毛利润率延续升势 战略布局成效显著,战新业务引领增长 以科技创新为引领,提升企业核心竞争力 坚持高质量发展策略,塑强核心竞争优势...

关键字: 通信 BSP 电信运营商 数字经济

北京2024年8月27日 /美通社/ -- 8月21日,由中央广播电视总台与中国电影电视技术学会联合牵头组建的NVI技术创新联盟在BIRTV2024超高清全产业链发展研讨会上宣布正式成立。 活动现场 NVI技术创新联...

关键字: VI 传输协议 音频 BSP

北京2024年8月27日 /美通社/ -- 在8月23日举办的2024年长三角生态绿色一体化发展示范区联合招商会上,软通动力信息技术(集团)股份有限公司(以下简称"软通动力")与长三角投资(上海)有限...

关键字: BSP 信息技术
关闭
关闭