|
EDA365欢迎您登录!
您需要 登录 才可以下载或查看,没有帐号?注册
x
摘要:* h- ]9 d. Q( u
四旋翼飞行器由主控制器、姿态采集器、电机驱动、执行机构、电源、防撞圈等六部分
. o( N% O* @7 D9 O8 p3 a6 L$ p组成。其中,控制核心采用瑞萨单片机( R5F100LEA )负责飞行器姿态数据接收和飞行姿态
3 Q: b* d; E2 s" S. z& |控制;采用AHRS 模块( 9 轴姿态仪)的姿态采集器做飞行姿态反馈机构;用四块MOS 管1 F- S" H4 { }6 ?2 q! _# Y* I
搭建大功率驱动器来驱动电机;执行机构采用四路空心杯电机实现。该飞行器还采用了模糊9 K+ K; d, o' ^+ A6 m6 H
控制算法对当前姿态数据进行处理,同时,解算出相应电机的PWM 增减量,及时调整飞行) `% [9 `2 H/ B7 t/ Y. p
姿态,使飞行器的飞行的更加稳定。电源采用集成开关稳压块给单片机供电,使得单片机电' I0 o' x/ l$ d8 H7 o" }9 V
源稳定高效。
9 S+ V8 p+ V: u3 Q$ E关键词:四旋翼飞行器;模糊控制算法;陀螺仪
; x" B' U* H0 O% Y/ K2 L7 aAbstract :) p" g, E! H) t2 ?4 a3 A
The four rotor aircraft by the power supply, main controller , attitude collector , motor# X w- Z& ?8 _7 I) v u
driver, actuators, anticollision ring and so on six parts. Integrated a switching power supply
1 ~/ g& F2 p% J8 q% v* P Uadopts LM2596S on to the system power supply; Main controller for renesas mcu7 V! X( y: C! k/ ~' s) V
(R5F100LEA), is mainly responsible for to calculating the spacecraft attitude and offer four! R; I, }# w. h* ~% ~9 k
road PWM motor respectively; Gestures collector the AHRS - DEMO six axis gyroscope as the9 B/ L. d9 ~- T
spacecraft attitude feedback mechanism; With four pieces of MOS tube structures,
* t( f) ?7 U7 d1 d* @; s* {' ], lhigh-power power drive to drive motor; The hollow cup motor actuators for four road. This8 a& K$ C1 x0 L- w
aircraft USES the fuzzy control algorithm to deal with the attitude data transformation, makes( H6 B; C7 k4 c
the aircraft flight attitude more stable. The aircraft has completed the basic requirement of
) S# ]3 h& ?7 Z4 v# x1 Ethe topic.$ Q- f/ E% S y2 q- y: @
Keywords: four rotor aircraft ;gyroscope fuzzy control ;algorithm
4 L( L4 t# J$ q5 ~/ n0 Y) I3 }4
+ r2 q! ~( f. G" k9 B3 j一、系统方案论证
" e( w4 b1 T7 n+ J1 `1 P系统主要由单片机控制模块、姿态采集模块、电源模块、电机驱动模块、空心杯电机和
/ O7 J$ v+ A; d3 f( g防撞圈等六部分组成,采用X 型飞行模式,下面分别论证这几个模块的选择。0 k" K4 w9 g2 {4 |* J' e; X
1.1 姿态模块的论证与选择( a7 b" `+ i; [# g2 O
方案一:: ?+ V" y1 A7 m. i- o
MPU6050 三轴陀螺仪。MPU6050 三轴陀螺仪就是可以在同一时间内测量六个不同方向的- E# I0 f- N z* j+ q- X5 b
加速、移动轨迹以及位置的测量装置。单轴的话,就只可以测定一个方向的量,那么一个三; ?( s4 T9 ~' D6 F9 ^/ U8 n9 {+ r6 B
轴陀螺就可以代替三个单轴陀螺。它现在已经成为激光陀螺的发展趋向,具有可靠性很好、/ Q: y e: I9 t0 | j' @* o6 F
结构简单不复杂、重量很轻和体积很小等等特点,但是其输出数据需要大量的浮点预算才能/ g7 P5 D, A- P; c
保证较高的精度,这样会影响单片机对最终的姿态控制的响应速率。- f( J4 Y( r3 ]/ h
方案二:$ T1 \* o+ } ?; R
光纤陀螺仪。光纤陀螺仪是以光导纤维线圈为基础的敏感元件, 由激光二极管发射出的
, {1 v2 l; Q# Y! f; e光线朝两个方向沿光导纤维传播。光传播路径的变化,决定了敏感元件的角位移。光纤陀螺7 T1 ~& l g; |: M' k8 B
仪寿命长,动态范围大,瞬时启动,结构简单,尺寸小,重量轻,但是成本较高。
5 [! X( @' \3 R1 h4 J方案三:+ p A5 q- @ H
AHRS 模块。AHRS 模块包含了MPU6050(集成3 轴陀螺仪和3 轴加速度计)、HMC5883L# b% w$ C9 [9 @8 k8 Y
(3 轴地磁传感器),BPM180 气压高度计等模块。且AHRS 模块内部已经进行一些数据处理,: ^7 T9 F1 N; P% J) G
通过串口直接输出飞行器的当前姿态状态,减少了单片机进行姿态解算的运行时间消耗,进7 L* c5 `0 O4 ~4 x; l# n
一步提高了单片机对飞行器的姿态控制。
* l4 |# m+ k* t7 ^综合以上三种方案,我们选择了方案三。9 T! M& T1 s" r; ?/ l+ t
1.2 电源模块的论证与选择
: b1 Z* ]# ]" K! b; B# A7 g飞行器的电机电源由7.4 伏的航模专用锂电池直接提供,而瑞萨单片机的工作电压在
3 r+ [* h9 _: q$ m- \3.3~5.5 伏之间,所以系统需要进行一次电压转换,为控制核心供电,其质量直接决定了系统% v9 H" ]5 V( X6 b& q/ {) }5 m$ x a
的稳定性。* D/ O% {& {% z
方案一:
" c9 B+ P) h" t4 z0 |LM7805 模拟电源模块。用LM78/LM79 系列三端稳压IC 来组成稳压电源所需的外围元
; s( R4 N4 w E0 m4 K3 @( b; \件极少,电路内部还有过流、过热及调整管的保护电路,使用起来可靠、方便,而且价格便" G4 S6 C9 P" L" y4 ~
宜。然而在实际应用中,应在三端集成稳压电路上安装足够大的散热器(当然小功率的条件
: Y4 n8 ]! |8 c* \ X/ {下不用)。当稳压管温度过高时,稳压性能将变差,甚至损坏。
) P C2 o' `$ P1 L5& a" p* @/ y$ j! ~; [- T
方案二:
! m$ A# ?$ ]5 ^* M& C, }LM2596 开关电源模块。LM2596 系列是美国国家半导体公司生产的3A 电流输出降压开
: W: u. {5 J+ @: M" g7 y" N- U关型集成稳压芯片,它内含固定频率振荡器( 150KHZ )和基准稳压器( 1.23v ),并具有完善
) [7 R' N; T* ^的保护电路、电流限制、热关断电路等。利用该器件只需极少的外围器件便可构成高效稳压
! ?; S4 a( T5 s; N1 T电路。提供有: 3.3V、5V、12V 及可调( -ADJ)等多个电压档次产品。而且2596 的功耗较
- P# T( u; G/ g' W, a2 M小,效率较高,适合在航模中使用以提高续航时间,能满足该系统中电路要求。
5 |7 [3 L& ~. Q% K方案三:: y* a! ~# F1 H- i$ O- l0 K
AMS1117。AMS1117 系列稳压器有可调版与多种固定电压版,设计用于提供1A 输出电
5 Q0 v) F( _- W$ L- ] [流且工作压差可低至1V。在最大输出电流时, AMS1117 器件的压差保证最大不超过1.3V,
# }& G. G0 L$ C, V# H( Z. X并随负载电流的减小而逐渐降低。AMS1117 的片上微调把基准电压调整到1.5% 的误差以内,
; v$ E* E! }% r$ Z% F4 N而且电流限制也得到了调整,以尽量减少因稳压器和电源电路超载而造成的压力。但是能提
5 q# I' |' `7 ?" |% g* j供的电流较小,且在大电流工作状态下易发热。而
6 N3 c; a; f% X综合以上三种方案,选择方案二。$ Z" H3 R; J+ s0 b; b/ x
1.3 飞行方式的论证与选择
: p3 Y# E0 G" p1 ~方案一:
v1 {1 l b- ~8 {6 o十字飞行方式。四轴的四个电机以十字的方式排列,调整的时候应该对角调整,但是它4 S# Z9 F) F O
灵活性和可调性有限。7 f: R; W! X3 A5 T8 P# E
方案二:1 A3 y) }0 {: _6 I0 [7 W
X 行飞行方式。四轴的四个电机以X 字的方式排列,调整的时候应该相邻两个调节,灵
" e! O: r ]7 ?2 \- X# m活性和可调性较高。X 型飞行方式非常自由灵活,旋转方式多样,可以花样飞行,也可
5 d+ |, y# ?) G+ T" d$ t以做出很多高难度动作。
" Z" d: Z/ H- h3 t& D4 `8 `, @综合以上两种方案,选择了方案二。/ C, t" A8 u8 F3 R
1.4 电机驱动模块的论证与选择3 g, o; E4 S' \3 a: D: D; \& {
方案一:
* }" ]0 w1 t0 a' x# l3 u2 @9 `L298N 驱动模块。采用L298N 控制芯片,通过单片机I/O 口输入改变控制端的电平,7 N8 u2 h1 j" F; k- ^( ^
即可实现5V 直流电机正反转、停止的操作。运用此方案可以很好的利用单片机程序控制达
7 s) W2 T. _! `7 Z* j) y到控制电机的目的。但是经过测试发现飞行器的四路空心杯电机同时运作时电流达到5~6 安
/ c8 m- q# y. i8 N( D培,然而L298N 承受不了如此大的电流。
7 v& _' F6 v" {方案二:
+ _. T, p [4 K* g4 路MOS 电流放大电路。通过MCU 输出的信号控制MOS 管的通断,达到放大驱动电流; Y( t9 y. a0 @- Q8 ?) J( J x8 a
控制电机正转和反转。该电路简单,驱动能力强,体积小,非常适合作为小型空心杯电机的+ S$ ?4 n/ {! p# G
驱动。与L298N 驱动相比较,具有驱动简单,控制方便,而且面积小,质量轻等优点。
" [. q- \1 A/ G9 y! {. M5 G' n6 N* J69 ^, q# A& d+ x6 j2 k% d+ O, c* \& V
综合以上两种方案,选择了方案二。
9 K" d0 R$ y- P T; e二、系统理论分析与计算% D6 w$ r. N" u, N/ h8 g
2.1 模糊控制算法的分析
9 \7 U9 |5 U) c, W由于四旋翼飞行器由四路电机带动两对反向螺旋桨来产生推理,所以如何保证电机在平
- G0 W& G! T' A8 u# }稳悬浮或上升状态时转速的一致性及不同动作时各个电机转速的比例关系是飞行器按照期望
4 j3 k) l+ _! H) |" n2 t4 ~# q姿态飞行的关键。经过反复测试发现用模糊控制算法处理姿态数据的效果比采用单纯的PID
1 v8 X6 K! v$ Z9 r* s( R. @3 A7 U算法实现更加稳定可靠,但是需要处理的运算增多,使得单片机单位时间内进行姿态矫正的
0 S$ _- P6 C/ M0 H3 ?: }! }次数减少,从而一定程度上影响了系统的响应速度。
% o7 E: _ [* V& ]# ?$ j: h( z模糊控制算法是对手动操作者的手动控制策略、经验的总结。模糊控制算法有多种实现0 }- V* s' @! w4 w
形式。采用应用最早、最广泛的查表法可大大提高模糊控制的时效性,节省内存空间,本自" `( o$ h; m( s+ `; ~1 G* }/ p
主飞行器的设计就采用了查表法。控制时针对于不同的飞行姿态将每个电机对应的运行状态: ]; I( A3 ^3 b
分别存放在四个五行五列的数组中,系统运行时将从陀螺仪处解算出的姿态数据与数组中的! W8 U' }4 U' X* j6 N
数据对比,查找并映射到相应的隶属区间,然后在隶属的区间处取得最优解进行姿态矫正。
% N- J0 l) g5 G0 ?+ |
- A9 M8 o5 [6 P! {, P+ }) ~+ w
# _* f# c5 t9 P9 u
, ^* [/ [- X8 c( k& g" e1 i( N* k B P2 V) ]
|
|