第一次在ST论坛发帖,以前都是瞎逛,在大佬的帖子里学习了不少东西, 这次看到这个什么创意挑战赛,说实话我也没看明白怎么参加这活动,什么格式啥的有啥要求,其实得不得奖无所谓,在这我主要把我做飞控的一些经验分享一下,如果大家喜欢,后期可能或软硬件全部开源。 C" {# R5 }/ D* \) W+ I既然是用STM32 那就用彻底了,而且我整的无人机从遥控到电调,到最终的主控全系列STM32 ,制版,程序全部自己来,遥控用的STM32F103C8,电调用的STM32F051 ,飞控用的STM32F446." [+ H/ o9 S* T- p9 G4 z) |- g |
微信公众号
手机版
目前是3S 2200 电池 测了一下13分钟左右
void STEP1( int PWM)
{
TIM1->CCR1=PWM;
TIM1->CCR2=PWM;! T8 I- v8 a9 G Y) {
TIM1->CCR3=PWM; //给占空比
//关T5 & P' D0 B$ k6 X2 u
GPIOA->MODER=(GPIOA->MODER&0XffDFFFFF)|0X00100000; //PA10输出
GPIOA->BRR=0X00000400;//PA10置0
//关T6
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFF7)|0X00000004; //PB1输出
GPIOB->BRR =0X00000002;//PB1置0
//常开T4
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFD)|0X00000001; //PB0输出
GPIOB->BSRR =0X00000001;//PB0置1; z/ r6 S" o+ O5 V k
//关T3
GPIOA->MODER=(GPIOA->MODER&0XFFF7FFFF)|0X00040000; //PA9输出+ d$ Y4 N a1 f$ [! ]
GPIOA->BRR=0X00000200;//PA9置0
//开T1PWM+ g+ t# e' _# Z& \/ u# ]3 \
GPIOA->MODER=(GPIOA->MODER&0XFFFEFFFF)|0X00020000; //PA8 PWM
//关T2
GPIOA->MODER=(GPIOA->MODER&0XFFFF7FFF)|0X00004000; //PA7输出
GPIOA->BRR =0X00000080;//PA7置0
}
void STEP2( int PWM)
{
TIM1->CCR1=PWM;4 J# f, |2 Z7 \4 H4 D
TIM1->CCR2=PWM;
TIM1->CCR3=PWM; //给占空比
//关T4
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFD)|0X00000001; //PB0输出
GPIOB->BRR =0X00000001;//PB0置0
//关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输出
GPIOA->BSRR=0X00000100;//PA8置1
//关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
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFB)|0X00000008; //PB1 PWM9 _5 Z9 k f$ O& I3 X0 d: U( g- n
//关T5
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
}
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 ;
float b[]={1,2,1};9 S8 s; l% o. P) E; z+ f* a( ~& X
float a[]={1, -1.7347257688092752 , 0.76600660094326389 };
static float Last_Data_IN=0;
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];
Last_Last_Data_IN=Last_Data_IN;* w0 G8 |& ^ x5 E
Last_Data_IN=Data_IN;
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;
}
上面代码Gain即为matlab生成的Gain参数,b和a分别对应matlab中的Num参数与Dem参数,函数输入为带滤波的数据,返回为滤波后的数据,需要注意的是,我是按采样频率为1000HZ设计的,就必须要求该函数的执行周期为1ms,不然滤波效果就与期望的不符了。5 E. h" y- W, e3 E" f1 {
æ´æºç §ç
饿§PCB
串å£å±ä¸ä½æº
发的多了就不用了
不错,支持
1 T c% }) i7 y; x9 t5 ~8 a. b
视频8 t7 a% a5 ?8 R* _6 c3 T' y J