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

　　判断自身姿态 这是本控制电路的核心部分之一，在控制飞机保持竖直飞行之前必须先判断自身的姿态。本项目用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更新一次数据，数据就是前后左右上下的控制脉冲的宽度。这个数据是把模定时器捕捉中