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

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

[复制链接]
侯元祥 发布时间:2020-4-27 22:27
赞 1 收藏 4 评论21 发布时间:2020-4-27 22:27
21个回答
侯元祥 回答时间:2020-5-2 08:44:31
FDA生成的滤波器滤波器参数本质上是,冲击响应函数,两个系数矩阵,他这里还有一个增益Gain,我们用的时候只需要把这个转为差分方程就可以,下面我直接贴上代码: X) P% |/ G9 I# x
float Butterworth_Low_Pass(float Data_IN) //2阶巴特沃斯低通滤波器截止频率30HZ FS=1000. o& v1 o( G/ J% v; h
{
& d3 R( f. E. m( Z( O float Gain=0.0078202080334971915 ;, S& O. }' ?8 k1 U% l

9 d5 x$ W5 I, A% I, K: m* \+ M9 Z, V 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;
3 A- ?9 B' T5 A( p 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];
+ J- R6 e6 T$ w3 E Last_Last_Data_IN=Last_Data_IN;+ c# @) m1 w2 G- ^- m
Last_Data_IN=Data_IN;
2 C, N0 E+ |/ p6 E( x  p Last_Last_Data_OUT=Last_Data_OUT;
+ Y- k$ _/ T8 f) J  e1 }  A Last_Data_OUT=Data_OUT;* J& e/ G0 \/ F
  return  Data_OUT;
  b6 U/ r: D4 ^) r}
6 L& g& s) Q9 U* X6 Y! m上面代码Gain即为matlab生成的Gain参数,b和a分别对应matlab中的Num参数与Dem参数,函数输入为带滤波的数据,返回为滤波后的数据,需要注意的是,我是按采样频率为1000HZ设计的,就必须要求该函数的执行周期为1ms,不然滤波效果就与期望的不符了。
; U* t' a, P) U
nyszx 回答时间:2020-5-2 21:23:02
楼主很厉害啊,无刷驱动,飞控系统,无线通讯,软硬件,各种算法,matlab...膜拜!最近买了点书,也想学学无刷驱动软硬件设计,什么BLDC .FOC.HFI的,头都大了
李康1202 回答时间:2020-5-3 09:20:28
赞一个
侯元祥 回答时间:2020-5-6 09:35:42
nyszx 发表于 2020-5-2 21:23
8 m) q7 q5 @1 f$ r# H% L楼主很厉害啊,无刷驱动,飞控系统,无线通讯,软硬件,各种算法,matlab...膜拜!最近买了点书,也想学学 ...

$ Q. r/ Y5 c% @) i( X& g7 j杂七杂八的东西太多了,所以比较费时间,我的电调比较简单,就是方波六步,没上FOC,以及高频注入
侯元祥 回答时间:2020-5-6 09:42:29
分享以下无刷电调的设计经验,无刷电调用的STM32F051,选择这个是因为自带比较器,这样采用虚拟中性点过零点换向的方法就比较好实现,另外,STM32自带的高级定时器输入互补PWM也是节省了不少时间,我使用的是传统的方波六步,原理比较粗暴,哪一相关断,直接把对应的GPIO配置为下拉输出,哪一相需要PWM调制,在配置为PWM复用输出,全部寄存器操作,节省了不少时间。利用了比较器的中断,换向事件完全在中断里解决。以下为方波六步的前两步代码,其他的以此类推。$ C: L* k+ ^4 r7 m
void STEP1( int PWM): K1 N$ `$ d7 A; I! p
{
$ Z8 K& M) P* G$ X6 J9 M) C$ P
3 b, o5 d9 m- @ TIM1->CCR1=PWM;9 y+ P( A9 P9 a8 O) R% q
TIM1->CCR2=PWM;
+ Z: |# t5 _9 q2 Y% n$ D" `, t' k TIM1->CCR3=PWM;  //给占空比7 o6 o8 O' w) `3 I: H; [, l! Z) d
//关T5
9 c7 c1 U# m8 D5 D0 X- @& L1 ^' J6 @ GPIOA->MODER=(GPIOA->MODER&0XffDFFFFF)|0X00100000; //PA10输出/ Y6 v& j! _7 O) v9 r, r
GPIOA->BRR=0X00000400;//PA10置0
, E/ U* U( T7 O7 L% F% o //关T6( Q+ }( S; z% U6 D( C: }
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFF7)|0X00000004; //PB1输出
4 ]; f5 a4 _5 x7 ^3 h 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
  l& q. D9 q' c" v: t9 Y 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
% ~/ _- ~4 ]; P! B' r3 A GPIOA->MODER=(GPIOA->MODER&0XFFFF7FFF)|0X00004000; //PA7输出
! K' q0 \. P. k( ?' K8 R( \0 P+ t GPIOA->BRR =0X00000080;//PA7置0 & P7 [& l- t: |# d# R
}
6 |! Q/ u4 X( d5 @+ y% x
6 V6 @; q9 u2 M( V9 E$ Bvoid STEP2( int PWM)
: X; \9 x8 Z! E8 t+ z  W{% T$ O) C6 C" |) r7 P) C
TIM1->CCR1=PWM;6 S, C- e- b2 l" E
TIM1->CCR2=PWM;
4 j+ i9 |+ q. m' ~: P' } TIM1->CCR3=PWM;  //给占空比
: [) j2 x# F( ^5 r //关T4/ a' |( S4 A+ S0 [  K9 {+ v" e4 J
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFD)|0X00000001; //PB0输出
7 k  h  G! M4 l2 e GPIOB->BRR =0X00000001;//PB0置0
# t1 K9 o7 w+ c/ j //关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
/ b0 Y+ B' f0 ~& S8 r$ h //T1常开% P) Z8 x2 J! Q; A: y1 M
GPIOA->MODER=(GPIOA->MODER&0XFFFDFFFF)|0X00010000; //PA8输出
! g8 e2 t1 g- d8 V% T5 _4 n- q( i* z GPIOA->BSRR=0X00000100;//PA8置1
  l7 M" ^1 F# N; e" @, `  C$ p //关T2
% [; M+ r5 o8 b7 W9 Z GPIOA->MODER=(GPIOA->MODER&0XFFFF7FFF)|0X00004000; //PA7输出5 ?5 O, R: Q5 E9 A
GPIOA->BRR =0X00000080;//PA7置0  
/ e2 U1 l: }1 K" F% I' A; A //开T6PWM$ @' p0 d# ^6 x  B6 Q) y
GPIOB->MODER=(GPIOB->MODER&0XFFFFFFFB)|0X00000008; //PB1 PWM
2 ?  F( i* ~" T //关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
guoyuli 回答时间:2020-5-6 22:26:06
厉害了大佬!
菜鸟先飞2016 回答时间:2020-6-30 11:40:00
不错,覆盖全面
12
关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版