一种飞行控制器及其辅助飞行控制方法_2

文档序号:8445175阅读:来源:国知局
接图像传感器;四通道输出模块连接飞行控制器的螺旋桨马达的控制电路。
[0043]电源模块包括为DC/DC双路直流电源输出模块,包括半导体5v集成稳压IC和半导体3.3v集成稳压1C,分别5v和3.3v电压。提供四浆飞行器的飞行控制器电路所需电源是由飞行器充电电池所供应,飞行器充电电池为12伏特10安培小时;HT46R24与CCD镜头使用5v电源,通过半导体5v集成稳压IC提供5v电压;陀螺仪、加速度计、RF模块使用3.3v电压,通过半导体3.3v集成稳压IC提供3.3v电压。
[0044]螺旋桨马达包括前螺旋桨马达、后螺旋桨马达、左螺旋桨马达、右螺旋桨马达,如图2所示,其中箭头方向为螺旋桨转动方向。
[0045]前螺旋桨马达、后螺旋桨马达、左螺旋桨马达、右螺旋桨马达的控制电路分别连接PWM信号四通道输出模块的四个输出通道。
[0046]本实施例加速度计为MMA7200Q三轴加速度计,如图7所述为MMA7200Q三轴加速度计应用电路图,MMA7200Q传感器具有高灵敏度的特性,使用其X、Y的分量变化来测量飞行器的水平姿态,其中X轴的分量来探测飞行器的俯仰角(Pitch)变化,而Y轴则是探测侧滚角(Roll)的变化。
[0047]一种飞行控制器辅助飞行控制方法,包括以下步骤,
[0048]SI,系统初始化:保持机身水平,系统记录起始零点的状态参数,状态参数包括中断计时频率、方向角(Yaw) ω、俯仰角(Pitch) Θ、侧滚角(Roll) Φ的零点位置;
[0049]S2,接收遥控器发出的控制讯号,所述控制讯号包括油门(Throttle)、方向角(Yaw)、俯仰角(Pitch)、侧滚角(Roll);
[0050]S3,采集陀螺仪与加速度计所探测的即时信号;
[0051]S4,所述步骤S2、S3的数据经过A/D转换后进入PI控制器运算,当陀螺仪与加速度计所探测的即时信号与零点位置的状态参数存在误差时,PI控制器将陀螺仪与加速度计修正至零点位置,与飞行器保持稳定;
[0052]S5,遥控器送出的控制量与PI控制器产生的控制量运算后输出四个频道的PWM信号到四组马达,经由PWM信号的责任周期(Duty Cycle)变化控制直流马达转速,使飞行器的浮力达到稳定状态。
[0053]通过飞行器上的加速度计采集的即时信号的X、Y的分量变化来测量飞行器的水平姿态,其中X轴的分量来探测飞行器的俯仰角(Pitch)变化,Y轴则是探测侧滚角(Roll)的变化。
[0054]方向角(Yaw) ω是由陀螺仪探测,由四组旋翼彼此的转速比例控制方向角ω的实际角度。
[0055]本发明飞行控制器的工作过程如下:飞行器开机后初始化中断计时频率与方向角(Yaw) ω、俯仰角(Pitch) Θ、侧滚角(Roll) Φ的零点位置,即保持机身稳定、水平,陀螺仪和加速度计记录起始零点的状态参数。系统初始化后系统将即时接收遥控器发出的控制讯号,同时陀螺仪与加速度计信号实时输入采集的数据到模数转换器(A/D转换),经过A/D转换后进入PI控制器,PI控制器控制飞行器与零点位置飞行参数相同。当飞行器未接收到遥控器的控制信号时,控制器必须保持飞行器的姿态与航向稳定,其中方向角(Yaw)?是由陀螺仪负责探测,并由四组螺旋桨(旋翼)彼此的转速比例控制方向角的实际角度。俯仰角(Pitch) Θ、侧滚角(Roll) Φ利用加速度计的X与Y分量来探测,其中俯仰角的控制通过单片机控制四楽飞行器中的前螺旋桨马达(Motor Front)与后螺旋桨马达(Motor Rear)间转速比例,侧滚角通过控制左螺旋桨马达(Motor Left)与右螺旋桨马达(Motor Right)控制,如图2所示。
[0056]以上仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
【主权项】
1.一种飞行控制器,包括单片机和螺旋桨马达,其特征在于,还包括辅助飞行控制器、电源模块、无线接收模块、图像传感器、无线发送模块和PWM信号四通道输出模块; 所述辅助飞行控制器包括PI控制器、陀螺仪、加速度计、模数转换器; 所述电源模块、PI控制器、单片机、PWM信号四通道输出模块依次顺序连接;所述陀螺仪、加速度计均与模数转换器相连接,模数转换器与PI控制器连接,所述无线接收模块、图像传感器、无线发送模块均与单片机相连接; 所述电源模块连接图像传感器; 所述四通道输出模块连接飞行控制器的螺旋桨马达的控制电路。
2.根据权利要求1所述的一种飞行控制器,其特征在于, 所述电源模块包括为DC/DC双路直流电源输出模块,包括半导体5v集成稳压IC和半导体3.3v集成稳压1C,分别5v和3.3v电压。
3.根据权利要求1所述的一种飞行控制器,其特征在于, 所述单片机为28Pin DIP封装单片机。
4.根据权利要求1所述的一种飞行控制器,其特征在于, 所述螺旋桨马达包括前螺旋桨马达、后螺旋桨马达、左螺旋桨马达、右螺旋桨马达。
5.根据权利要求1所述的一种飞行控制器,其特征在于, 所述前螺旋桨马达、后螺旋桨马达、左螺旋桨马达、右螺旋桨马达的控制电路分别连接PWM信号四通道输出模块的四个输出通道。
6.根据权利要求1所述的一种飞行控制器,其特征在于,所述单片机包括8MHz晶体振荡器。
7.一种飞行控制器辅助飞行控制方法,其特征在于,包括以下步骤, SI,系统初始化:保持机身水平,系统记录起始零点的状态参数,状态参数包括中断计时频率、方向角ω、俯仰角Θ、侧滚角Φ的零点位置; S2,接收遥控器发出的控制讯号,所述控制讯号包括油门、方向角、俯仰角、侧滚角; S3,采集陀螺仪与加速度计所探测的即时信号; S4,所述步骤S2、S3的数据经过A/D转换后进入PI控制器运算,当陀螺仪与加速度计所探测的即时信号与零点位置的状态参数存在误差时,PI控制器将陀螺仪与加速度计修正至零点位置,与飞行器保持稳定; S5,遥控器送出的控制量与PI控制器产生的控制量运算后输出四个频道的PWM信号到四组马达,经由PWM信号的责任周期变化控制直流马达转速,使飞行器的浮力达到稳定状??τ O
8.根据权利要求7所述的一种飞行控制器辅助飞行控制方法,其特征在于, 通过飞行器上的加速度计采集的即时信号的X、Y的分量变化来测量飞行器的水平姿态,其中X轴的分量来探测飞行器的俯仰角变化,Y轴则是探测侧滚角的变化。
9.根据权利要求7所述的一种飞行控制器辅助飞行控制方法,其特征在于,所述方向角ω是由陀螺仪探测,由四组旋翼彼此的转速比例控制方向角ω的实际角度。
【专利摘要】本发明公开了一种飞行控制器,包括单片机、螺旋桨马达、辅助飞行控制器、电源模块、无线接收模块、图像传感器、无线发送模块和PWM信号四通道输出模块;辅助飞行控制器包括PI控制器、陀螺仪、加速度计、模数转换器;电源模块、PI控制器、单片机、PWM信号四通道输出模块依次顺序连接;陀螺仪、加速度计均与模数转换器相连接,模数转换器与PI控制器连接,无线接收模块、图像传感器、无线发送模块均与单片机相连接;电源模块连接图像传感器;四通道输出模块连接飞行控制器的螺旋桨马达的控制电路。本发明使飞行器得以应用于勘察、检测与监控等场合,在飞行器上装设辅助飞行控制器,使飞行器能保持姿态稳定与固定的航向。
【IPC分类】G05D1-10
【公开号】CN104765375
【申请号】CN201510106899
【发明人】刘训非, 祝清兰, 凌璟
【申请人】苏州工业职业技术学院
【公开日】2015年7月8日
【申请日】2015年3月11日
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1