一种飞行控制器及其辅助飞行控制方法
【技术领域】
[0001]本发明涉及遥控飞行控制领域，具体涉及一种带有辅助飞行控制器的飞行控制器。
【背景技术】
[0002]现有技术中，遥控飞行器在操作时必须相当全神贯注，以四浆飞行器为例，主要的原因是由于飞行器飞行时机翼转动除了提供飞行器的浮力之外，同时旋翼转动除了提供飞行器的浮力之外，同时旋翼转动所产生的作用力与反作用力都会影响飞行器的姿态与航向，而当操作的场所位于户外时，飞行器更会受到风势以及气流等影响。因此飞行遥控器的操作人员得随时专注于飞行器的姿态、航向、位置、高度等状态，随时进行修正和稳定控制飞行器。
[0003]飞行器操作人员往往需要经过许多的时间与调试才能掌握与熟练各种飞行器的控制，使得遥控飞行器应用于勘察、探索等工作始终难于达成。
【发明内容】
[0004]本发明提出一种飞行控制器，在飞行器上装设辅助飞行控制器，负责将陀螺仪与加速度计量测到的方向角(Yaw)、俯仰角(Pitch)、侧滚角(Roll)信号经过辅助飞行控制器后输出脉冲宽度调变(PWM)信号至四组马达，使飞行器能保持姿态稳定与固定的航向。
[0005]本发明技术方案如下:
[0006]一种飞行控制器，包括单片机、螺旋桨马达、辅助飞行控制器、电源模块、无线接收模块、图像传感器、无线发送模块和PWM信号四通道输出模块；
[0007]辅助飞行控制器包括PI控制器、陀螺仪、加速度计、模数转换器；
[0008]电源模块、PI控制器、单片机、PWM信号四通道输出模块依次顺序连接；陀螺仪、加速度计均与模数转换器相连接，模数转换器与PI控制器连接，无线接收模块、图像传感器、无线发送模块均与单片机相连接；
[0009]电源模块连接图像传感器；四通道输出模块连接飞行控制器的螺旋桨马达的控制电路。
[0010]电源模块包括为DC/DC双路直流电源输出模块，包括半导体5v集成稳压IC和半导体3.3v集成稳压1C，分别5v和3.3v电压。
[0011]单片机为28Pin DIP封装单片机。
[0012]螺旋桨马达包括前螺旋桨马达、后螺旋桨马达、左螺旋桨马达、右螺旋桨马达。
[0013]前螺旋桨马达、后螺旋桨马达、左螺旋桨马达、右螺旋桨马达的控制电路分别连接PWM信号四通道输出模块的四个输出通道。
[0014]所述单片机包括8MHz晶体振荡器。
[0015]本发明飞行控制器的工作过程如下:飞行器开机后保持机身稳定、水平，陀螺仪和加速度计记录起始零点的状态参数。系统初始化后系统将即时接收遥控器发出的控制讯号，同时陀螺仪与加速度计信号实时输入采集的数据到模数转换器(A/D转换)，经过A/D转换后进入PI控制器，PI控制器控制飞行器与零点位置飞行参数相同。
[0016]一种飞行控制器辅助飞行控制方法，包括以下步骤，
[0017]SI，系统初始化:保持机身水平，系统记录起始零点的状态参数，状态参数包括中断计时频率、方向角(Yaw) ω、俯仰角(Pitch) Θ、侧滚角(Roll) Φ的零点位置；
[0018]S2，接收遥控器发出的控制讯号，所述控制讯号包括油门(Throttle)、方向角(Yaw)、俯仰角(Pitch)、侧滚角(Roll)；
[0019]S3，采集陀螺仪与加速度计所探测的即时信号；
[0020]S4，所述步骤S2、S3的数据经过A/D转换后进入PI控制器运算，当陀螺仪与加速度计所探测的即时信号与零点位置的状态参数存在误差时，PI控制器将陀螺仪与加速度计修正至零点位置，与飞行器保持稳定；
[0021]S5，遥控器送出的控制量与PI控制器产生的控制量运算后输出四个频道的PWM信号到四组马达，经由PWM信号的责任周期(Duty Cycle)变化控制直流马达转速，使飞行器的浮力达到稳定状态。
[0022]通过飞行器上的加速度计采集的即时信号的X、Y的分量变化来测量飞行器的水平姿态，其中X轴的分量来探测飞行器的俯仰角(Pitch)变化，Y轴则是探测侧滚角(Roll)的变化。
[0023]方向角(Yaw) ω是由陀螺仪探测，由四组旋翼彼此的转速比例控制方向角ω的实际角度。
[0024]与现有技术相比，本发明包括以下有益效果:
[0025]本发明使飞行器得以应用于勘察、检测与监控等场合。在飞行器上装设辅助飞行控制器，负责将量测到陀螺仪与加速度计的数据经过PI控制器输出脉冲宽度调变(PWM)信号至四组马达，使飞行器能保持姿态稳定与固定的航向。
[0026]经由辅助飞行控制器将飞行器飞行保持与零点位置参数相同，飞行器的操作人员不须再花费多余的精神在保持飞行器的稳定上，仅需要将飞行器遥控至目标物附近，再利用无线传输的CCD镜头将影像回传至地面控制站，使工作人员得以观察目标的实际情形。
[0027]对于观测、勘察人员不容易到达的目标有非常大的帮助，有助于提升工作的效率，获得更清晰的影像资料。
【附图说明】
[0028]图1为本发明一种飞行控制器的结构示意图；
[0029]图2为四浆飞行器示意图；
[0030]图3为螺旋桨马达驱动电路图；
[0031]图4为HT46R24核心电路图；
[0032]图5为陀螺仪电路；
[0033]图6为TRW-24G无线模块应用电路图；
[0034]图7为加速度计应用电路图。
【具体实施方式】
[0035]为使本发明的目的、技术方案、优点更加清楚，下面结合附图对本发明的【具体实施方式】进行详细说明。
[0036]以下将结合本发明的附图，对本发明实施例中的技术方案进行清楚、完整的描述和讨论，显然，这里所描述的仅仅是本发明的一部分实例，并不是全部的实例，基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例，都属于本发明的保护范围。
[0037]四浆飞行器具有四组直流马达作为上升的动力，其中两组旋翼(螺旋桨)为顺时针旋转，另外两组则为逆时针旋转。目的是利用旋翼旋转方向不同产生的反作用力相互相反抵消。飞行时航向与移动是利用各旋翼间转速的差距造成浮力变化来达成。
[0038]如图1所示，一种飞行控制器，包括单片机、螺旋桨马达、辅助飞行控制器、电源模块、无线接收模块、图像传感器、无线发送模块和PWM信号四通道输出模块；本实施例中单片机为HT46R24微控制器，采用28Pin DIP封装，符合飞行控制器体积小、重量轻的要求，并采用5v供电，8MHz晶体振荡器，使每个指令周期达到0.5微妙的运算速度，以达到飞行控制系统高频率响应的要求。其中陀螺仪与加速度计测量到的信号分别进入HT46R24的PBO?PB3的10bitA/D转换脚位(图4电路图)。图3为螺旋桨马达直流电路，其中Motor Front、Motor Rear、Motor Left、Motor Right 连接至 HT46R24 的 PAO ?PA3 输出模式(OutputModor)输出PWM信号，共有四组螺旋桨马达控制电路。陀螺仪型号为ADRX300，负责探测Z轴方向角的单轴角速率陀螺仪，最大探测范围为±300° /s，陀螺仪电路如图5所示。
[0039]本实施例中无线接收模块、无线发送模块均为TRW-24G无线模块，电路图如图6所不O
[0040]辅助飞行控制器包括PI控制器、陀螺仪、加速度计、模数转换器；
[0041]电源模块、PI控制器、单片机、PWM信号四通道输出模块依次顺序连接；陀螺仪、加速度计均与模数转换器相连接，模数转换器与PI控制器连接，无线接收模块、图像传感器、无线发送模块均与单片机相连接；
[0042]电源模块连