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

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

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

( C. U# g2 {  ]1 P+ E6 t1 _
赞 1 收藏 4 评论21 发布时间:2020-4-27 22:27

举报

21个回答
侯元祥 回答时间:2020-4-30 12:32:23
a316363723 发表于 2020-4-29 14:18
7 B6 {+ t' }# X' A' u  l# g# ~大佬,你这个可以飞多久呢?

( K4 `4 R% |7 n$ l8 U. Q8 @目前是3S 2200 电池 测了一下13分钟左右
侯元祥 回答时间:2020-5-6 09:42:29
分享以下无刷电调的设计经验,无刷电调用的STM32F051,选择这个是因为自带比较器,这样采用虚拟中性点过零点换向的方法就比较好实现,另外,STM32自带的高级定时器输入互补PWM也是节省了不少时间,我使用的是传统的方波六步,原理比较粗暴,哪一相关断,直接把对应的GPIO配置为下拉输出,哪一相需要PWM调制,在配置为PWM复用输出,全部寄存器操作,节省了不少时间。利用了比较器的中断,换向事件完全在中断里解决。以下为方波六步的前两步代码,其他的以此类推。
: G1 _; S1 e) k9 V! Fvoid STEP1( int PWM)
+ Q0 t. u( D& g; R$ K{
! T3 \  J' z  n8 D5 v2 f
7 z* }2 z  a) q# ?6 j9 v TIM1->CCR1=PWM;
6 ^% W% d) @6 g TIM1->CCR2=PWM;! T8 I- v8 a9 G  Y) {
TIM1->CCR3=PWM;  //给占空比
# P8 D3 o8 w  ^9 @ //关T5 & P' D0 B$ k6 X2 u
GPIOA->MODER=(GPIOA->MODER&0XffDFFFFF)|0X00100000; //PA10输出
+ ^3 R: I: t9 }# S5 `( Q GPIOA->BRR=0X00000400;//PA10置0
8 {6 M$ P) S* e //关T6
/ L# `; k  d/ A$ x& r# @+ v2 j GPIOB->MODER=(GPIOB->MODER&0XFFFFFFF7)|0X00000004; //PB1输出
6 T4 z# {. s( T; M( [! C! i0 t GPIOB->BRR =0X00000002;//PB1置0
4 h, F9 Y1 @2 o: P% D //常开T4
. q: _& ^9 f0 @! ^" L: a6 ] GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFD)|0X00000001; //PB0输出
# k! p  l9 g& m3 |; R GPIOB->BSRR =0X00000001;//PB0置1; z/ r6 S" o+ O5 V  k
//关T3
: a3 K7 ?8 Q: d/ Y( ?, u% P GPIOA->MODER=(GPIOA->MODER&0XFFF7FFFF)|0X00040000; //PA9输出+ d$ Y4 N  a1 f$ [! ]
GPIOA->BRR=0X00000200;//PA9置0
5 w) Q9 S5 {+ Z# j5 y //开T1PWM+ g+ t# e' _# Z& \/ u# ]3 \
GPIOA->MODER=(GPIOA->MODER&0XFFFEFFFF)|0X00020000; //PA8 PWM
1 |! G7 A9 N5 c //关T2
9 j. |6 N. u3 q( }. U* ^3 c8 c GPIOA->MODER=(GPIOA->MODER&0XFFFF7FFF)|0X00004000; //PA7输出
& B5 N/ U6 ?5 F+ u# T GPIOA->BRR =0X00000080;//PA7置0
! [$ \  t/ H, H7 a! |: x$ `}
& @$ v( o4 i7 C- ]
. v3 ^8 g* E" B6 {2 G; Gvoid STEP2( int PWM)
, u9 k& k- I9 c- A  u5 Y{
1 P. o" d1 G5 f/ I7 r TIM1->CCR1=PWM;4 J# f, |2 Z7 \4 H4 D
TIM1->CCR2=PWM;
* D/ M- }5 F% {: }; N TIM1->CCR3=PWM;  //给占空比
5 e0 G2 R* X( R //关T4
8 D6 a" i. E3 b* Y, h/ C GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFD)|0X00000001; //PB0输出
7 v5 b% F) ?8 B- v GPIOB->BRR =0X00000001;//PB0置0
* X/ K1 F  l! H  R, y //关T3, P. z+ [. I* s* y
GPIOA->MODER=(GPIOA->MODER&0XFFF7FFFF)|0X00040000; //PA9输出% {2 z( T0 ^+ r5 M' F( }+ p
GPIOA->BRR=0X00000200;//PA9置0 ; K; a; Z" B2 |' K8 Y  L( T2 y
//T1常开' W& _3 f& u+ T! ]. @
GPIOA->MODER=(GPIOA->MODER&0XFFFDFFFF)|0X00010000; //PA8输出
' m1 c8 D1 V5 ~0 c! ^& ? GPIOA->BSRR=0X00000100;//PA8置1
- z! D" L8 X* J6 ^0 x7 w# ? //关T2( f, ^9 C) Y5 H
GPIOA->MODER=(GPIOA->MODER&0XFFFF7FFF)|0X00004000; //PA7输出/ x+ P6 [2 \8 q6 f! N3 V4 O! p5 }
GPIOA->BRR =0X00000080;//PA7置0  4 ~8 e$ @) ?7 Q* \0 u3 a5 [6 q  _
//开T6PWM
0 ~+ B6 E4 |3 ?0 j GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFB)|0X00000008; //PB1 PWM9 _5 Z9 k  f$ O& I3 X0 d: U( g- n
//关T5
4 m) d7 b4 G! f4 d% `2 j GPIOA->MODER=(GPIOA->MODER&0XffDFFFFF)|0X00100000; //PA10输出  f+ b# ]1 [: T, i6 I
GPIOA->BRR=0X00000400;//PA10置0  6 V5 Z6 o5 q6 d, E
}
2 H" g( h! D9 E. ]
9 F" w! r$ s* m; D) Z
侯元祥 回答时间:2020-5-2 08:44:31
FDA生成的滤波器滤波器参数本质上是,冲击响应函数,两个系数矩阵,他这里还有一个增益Gain,我们用的时候只需要把这个转为差分方程就可以,下面我直接贴上代码  _  W7 H( Z8 h+ ?4 E" K
float Butterworth_Low_Pass(float Data_IN) //2阶巴特沃斯低通滤波器截止频率30HZ FS=1000) I# a. `( p% L0 P4 v4 k
{& K/ G; R/ A- _9 n
float Gain=0.0078202080334971915 ;
4 G% |8 t1 a, Y1 X. D
; V/ d1 T- ^; O: F+ ` float b[]={1,2,1};9 S8 s; l% o. P) E; z+ f* a( ~& X
float a[]={1, -1.7347257688092752 , 0.76600660094326389 };
& J5 r. t" c; W8 W$ m/ b6 {
+ _  C( P/ B! R" w' s6 [, h; u) \! @% x static float Last_Data_IN=0;
5 Q) |+ B2 \0 @) q' b- | static float Last_Last_Data_IN=0;5 c* |& |! L7 T% [! c! _
  float Data_OUT;9 B1 ~& D) {- k
static float Last_Data_OUT=0;( L8 d9 E( N4 N
static float Last_Last_Data_OUT=0; 4 {& E8 Y) ^! Y. o
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];
/ M1 h& f: m9 O) z/ C0 s' L  H Last_Last_Data_IN=Last_Data_IN;* w0 G8 |& ^  x5 E
Last_Data_IN=Data_IN;
7 s# x( B6 @  w% p0 }9 N0 F Last_Last_Data_OUT=Last_Data_OUT;! [: ]6 i+ W. z( G  `, ^4 d  q
Last_Data_OUT=Data_OUT;4 i1 _% l$ J% q" t, b. w
  return  Data_OUT;
* s  y* x# A/ v+ z5 k5 r}
, Z! B" W+ \/ e6 {6 S* t上面代码Gain即为matlab生成的Gain参数,b和a分别对应matlab中的Num参数与Dem参数,函数输入为带滤波的数据,返回为滤波后的数据,需要注意的是,我是按采样频率为1000HZ设计的,就必须要求该函数的执行周期为1ms,不然滤波效果就与期望的不符了。5 E. h" y- W, e3 E" f1 {
侯元祥 回答时间: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丝印层跑偏了,凑合用吧。5 [* C8 L1 S' {7 ?) y- `: p7 s: @
捕获.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元了,
$ G$ c. S& M. c" w
MDK截图1.PNG
侯元祥 回答时间:2020-4-27 23:07:13
遥控器用的STM32F103 ,毕竟没有那么高的运算量,简单采集的摇杆电压,通信就行,另外,遥控器部分也加入了陀螺仪与磁力计,可以实现类似重力感应控制的功能。供电采用的是18650电池,USB接口充电,充电芯片烂大街的TP4056,加了一个比较“高大上的屏幕,串口控制”,有上位机编辑界面,感觉挺好用,减轻了不少单片机的负担,再配合上串口DMA,完全不占用CPU资源,另外这里的NRF24L01,使用了带数据的ACK功能,实现了双向传输,飞机也可以把数据回传给遥控,比如姿态信息,剩余电量等。
& L$ d, l, P6 j0 N& M. }1 k( V

遥控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机架上,完美。6 b# `' O. x, z3 Q5 v" S
电调第一版.PNG
电调第二版.PNG
电调第三版.PNG
电调第4版.PNG
电调安装.jpg
侯元祥 回答时间:2020-4-27 23:34:13
另外电调的协议我介绍一下,传统电调基本都是PWM信号,根据PWM高电平时间决定占空比,新一点的现在都是数字电调,比如Dsht600啥的,鄙人也研究过这个Dshot协议,挺好,但是转到STM32上,我就没整成,其实就是定时器配合DMA,接收数据,后来一寻思,串口不是更好么,DMA不比定时器简单多了,最后就整成串口的了,而且四个电调的RX我接到了一起,接到主控F446的一个TX上,主控一下发送四个电调的油门信息,各个电调把自己的那部分提取出来,舍弃其他的就可以了,这样,四个电调只需要一个数据线,当然保证实时性,串口波特率要比较高,板间通信也无所谓了,缺点就是,这个电调通用性不好,甚至是没有通用性,只能配合我这个飞控。6 g1 ]/ ^4 W; d( ?
电调代码.PNG
侯元祥 回答时间:2020-4-28 08:58:47
自己回复自己的贴子还需要审核
TLLED 回答时间:2020-4-28 09:26:45
侯元祥 发表于 2020-4-28 08:584 u; ^1 G% H4 L+ R' l* _0 z
自己回复自己的贴子还需要审核
7 s3 Z7 _9 @7 r% ]
发的多了就不用了
李康1202 回答时间:2020-4-28 09:40:30
大老牛
mmuuss586 回答时间:2020-4-28 10:14:23
1 y/ C4 j+ V; I! w  \7 N, t
不错,支持
侯元祥 回答时间:2020-4-28 11:41:12
( C# V; o5 f( d* i7 s
1 T  c% }) i7 y; x9 t5 ~8 a. b
视频8 t7 a% a5 ?8 R* _6 c3 T' y  J
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 手机版