你的浏览器版本过低,可能导致网站不能正常访问!为了你能正常使用网站功能,请使用这些浏览器。
nyszx 发表于 2020-5-2 21:23 8 m) q7 q5 @1 f$ r# H% L楼主很厉害啊,无刷驱动,飞控系统,无线通讯,软硬件,各种算法,matlab...膜拜!最近买了点书,也想学学 ...
意法半导体微控制器和微处理器拥有广泛的产品线,包含低成本的8位单片机和基于ARM® Cortex®-M0、M0+、M3、M4、M33、M7及A7内核并具备丰富外设选择的32位微控制器及微处理器。关注该话题即可发布文章!
无人机组开发平台视频讲解
无人机组开发平台介绍
【外网项目分享】无人机Firefly Pro制作指导
用于避障和区域测绘的无人机
DIY高大上四旋翼无人机飞控
几个基于STM32的开源无人机飞控
基于无人机的图像和GPS数据采集系统的研究与实现
float Butterworth_Low_Pass(float Data_IN) //2阶巴特沃斯低通滤波器截止频率30HZ FS=1000. o& v1 o( G/ J% v; h
{
float Gain=0.0078202080334971915 ;, S& O. }' ?8 k1 U% l
float b[]={1,2,1};8 D) V8 U- \ ?, ?( ]: Z
float a[]={1, -1.7347257688092752 , 0.76600660094326389 };3 H8 Y, _! x, L' f) V2 N
, Z2 S; W& g0 l" Z
static float Last_Data_IN=0;
static float Last_Last_Data_IN=0;+ N2 [) o3 N7 }. J4 J, u
float Data_OUT;3 t' h/ S; h: H! N0 S
static float Last_Data_OUT=0;% G6 j! s4 ?$ ^. w+ m3 x; D1 S
static float Last_Last_Data_OUT=0; 9 E- C# u4 N; D$ }" }
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;+ c# @) m1 w2 G- ^- m
Last_Data_IN=Data_IN;
Last_Last_Data_OUT=Last_Data_OUT;
Last_Data_OUT=Data_OUT;* J& e/ G0 \/ F
return Data_OUT;
}
上面代码Gain即为matlab生成的Gain参数,b和a分别对应matlab中的Num参数与Dem参数,函数输入为带滤波的数据,返回为滤波后的数据,需要注意的是,我是按采样频率为1000HZ设计的,就必须要求该函数的执行周期为1ms,不然滤波效果就与期望的不符了。
杂七杂八的东西太多了,所以比较费时间,我的电调比较简单,就是方波六步,没上FOC,以及高频注入
void STEP1( int PWM): K1 N$ `$ d7 A; I! p
{
TIM1->CCR1=PWM;9 y+ P( A9 P9 a8 O) R% q
TIM1->CCR2=PWM;
TIM1->CCR3=PWM; //给占空比7 o6 o8 O' w) `3 I: H; [, l! Z) d
//关T5
GPIOA->MODER=(GPIOA->MODER&0XffDFFFFF)|0X00100000; //PA10输出/ Y6 v& j! _7 O) v9 r, r
GPIOA->BRR=0X00000400;//PA10置0
//关T6( Q+ }( S; z% U6 D( C: }
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFF7)|0X00000004; //PB1输出
GPIOB->BRR =0X00000002;//PB1置0) }+ G7 u* \5 m' {, K; l
//常开T4% D! ^3 e" J. _- m
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFD)|0X00000001; //PB0输出 # l* y$ `$ }; K$ e
GPIOB->BSRR =0X00000001;//PB0置1+ c- P+ s& H* J" v$ K
//关T3
GPIOA->MODER=(GPIOA->MODER&0XFFF7FFFF)|0X00040000; //PA9输出# S- {* ]5 n5 f- l
GPIOA->BRR=0X00000200;//PA9置04 ^1 V% z' i Z- J" K
//开T1PWM) V1 x4 M2 Z7 l4 b. a3 }$ J$ |
GPIOA->MODER=(GPIOA->MODER&0XFFFEFFFF)|0X00020000; //PA8 PWM" m# i/ B) S2 b( A
//关T2
GPIOA->MODER=(GPIOA->MODER&0XFFFF7FFF)|0X00004000; //PA7输出
GPIOA->BRR =0X00000080;//PA7置0 & P7 [& l- t: |# d# R
}
void STEP2( int PWM)
{% T$ O) C6 C" |) r7 P) C
TIM1->CCR1=PWM;6 S, C- e- b2 l" E
TIM1->CCR2=PWM;
TIM1->CCR3=PWM; //给占空比
//关T4/ a' |( S4 A+ S0 [ K9 {+ v" e4 J
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFD)|0X00000001; //PB0输出
GPIOB->BRR =0X00000001;//PB0置0
//关T3/ ~1 {( k2 a- K. T
GPIOA->MODER=(GPIOA->MODER&0XFFF7FFFF)|0X00040000; //PA9输出6 Y c' d8 B6 G# o
GPIOA->BRR=0X00000200;//PA9置0
//T1常开% P) Z8 x2 J! Q; A: y1 M
GPIOA->MODER=(GPIOA->MODER&0XFFFDFFFF)|0X00010000; //PA8输出
GPIOA->BSRR=0X00000100;//PA8置1
//关T2
GPIOA->MODER=(GPIOA->MODER&0XFFFF7FFF)|0X00004000; //PA7输出5 ?5 O, R: Q5 E9 A
GPIOA->BRR =0X00000080;//PA7置0
//开T6PWM$ @' p0 d# ^6 x B6 Q) y
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFB)|0X00000008; //PB1 PWM
//关T5 5 p( f! a: r5 e `
GPIOA->MODER=(GPIOA->MODER&0XffDFFFFF)|0X00100000; //PA10输出1 u" N1 L' b& N y% v8 F$ C
GPIOA->BRR=0X00000400;//PA10置0 # F% h+ i8 q3 l' @& t" a: v! B
}, Z# v8 b5 w2 ~: F+ k' o
# V6 n* {: l2 v d