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

【基于STM32L432的飞控】 精华  

[复制链接]
Cortexxx 发布时间:2016-10-21 14:29
本帖最后由 Cortexxx 于 2016-11-23 14:00 编辑 8 w$ S5 G3 x) m: y! t

: S, ]/ u. Y9 K9 T  s  K8月份众筹的板子  今天分享一下四轴飞控  
5 k. q9 m0 J9 I3 TNucleo 32板子比较小比较适合做飞控 2 l6 e1 V1 }# @7 G
采用了互补滤波和串级PID' [. H+ h4 |7 w! |5 [6 Q+ x
个人认为最重要的就对PID的了解 和PID的调试 7 z" p4 }* a8 `2 g6 o/ C' @* [/ \
! Y7 |' b. ^! a0 \" O
$ ]. ~6 z- _$ S" J& S3 E* q3 E
第一步 买买买7 b% R! m% x. n* Q
无刷电机: LZ买的是朗宇2212 980KV 电机;    买电机的时候不要贪小便宜,贵一点无所谓,买个正品比什么都重要;当然如果程序写的好,电机好坏就无所谓了。! l4 V. d2 C- P
电子调速器: aka 电调 好盈20A4 C6 Y/ e6 e6 W; i0 s# z
螺旋桨: 9寸
% P( I3 J1 `! Z+ m; ]. b; \遥控器:天地灰6II
3 M. `; |, y& j+ d   遥控器比较贵,建议买个二手的玩玩。天6足够用了 6通道的。8 u" ^9 i# p0 i/ E/ g9 e, h
航模锂电池:HRB 3S 35C 3000mAh  种类挺多的 钱多就买好的 没钱就买个中等价位的;无底洞!! btw 还要买充电器  E- q; H; O" S  K& m
6轴传感器:mpu6050 - X, A: E1 |" ?8 L+ i$ h
主控芯片:STM32L432 主频100MHz Nucleo32 体积比较小做飞控板很不错的;之前用了一块Nucleo64做过,实在有点大!
; R" j8 N# l0 s' ^4 R! K% t, h4 n7 J机架:450
6 w/ J. K( R' G4 \& _# ePS:还需要一个降压模块12V->5V的 酱就差不多圆满了 还有一些小东西 比如说 镍氢电池 扎线带  blah blah blah1 M8 e/ m- {$ f9 z5 j

! U) ^2 E" ]7 F5 H; \" u1 v' K

6 D/ a1 m& e. V第二步 调试陀螺仪
- V/ ~! B: i; q% C9 f4 o安装什么的就不说了 还要当然如果是第一次做的话 做个十字形的比较好调试 LZ是新手所以做了一个十字形的
) J: ], q9 S1 ?, `% R! d1 empu6050用的是IIC接口 LZ用的软件模拟的IIC
# T  D8 w! m% G; F1 i6轴传感器 分别是3个方向x y z 方向的加速的 和角速度( Z& i4 g1 y! k* s. A4 U
LZ采用的是最简单滤波方式--互补滤波 ; G. X& t; N  O) x
卡尔曼滤波没弄过,想弄卡尔曼的话自己好好学学吧!毕竟响应速度快。
% z# n. v9 @/ ~9 n- ^% r' i/ a# f: x
" P7 U, a1 h  R1.IIC 和 UART 程序* @: E9 c- y. \2 R# [! f3 N
2.初始化mpu60502 d. z0 A4 F9 F7 m5 Q
3.滤波% f8 p( U% O& B' Q7 ?* f0 Z+ V2 |
QQ截图20161123135923.png # A- x; d( c6 l8 L; e
  1. <blockquote>mpu.AXtemp=(float)((Get(0x3b)-145)*0.2f+mpu.AXtemp*0.8f);
复制代码
在滤波之前需要消除零点漂移  加速度 和角速度都有零点漂移 而且产生零点漂移的因素有很多 温度 气压 etc..
5 q/ G5 ?* ]2 ~所以每次启动程序的时候都要初始化零点误差。 LZ只初始化了 角速度的零点误差。因为加速度的零点误差 需要放在一个固定的已知角度来调; 0 E( _# d# t& a7 z/ f# U* D6 |
上面的 程序1 是互补滤波 ( Z& h2 R2 k" |) }( B8 p
AX AY AZ是加速度的值0 U6 D1 Y$ V  `; G8 C, j
GX....      是角速度的值5 x* j# {0 B) g5 }* _) [6 _0 o
GXErr        是角速度的零点误差值! V' X" M' W! \: X2 d
GET 加速度 和角速度值的时候 用了一个低通滤波
$ T0 t  {% r; a! P$ S# ^然后开始单位换算  之后的anglex+=(mpu.AX-anglex)*0.05f+mpu.GX/500.0f*0.95f;  是互补滤波 由于Z轴是旋转轴用不到加速度所以就直接把角速度积分的到 角度(自旋)的偏移量;
2 C6 {# C- y& P: y& h! H3 a: G" `得出来的角度也不知道好不好看 所以这时用串口把得到的角度发出去,然后用Excel把得到的点绘制成折线图。观察图像是否圆滑。有没有阶跃。, v8 F* t1 [! a1 x3 ~
                       角度读取的时间间隔必须保持一致                     : R, h; u. I0 l: Z1 }
所以必须用定时器读  LZ采用500Hz的读取速度。 因为之后还有积分微分呢 周期T必须一致
/ z$ D/ ?. V" O& G; I第三步 遥控器&电机驱动
7 G* E' Z/ b# A9 \遥控器发送信号到接收器,接收器输出50Hz的PWM 高电平时间≈1.0ms~2.0ms 具体多少用逻辑分析仪看看吧!
4 Q9 ?( M  [% D# H5 @+ A/ g3 ^只是让自己知道占空是比多少这还远远不够 还需要让单片机知道!! H- |0 g/ n8 a4 f( |3 \% L( `
两种方法:输入捕获   或者外中断加定时器. g' u# A, W7 K, s4 D
LZ用的是外中断加定时器  上升沿来个中断让读一下 TIMx->CNT的值 然后下降沿在GET一下TIM->CNT寄存器的值  两次值做差就得到的高电平时间。酱就可以了;很简单的;2 v' G$ j/ y; H- _) C. E
无刷电机的驱动 0 q- \- D/ ]. A" }$ H3 H1 A7 ?: p
MCU输出PWM(50Hz 高电平时间和遥控器的高电平时间一致或者成一定比例)->电调->无刷电机
9 I0 [  e& O* ~" v/ q5 U5 n我是这么写的程序:1.当接收器的值小于一定值的时候 关掉所有电机  2.然后把增大的值 X0.5或者0.6(自己定) 在加上基础的值; f( K: G) o+ @0 h4 ?% g
第四步 PID
9 g9 A$ M1 x& X3 f& z" m* dPID控制器 包括比例积分微分
' N: ?. S4 }/ m: K5 @$ R航模采用的是位置式PID
! D3 p; A+ P3 d- u% f比例环节 理解很简单就是误差 × Kp 可以理解为系统响应的速度Kp的值越大响应速度越快 过大就开始震荡
( h5 S+ e5 q/ ?: q
$ E2 I! J7 Z# d" d& ]9 ~4 X

8 k+ J4 q* w% q. o微分环节 微分就是求导  位移求导就相当于速度  速度求导就相当于加速度  mpu6050自带角速度 就不必把角度求导了 直接用陀螺仪输出的角度就即可;
" |* ]: Q% @4 I8 D可以把微分环节看做一个负反馈,或者说当做一个阻尼系统,如果速度越快微分出来的值就越大 当做负反馈来较小相应速度。当时 朋友给我举过一个例子,一个摆锤,抬到一定角度之后松开。一开始的时候摆锤的高度最大,所以垂直于 摆锤绳子上的力(沿运动方向的力)最大。可以把这个力理解为比例环节的值。当 摆锤 运动到零点时(期望位置) 速度最大,我们做的PID目的就是让他在0点的时候停下来。OK 这时候我们引入了 微分环节(阻尼系统)--空气阻力, 空气阻力一定是速度越快阻力越大。 这样的话摆锤在来回摆动第20个周期之后停了一下。很明显阻尼系统太小了。那好吧!!这次我们把摆锤放在水里,可能两个周期就停了。所以我们就说这事一个调的比较不错的PD系统。(没有积分环节所以没有I)
+ H% E+ C* V% W: ~$ B& u1 i1 u上面的例子可以看出 放在水里 比放在空气里面要好 但是要理解成微分环节 越大越好!!!
( t/ a, t# j- k3 j7 M! v7 x
* S2 T1 f8 d3 ]) _$ n! u
" e! _8 T9 W! l
积分环节:I 积分 换句话说就是累加的和  作为一个成熟的飞控系统 积分相当重要。但是 自己写的飞控感觉对I的要求并不算高。
  P# j$ l* x+ [+ w& b6 VI 累计误差,误差值的累加如果说你的飞机的重心不在中心上,那么一定要加一定的I作为补偿。8 c2 ]! V" Z+ K+ E- r3 z9 `8 r
再用上面的那个例子 这回把摆锤放在沙子里,好吧!!他根本不回到达零点!!沙子的阻力太大了,所以这时候我们需要加上个 积分环节 选出累计误差。时间越长累计误差的值就越大。可以想象一下一开始差了1°,控制时间是100Hz 的话 一秒钟之后就到了100°。相当可怕了 所以积分环节一定要加上限!!!而且积分的Ki要小一点!!
4 w* w3 T1 M& c) l
- M& ~( D# o- z- Y# b9 ?- F8 W

9 u4 [2 ]3 l: o% ?% J这样调试完成了 去空地上试一试,JEEEEEEEZ 四轴跟陀螺一样在地上转!  z" j. E5 E; H$ _; {9 q' n3 w. G  f6 `
没错 我们还需要最Z轴进行PID 和上面的调试方法差不多 只是我们只用到了Z轴的角速度D。 Z轴速度的积分想到与 角度P, Z轴角速度积分之后再积分。相当于I。% o/ E) v& a; B* H1 _; w
/ c+ _  Q8 ?/ ]
PID系统也要在定时器中断里面运行  控制周期指的就是这个!!!  速度可以降到100Hz或者50Hz!如果降低频率的话需要对PID的一些参数进行修改!!!!!!!
( {; N2 T' d! r. ?4 u
) w8 b$ d* h' R. Z) b
第五步 PID的调试  重中之重
$ K4 F  D3 p4 R: h: l  y0 e" \LZ对PID的调试也没什么经验,这东西全凭感觉! 而且需要和你的四轴有一定的情感,随心所动* S0 n! f3 S3 D% Y% p3 P
如果感觉自己的PID不稳定的话 可以使用串级PID  就是上面的到的PID输出的值 作为第二PD(没有I) 的P的输入量,然后微分D 这次需要把角速度进行一次微分,得到角加速度。 PWM_D_Y=(mpu.GY*500.0f)*PWM_KD_Y;  我程序里面写的*500 其实相当于/0.002; 然后在输出给电机。
  ^/ \; Z- m0 G: `- p- b) C& H
6 K# s( ]; q+ E8 u2 T$ S8 R: P9 U上图!上图!上图!" L/ a- |& }1 q" O3 V! R
P61123-105423.jpg ) u8 J* A4 O- }" ^  q

% q- k) v, F5 f$ W" P$ l$ T P61123-105429.jpg
9 v0 W5 Y; S- U5 q6 u! I; ^$ E, T! Z, B1 [+ [
P61123-105439.jpg 7 S. F. @- |1 l4 Q
' h' o: s0 i8 @, V) K! R1 X) h
里面带的那个ESP8266的是我之前想法的帖子 但是没发 这回把那个工程再贴上去吧
" t( C7 w3 R* i$ e- x2 ]仅仅只是点个灯 而且属于局域网的wifi 没连接外放 如果连接外网的话需要在网上租一个云服务。太麻烦了 而且还需要花钱 就没弄!. a0 [: F+ h; ~

" l7 m4 Z! K7 R2 f- V7 b Flight_Ctrl.rar (1.42 MB, 下载次数: 296)

评分

参与人数 1 ST金币 +10 收起 理由
zero99 + 10

查看全部评分

赞 收藏 5 评论45 发布时间:2016-10-21 14:29

举报

45个回答
Cortexxx 回答时间:2016-11-28 14:19:39
zmh169 发表于 2016-11-28 09:01
' X3 C/ X& p8 c7 Q门外汉,看热闹。飞控就是控制电调的中央控制单元吧,相当于汽车的ECU?

8 E2 w+ G9 k; ~! a4 r对 但是我对汽车电子不太了解。差不多就是个闭环控制 读取实时角度 反馈给单片机 然后根据角度 改变电机转速。 达到动态平衡。
Cortexxx 回答时间:2016-10-22 18:05:14
g921002 发表于 2016-10-22 14:24
& N$ I! ^* d0 x/ J6 V9 R0 @裡面有關ESP8266的代碼跟使用很棒,感謝!!
' w3 D6 O. F- e/ E1 O+ D. \' d+ W
  最开始玩了一下WiFi 然后就直接拿那个模板写的飞控了  
jackten 回答时间:2016-12-4 20:27:27
谢谢分享                 
zero99 回答时间:2016-10-21 15:54:31
谢谢分享
11:493 回答时间:2016-10-21 15:55:49
多谢分享。学习了。
车厘子 回答时间:2016-10-21 16:35:05
高二毛 回答时间:2016-10-21 17:31:06
感谢分享。
assssdz 回答时间:2016-10-21 22:24:22
:):):)
ynwscfsfi 回答时间:2016-10-22 00:14:39
感谢分享!
disheng4688 回答时间:2016-10-22 09:24:42
谢谢分享
黑皮男 回答时间:2016-10-22 10:39:19
多谢分享
andrewz 回答时间:2016-10-22 13:08:44
谢谢分享~
g921002 回答时间:2016-10-22 14:24:54
裡面有關ESP8266的代碼跟使用很棒,感謝!!
zbber 回答时间:2016-10-22 15:23:18
感谢分享
原田夜舞love 回答时间:2016-10-23 23:13:44
谢谢分享6 b  n8 q" f. V' T& _+ c
爝火燃回春浩浩 回答时间:2016-10-24 01:49:17
支持,太赞了。收藏了。
1234下一页

所属标签

相似技术帖

官网相关资源

关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
人形机器人运动控制、感知与智能配电
半导体创新技术与应用方向
EE架构与软件定义汽车
12V/48V 汽车智能配电(SPD)
区域控制单元(ZCU)与分区架构
关注我们
st-img 微信公众号
st-img 手机版