第一次在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 |
微信公众号
手机版
目前是3S 2200 电池 测了一下13分钟左右
void STEP1( int PWM)
{# _% F5 g1 H# T. @
TIM1->CCR1=PWM;
TIM1->CCR2=PWM;
TIM1->CCR3=PWM; //给占空比
//关T5 ' B9 Y5 K# K& P( S2 j5 J$ S9 H
GPIOA->MODER=(GPIOA->MODER&0XffDFFFFF)|0X00100000; //PA10输出
GPIOA->BRR=0X00000400;//PA10置0
//关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输出
GPIOB->BSRR =0X00000001;//PB0置1
//关T3
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
GPIOA->MODER=(GPIOA->MODER&0XFFFEFFFF)|0X00020000; //PA8 PWM
//关T29 D; i% W, v3 u) W
GPIOA->MODER=(GPIOA->MODER&0XFFFF7FFF)|0X00004000; //PA7输出
GPIOA->BRR =0X00000080;//PA7置0
}
; 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
//关T3
GPIOA->MODER=(GPIOA->MODER&0XFFF7FFFF)|0X00040000; //PA9输出
GPIOA->BRR=0X00000200;//PA9置0
//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
GPIOA->MODER=(GPIOA->MODER&0XFFFF7FFF)|0X00004000; //PA7输出
GPIOA->BRR =0X00000080;//PA7置0
//开T6PWM. u5 |# }( [0 X
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFB)|0X00000008; //PB1 PWM
//关T5 U' Z+ P6 H, U3 q- [/ L
GPIOA->MODER=(GPIOA->MODER&0XffDFFFFF)|0X00100000; //PA10输出
GPIOA->BRR=0X00000400;//PA10置0
}( g. a* I& g8 @- E% A9 J8 P+ f
. v2 P U/ J9 N! W
float Butterworth_Low_Pass(float Data_IN) //2阶巴特沃斯低通滤波器截止频率30HZ FS=10001 `4 v4 D" g9 Y4 A2 k) l
{
float Gain=0.0078202080334971915 ;
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;
static float Last_Data_OUT=0;' D# X- O+ G2 N- ?* K* i
static float Last_Last_Data_OUT=0;
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;
Last_Data_IN=Data_IN;
Last_Last_Data_OUT=Last_Data_OUT;8 m( ]* P) ] R6 ]9 U+ H
Last_Data_OUT=Data_OUT;
return Data_OUT;9 {' {( T8 t- B$ h
}
上面代码Gain即为matlab生成的Gain参数,b和a分别对应matlab中的Num参数与Dem参数,函数输入为带滤波的数据,返回为滤波后的数据,需要注意的是,我是按采样频率为1000HZ设计的,就必须要求该函数的执行周期为1ms,不然滤波效果就与期望的不符了。8 z3 S5 j3 S% v& s5 m0 V
æ´æºç §ç
饿§PCB
串å£å±ä¸ä½æº
发的多了就不用了
不错,支持
视频