你的浏览器版本过低,可能导致网站不能正常访问!
为了你能正常使用网站功能,请使用这些浏览器。

【创意】用STM32搞定无人机飞控系统(遥控、电调、主控)

[复制链接]
侯元祥 发布时间:2020-4-27 22:27
  第一次在ST论坛发帖,以前都是瞎逛,在大佬的帖子里学习了不少东西,这次看到这个什么创意挑战赛,说实话我也没看明白怎么参加这活动,什么格式啥的有啥要求,其实得不得奖无所谓,在这我主要把我做飞控的一些经验分享一下,如果大家喜欢,后期可能或软硬件全部开源。  Z3 u4 G) g0 g# M/ ]6 D
既然是用STM32 那就用彻底了,而且我整的无人机从遥控到电调,到最终的主控全系列STM32,制版,程序全部自己来,遥控用的STM32F103C8,电调用的STM32F051 ,飞控用的STM32F446.+ W' d5 C9 E# H4 m
" i5 [4 W7 C) Y" D. A
赞 1 收藏 4 评论21 发布时间:2020-4-27 22:27

举报

21个回答
侯元祥 回答时间:2020-4-30 12:32:23
a316363723 发表于 2020-4-29 14:18
, L$ s" ~) c$ H; W( i: A: p4 m8 D大佬,你这个可以飞多久呢?

  V9 w( E, ]8 [目前是3S 2200 电池 测了一下13分钟左右
侯元祥 回答时间:2020-5-6 09:42:29
分享以下无刷电调的设计经验,无刷电调用的STM32F051,选择这个是因为自带比较器,这样采用虚拟中性点过零点换向的方法就比较好实现,另外,STM32自带的高级定时器输入互补PWM也是节省了不少时间,我使用的是传统的方波六步,原理比较粗暴,哪一相关断,直接把对应的GPIO配置为下拉输出,哪一相需要PWM调制,在配置为PWM复用输出,全部寄存器操作,节省了不少时间。利用了比较器的中断,换向事件完全在中断里解决。以下为方波六步的前两步代码,其他的以此类推。* H7 X8 C; d5 \* X" E( Y/ m
void STEP1( int PWM)
/ o5 d; ^+ L% B6 u1 y. h0 O0 H4 f9 c{# _% F5 g1 H# T. @

* f+ e( ?! I1 M  V: ~" b TIM1->CCR1=PWM;
' k- V1 v" [, V$ a& S) `8 v5 J TIM1->CCR2=PWM;
' h) Q9 X) h) n3 G TIM1->CCR3=PWM;  //给占空比
# A+ {/ A' _5 D1 n6 [% U/ D& e; {+ d7 S //关T5 ' B9 Y5 K# K& P( S2 j5 J$ S9 H
GPIOA->MODER=(GPIOA->MODER&0XffDFFFFF)|0X00100000; //PA10输出
' |) u  y/ L. M3 z GPIOA->BRR=0X00000400;//PA10置0
: E0 t1 c5 w  u. t' h4 ?2 |. Y //关T61 I+ w4 {5 q* V$ @) K* q
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFF7)|0X00000004; //PB1输出& `0 {  l0 c3 ?! A1 G2 H0 I! l
GPIOB->BRR =0X00000002;//PB1置00 d5 Y( i6 M+ Z( o
//常开T4* ]3 @3 w& f( X0 J& G9 k1 g$ G
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFD)|0X00000001; //PB0输出
8 u+ s( A2 g4 t0 Y: B4 X GPIOB->BSRR =0X00000001;//PB0置1
; A0 U- D5 F! _" x: G. ]" m //关T3
) E* Z8 x! n. B GPIOA->MODER=(GPIOA->MODER&0XFFF7FFFF)|0X00040000; //PA9输出8 `0 B5 R8 l9 I, c) }/ Y
GPIOA->BRR=0X00000200;//PA9置0) k8 J! z! f4 m. m; L9 ]
//开T1PWM
3 J- O) H; j( C* F! X" u GPIOA->MODER=(GPIOA->MODER&0XFFFEFFFF)|0X00020000; //PA8 PWM
: \! z1 u% s; G9 p //关T29 D; i% W, v3 u) W
GPIOA->MODER=(GPIOA->MODER&0XFFFF7FFF)|0X00004000; //PA7输出
5 r% N7 g( J. Q6 N GPIOA->BRR =0X00000080;//PA7置0
9 d5 Q# d3 ~, t) ~2 K}
! j2 u& X1 k; {2 U; K) y7 Z$ N+ `
void STEP2( int PWM). H: t# l1 K1 Y# f* \8 y
{2 w2 q. Z# t8 a) X. A) Q: e
TIM1->CCR1=PWM;! Z/ L) x3 K9 i+ u
TIM1->CCR2=PWM;' Q8 g) F3 Q5 z! `0 u
TIM1->CCR3=PWM;  //给占空比( S& n2 l) r% U( v
//关T4+ r$ x% z+ S& b7 w, ^7 W' s
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFD)|0X00000001; //PB0输出 # H6 E* S9 M- a3 I. E$ Z
GPIOB->BRR =0X00000001;//PB0置0
) V/ J7 O3 J1 U' o" t0 N2 l //关T3
( T, d1 A; }7 j2 b. A7 k$ v GPIOA->MODER=(GPIOA->MODER&0XFFF7FFFF)|0X00040000; //PA9输出
5 _$ \1 J$ O& Z. c; p GPIOA->BRR=0X00000200;//PA9置0
+ ^# U( ?5 t1 Z2 v4 V* a7 M //T1常开2 m( R# x* n3 U9 h
GPIOA->MODER=(GPIOA->MODER&0XFFFDFFFF)|0X00010000; //PA8输出/ @: P# \9 d. S8 A* I
GPIOA->BSRR=0X00000100;//PA8置1 # Z  I+ r, w( m9 x0 y
//关T2
9 D- P" q. e$ \1 K4 v, A GPIOA->MODER=(GPIOA->MODER&0XFFFF7FFF)|0X00004000; //PA7输出
/ y* J; {) n% `0 G) Y; P GPIOA->BRR =0X00000080;//PA7置0  
3 g6 L. R0 c- j1 i! U //开T6PWM. u5 |# }( [0 X
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFB)|0X00000008; //PB1 PWM
( r, a5 h  @. O' l! Y //关T5   U' Z+ P6 H, U3 q- [/ L
GPIOA->MODER=(GPIOA->MODER&0XffDFFFFF)|0X00100000; //PA10输出
. p  O8 f) w" G  V+ I GPIOA->BRR=0X00000400;//PA10置0  
* I$ J" U4 _3 s' P- t. ]}( g. a* I& g8 @- E% A9 J8 P+ f
. v2 P  U/ J9 N! W
侯元祥 回答时间:2020-5-2 08:44:31
FDA生成的滤波器滤波器参数本质上是,冲击响应函数,两个系数矩阵,他这里还有一个增益Gain,我们用的时候只需要把这个转为差分方程就可以,下面我直接贴上代码
$ e( e; s% n: n2 _& ffloat Butterworth_Low_Pass(float Data_IN) //2阶巴特沃斯低通滤波器截止频率30HZ FS=10001 `4 v4 D" g9 Y4 A2 k) l
{
% Z+ M/ g) u$ e float Gain=0.0078202080334971915 ;
' |3 ^9 G& ?1 T2 [
7 {. ^+ V* b% C! p* @0 [3 i float b[]={1,2,1};5 E8 |' ~# G1 ^+ S# |
float a[]={1, -1.7347257688092752 , 0.76600660094326389 };8 i; w4 h7 Z; W$ W  B/ A# ?$ ]9 |
5 _, L; l% J$ W/ c
static float Last_Data_IN=0;) d& q% v7 A. s  o& g0 d8 z
static float Last_Last_Data_IN=0;& W- M0 T. l" N9 m6 `% }
  float Data_OUT;
: E) ]0 }2 F. X8 J static float Last_Data_OUT=0;' D# X- O+ G2 N- ?* K* i
static float Last_Last_Data_OUT=0;
5 i+ A" ~$ k" H, u! `  U) ]  B Data_OUT=(Gain*(b[0]*Data_IN + b[1]*Last_Data_IN + b[2]*Last_Last_Data_IN) - a[1]*Last_Data_OUT - a[2]*Last_Last_Data_OUT)/a[0];+ F4 O5 O# S, j+ V/ }$ X! m0 A
Last_Last_Data_IN=Last_Data_IN;
; G3 z5 o) ?2 y  O! Y Last_Data_IN=Data_IN;
: l0 C0 b. q4 l- o' q6 ?  x Last_Last_Data_OUT=Last_Data_OUT;8 m( ]* P) ]  R6 ]9 U+ H
Last_Data_OUT=Data_OUT;
; x0 y! d; x$ z) |: o  return  Data_OUT;9 {' {( T8 t- B$ h
}
% E) S: m$ G0 s1 @1 W上面代码Gain即为matlab生成的Gain参数,b和a分别对应matlab中的Num参数与Dem参数,函数输入为带滤波的数据,返回为滤波后的数据,需要注意的是,我是按采样频率为1000HZ设计的,就必须要求该函数的执行周期为1ms,不然滤波效果就与期望的不符了。8 z3 S5 j3 S% v& s5 m0 V
侯元祥 回答时间:2020-4-27 22:38:23
先来个整体图片吧,首先,最关注的可能是飞控,简单介绍一下硬件情况,主控此次用的是STM32F446 180MHZ主频,陀螺仪ICM20689(后期换为精度更高的BMI088),磁力计AK8975,气压计MS5611(后期换为精度更高的SPL06)。

整机照片

整机照片
侯元祥 回答时间:2020-4-27 22:47:30
两张图,降压模块用的TPS5430 ,通信模块用的NRF24L1+,预留了ST_LINK的调试接口,飞控部分硬件其实没啥,主要在于软件,注意:图中的PCB和原理图不是完全对应,由于我后期再接在PCB界面更改了部分芯片,原理图没有更新,以PCB为准。不知为何打样回的PCB丝印层跑偏了,凑合用吧。( b3 y5 B3 f2 U# c1 T
捕获.PNG
捕获2.PNG
PCB.jpg
侯元祥 回答时间:2020-4-27 22:57:29
用到F446主要是因为飞控算法会用到大量的浮点运算以及三角函数等,32F4系列的DSP功能,还是不错的,特别是三角函数库,快的一批,底层的话主要是传感器驱动,陀螺仪SPI, NRF24L01 SPI ,还有个flash也是SPI, 正好把F446的三个SPI全占用了,其余磁力计和气压计 走的IIC,模拟IIC ,毕竟这两种传感器实时性要求不是特别高,对于陀螺仪的选取,很多飞控用的都是MPU6000系列的,算得上是经典了,资料也多,其实最新的ICM系列(MPU系列升级系列)性能上更好,比如ICM20602,20689等,我一开始也是按ICM20689设计的,后来偶然发现博士的一款BMI888陀螺仪,参数更好,而且据说超强抗震,所以就临时换了博士的,但是,说实话,和ICM系列相比飞起来差别不大感觉,除了加速度计数据能好看点,但博士的一片块陀螺仪30元了,1 k3 C) A! y: F- |0 ~* u
MDK截图1.PNG
侯元祥 回答时间:2020-4-27 23:07:13
遥控器用的STM32F103 ,毕竟没有那么高的运算量,简单采集的摇杆电压,通信就行,另外,遥控器部分也加入了陀螺仪与磁力计,可以实现类似重力感应控制的功能。供电采用的是18650电池,USB接口充电,充电芯片烂大街的TP4056,加了一个比较“高大上的屏幕,串口控制”,有上位机编辑界面,感觉挺好用,减轻了不少单片机的负担,再配合上串口DMA,完全不占用CPU资源,另外这里的NRF24L01,使用了带数据的ACK功能,实现了双向传输,飞机也可以把数据回传给遥控,比如姿态信息,剩余电量等。
. q+ s8 H* B% U1 Z5 a+ T) P

遥控PCB

遥控PCB

串口屏上位机

串口屏上位机
遥控1.jpg
遥控2.jpg
侯元祥 回答时间:2020-4-27 23:25:50
先说一下,等明天我上传个飞行视频,,接下来是电调,其实我主要学的就是电机控制这方面,做飞控主要是兴趣爱好,但是电调就偏硬件比较多了,(感觉电调比飞控难啊)涉及到无刷电机的控制,调速等等,这个电调来来回回我也做了好几版,最初的是用N+P结构的,后来换成全N结构,上了独立的MOS驱动,由于32F051自带比较器,这个真是太好了,话说除了F3和现在的G0,G4系列,其他的32系列都没有硬件比较器了吧,这个东起感觉用途还是非常大的,大家看看,我这电调前三板都是牺牲品,第三版其实基本没有问题了采用的是全NMOS,STM32F051+FD6288芯片,但是我嫌放飞机上走线不方便了,就有了最后的第四版,把四个电调放一起,放到飞机中心支架上,这样好处是,稳压芯片可以共用,滤波电容也不用单独放,正好放在我的330机架上,完美。
$ Y! n9 a: S1 f
电调第一版.PNG
电调第二版.PNG
电调第三版.PNG
电调第4版.PNG
电调安装.jpg
侯元祥 回答时间:2020-4-27 23:34:13
另外电调的协议我介绍一下,传统电调基本都是PWM信号,根据PWM高电平时间决定占空比,新一点的现在都是数字电调,比如Dsht600啥的,鄙人也研究过这个Dshot协议,挺好,但是转到STM32上,我就没整成,其实就是定时器配合DMA,接收数据,后来一寻思,串口不是更好么,DMA不比定时器简单多了,最后就整成串口的了,而且四个电调的RX我接到了一起,接到主控F446的一个TX上,主控一下发送四个电调的油门信息,各个电调把自己的那部分提取出来,舍弃其他的就可以了,这样,四个电调只需要一个数据线,当然保证实时性,串口波特率要比较高,板间通信也无所谓了,缺点就是,这个电调通用性不好,甚至是没有通用性,只能配合我这个飞控。6 R. W+ z' J4 K$ C6 W2 T
电调代码.PNG
侯元祥 回答时间:2020-4-28 08:58:47
自己回复自己的贴子还需要审核
TLLED 回答时间:2020-4-28 09:26:45
侯元祥 发表于 2020-4-28 08:58! r' l; X/ }, H( N7 i2 ?# U
自己回复自己的贴子还需要审核
, r1 A' B! z, i
发的多了就不用了
李康1202 回答时间:2020-4-28 09:40:30
大老牛
mmuuss586 回答时间:2020-4-28 10:14:23

8 u, V: {" n; e5 w' p) G不错,支持
侯元祥 回答时间:2020-4-28 11:41:12
+ m) {: Z7 Z: I- Y0 _

: E7 l8 q2 N+ |/ \视频
; m$ Q% g! o+ X- f& T! r
a316363723 回答时间:2020-4-29 14:18:16
大佬,你这个可以飞多久呢?
侯元祥 回答时间:2020-5-2 08:37:59
分享一下滤波器的设计把,特别是飞控中,不论是陀螺仪还是加速度计都含有大量的高频噪声,怎样设计滤波器是关键,这里我推荐用matlab自带的FDA滤波器设计工具,打开FDA,可以配置滤波器参数,以飞机常用的IIR巴特沃斯滤波器为例,采样频率FS根据你的陀螺仪输出速率而定我这里是1000HZ,Fc为截止频率,即高于该频率的信号一律滤除,我这里选择30HZ,点击下面的Design Filter,即可生成滤波器,点击Analysis_Coefficientts 就可以查看滤波器的参数了,有了这个参数,怎么用在单片机上,下面再说。
matlab1.PNG
matlab2.PNG
matlab3.PNG
matlab4.PNG
12下一页
关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版