STM32平衡小车大家应该见到过很多了,作为学生或者DIY爱好者做一辆小型的mini平衡小车还是可以实现的。给大家带来博主老倪制作的迷你的平衡自行车项目,相信我们能从中学到一些新东西。在本文将会介绍平衡自行车的具体制作过程,包括机械、电路和代码。; M6 u D" t; t* f$ d! t , E' X+ D x$ H) F6 C1 M9 F) Z 文末点击阅读原文,可以获取平衡自行车完整的代码。下图是本项目要说的简易mini版平衡小车。$ Z: a m4 q' `- l o( k 自行车平衡理论( N4 r: w. h8 ~- x( [- g 模型分析( _, `2 D8 m& R O) y! |& m 1 倒立摆, X$ a; V: d C* e 5 C! E, I6 X5 q( L 很显然我们知道自行车在左右方向上不稳定,这是一个很常见的物理模型——倒立摆。, W& k7 m8 _& g( L 顾名思义,倒立摆的意思就是倒着的摆,比如一个倒着的杆, % y% R5 a- C3 x$ b1 O$ B* c9 h & v5 y3 x% \9 v, ^- B' [* M9 U 3 s0 D8 L# V8 n7 |1 r/ H 倒立摆的特性:不稳定,只要偏离平衡位置,就会有一个力(重力的分力)使系统更加偏离平衡位置,这样偏差就会越来越大。- N0 }5 I) `; r% J+ q! u: Z) Q * E% o( c W) v3 D- @ 一般倒立的杆在前后左右方向都有可能倒下,在二维的平面上不稳定;而自行车仅在左右方向上可能倒下,是一维的倒立摆,这要简单一些。2 d4 r0 E$ f4 L 以下是几个生活中常见的倒立摆例子:; A# J$ T% L$ |. l. ]& h / j1 k, j! m# \" S # S6 g9 ~$ |0 f+ i5 k3 { / T- R2 J. i' ?( S! n 2 自行车的平衡控制 自行车属于倒立摆模型,倒立摆是不稳定的,那么倒立摆应该如何控制才能平衡呢?1 X& o3 V8 M% X* m7 f& `1 d( W1 O0 E 我们把问题拆分一下:; s) y( {# q) c: L; I, o9 | * 怎样的状态才叫平衡? * 我们能控制的是什么?5 X, V# i2 L2 K; E' Z/ \/ ?. ~( J6 y * 如何控制才能稳定平衡? 2.1 怎样的状态才叫平衡 我们要对”平衡”进行数学描述,所谓的平衡其实就是倒立摆的倾角稳定在一个我们想要的值。 i0 a& N4 ~. l2 U. x' f 通常我们想要平衡在θ = 0处。" h& M4 w9 }9 p, @( o: \% A 5 @2 n: K: }- A6 b0 _( t 2.2 我们能控制的是什么7 k+ i9 e9 S0 a: s8 S( b3 L' P ) j& ]; v+ f+ m% H' B, j4 v 对于倒立摆模型,通常我们能控制的是底端的力或速度或位置,不同的控制量对应的控制方法不同。5 _+ s& o1 F8 D v- j 对于自行车来说,它的控制方式不像通常的倒立摆那样直接控制底部,而是间接地通过转向来控制,当自行车以一个固定的速度前进时,自行车把手以一定角度进行转向(设为α),自行车会做相应半径的圆周运动,产生相应大小的”离心力”。4 t3 x( G; a$ W3 M7 N* L. Z5 s 在自行车这个费惯性系里看来,只要对把手进行一定角度的转向(α),就会产生一个相应大小的横向力:; V+ n4 h$ q' m5 ? ! s$ R( W. l+ P* s( U 这就是我们进行平衡控制时的实际控制量——把手转角α,只要控制它就能控制回复力。 W. `6 S# W5 p, ^, ^) p* x 2.3 如何控制才能平衡 上面我们已经能够通过转向产生回复力,这个回复力可以把倒立摆”掰回”平衡位置,有往回掰的回复力就能稳定平衡了吗? 并不是这样,我们再来回顾一下中学物理:" p; B& a8 c) D2 ] “过阻尼状态的摆会以较慢的速度回到平衡位置;欠阻尼状态的摆会很快回到平衡位置,但会在平衡位置来回摆动;临界阻尼状态的摆会以最快的速度稳定在平衡位置。”1 k8 P' _6 ?' d7 } 结合到实际的自行车平衡中就是:0 b1 v* }9 J/ ^# _6 _' q+ \ >“如果恢复力不够大,就无法矫正,或者矫正速度很慢,这会导致系统不稳定;如果回复力过大,就会导致矫正过度,这也会导致系统不稳定;我们最希望的状态就是回复力刚刚好,刚好使倒立摆快速回到平衡位置,又不至于矫正过度。 ” 这是一个复杂的数学计算过程,回复力大小会在系统运行时不断地计算(本平衡自行车是20ms计算一次),用到的是PID算法,会在后面详细介绍。9 x# A _' e, L 8 x& I) d( r- \6 i9 Q 3 自行车平衡需要解决的基本问题/ J1 f% y0 B W. D7 Z: W * 获取左右方向倾角θ * 以合适的算法控制转角α使系统稳定平衡2 ^* f3 F1 K H8 ]5 N! g 7 `( D% \4 U R 这将会在下面详细讨论。$ p+ c& ?# d: F) R9 W! j ; T6 g( @3 g* G0 f! H& \0 K 姿态检测; V7 `1 ]3 h( {- {4 m0 q ' y' d: y; S2 u& a$ _ 1 检测的是什么1 s5 |6 m2 j" m* V* ? 检测的是自行车左右倾斜的角度。% U8 i% R- j& m8 ` ) R4 b3 n' p, p" R# T @: k 9 F$ d$ p- o' M 2 怎么检测" x9 j$ d$ M5 C1 [6 Q* ]+ j, y 用一个叫gy521的模块,里面用的是mpu6050芯片,带有陀螺仪和加速度传感器。 gy521的具体使用会在第三篇-实践篇介绍,这里我们知道通过这个模块我们可以得到自行车各个方向的加速度和角速度。注意哦,我们不能直接得到倾斜角度,我们的到的是各个方向的加速度和角速度,需要进行一些复杂的计算才能得到正确的倾斜角度。 常用的算法有互补平衡滤波、卡尔曼滤波。1 K/ c/ J- M$ j- Z) y6 V8 U ) o* z, s9 r0 u0 P( x PID算法4 A" s+ L K; l/ }7 w5 g+ T3 d 前面已经分析了,我们通过控制把手转角来控制回复力,我们需要实时计算一个合适的回复力使系统稳定平衡。* O8 K8 T) Q% x/ L' C 6 t5 d) \3 U. j. T 有一个小球在光滑球面上,小球的位置是x,光滑球面顶端在L处,我们可以控制小球水平方向力F,现在要求让小球稳定平衡在x0处。3 e& M. b2 W6 B. u# I% Y' n4 N; d' s 先看简单情况x0=L,此时偏差为L-x, 2 Y& w. R! \& L! ?5 ^* R& U n) A0 y 我们给出一个比例项(P) F = kp*(L-x),这样就会有一个回复力,当偏差存在时就会有一个力把小球拉回L处。* f2 Z# {. a: x0 X6 q. e/ {5 ~* H$ _ ! C5 R [6 p: `# W- Q 这存在的问题是,小球接近L时是会有一定速度的,小球越来越接近L,此时的力仍然是在把小球往L处拉,这会导致小球到达L时(我们想要的位置)速度很大,小球无法立刻停下来,而是会冲过去。 ( P7 f* H! B) l! h0 w! k) _9 p) K$ R' J, N 这样小球就会在L附近来回摆动,这是不稳定的状态,属于欠阻尼状态。 6 s7 H* y. R; _0 Y: G' o. C& T 为了解决上述问题需要加一个微分项(D) F = kd*dx/dt = kd*v,所谓”微分”指的是位置x对时间的微分,说白了就是速度。 % S5 I" G- c4 x5 R" K 意思就是当速度越大,就产生一个反向的力使速度减小,这样就可以防止出现上面小球冲过去的。+ d: D1 e# [5 M- q 可以认为这一项具有”预测”功能,预测小球下一时刻的状态从而提前做出反应,预测小球将要到达L处,提前减速。% u; ]0 ^' Q$ q $ q. S- R' d" O7 ~! p7 w, X5 u 也可以认为这一项具有阻尼作用,相当于系统中有一个和速度成比例的阻尼力。 这个”阻尼力”调得过小会导致欠阻尼状态,调得过大会导致过阻尼状态。& r0 m: B8 _$ k! {7 |+ \5 ? 8 |5 G+ S# u% ]9 a$ a# J6 r) k 积分项此时可以不用,积分项是当平衡位置x0不等于L时使用的, 当平衡位置不是L处,那么当小球静止在平衡位置x0时,由于在坡道上会有一个恒定的横向偏移力,此时比例调节作用为0(Δx=0),微分调节作用也是0(v=0),所以小球在该处无法平衡,会在更远离平衡位置处达到平衡,那么就会有一个长时间存在的偏差。 积分作用就是检测偏差进行累积,对于上面这个长时间存在的偏差进行积分(累积叠加),使系统在长时间范围可以稳定在要求的平衡位置。 - a& a( n7 b6 q& K& w 平衡自行车-实践篇2 u- b1 E6 f9 e, r) V 在本文将会介绍平衡自行车的具体制作过程,包括机械、电路和代码。 / b) |! B m7 D6 u d# S* D" Y 材料 a, h7 U" ~3 y$ t( D; \9 K% l9 D! Y 机械' n" W2 G q% W8 U5 x/ h, ? 电路 3 o7 {9 ^& p. G8 X 动力部分; C0 U+ f# h U% V) P# j 传动方式0 ~/ a/ l" P: C, }2 s6 L 如图,我用的是皮带或者齿轮传送的方式,因为比较好实现。, b: Z0 ]; @& U# {" D/ A1 _' T6 q; L 8 w0 A: N7 w3 u0 d3 h- | 电机选择6 n$ ~8 { J: y9 n9 G 这个DIY是不考虑变速情况的,平衡的参数都是按照一个固定速度调的。 所以动力部分的作用就是提供一个恒定的速度,并且这个速度尽可能稳定,尽可能不受外部影响。" T5 B% s, K. P) b0 y - Q5 E+ x1 G |7 R* `1 V 电机应选择扭力大一些、转速稳定的减速电机。- e: G& a/ e7 ~1 p2 T 6 k( a) [ ]( z# \ 电机供电 : b2 Y/ u! ]8 k9 b 电机是直接供电还是使用升压模块供电要根据电机特性,有些电机用升压模块可以提高功率,有些大电流电机用升压模块反而可能限制了电流。4 p( ~: Y' o! T) O% @ w % g5 m, d3 U' A" M$ G" z 我这里用升压模块升到12v给N20电机供电的。3 b5 \0 y& x, Z- Q b & }# e! O/ q; ?, q4 j7 d, J2 ?& n2 I * a9 E' H" i1 S$ d. m0 l# [ 另外,电机通过三极管受stm32控制,通过控制占空比也可以限制电机输出的功率。 转向部分- X2 D+ v, k& q6 R ( F7 A1 _& _/ ]/ I$ w6 e 转向部分用一个舵机带动把手转动即可。 电路 在GitHub工程里有详细的引脚连接表 " z! q' Y; b2 d- S% K! j& w" }% L5 \7 {/ j0 K; M9 I9 g 供电# F! Z0 F+ U6 I, T * 用3.3v稳压芯片给整个控制系统供电,包括单片机、GY521模块、蓝牙模块。3 B* r( D8 I" f/ z K$ I* T * 用5v稳压芯片给舵机供电。; e9 _1 K$ R! W6 e4 k * 用12v升压模块给电机供电。 % H1 p \1 V0 o 下载; f* Y' q& ^; P* ~' s. X! g8 O; ~ 我是用串口给stm32下载程序的。. w& i; @& j: j . y. u: m1 ]) P: @7 R F6 l GY521$ ^3 p e' ^( n$ e . R8 w- V, ]; r! } 这个模块通过i2c通信,只需要连接4根线。8 V4 k1 @; X8 [6 p * 3.3v * GND * PB0 GY521 I2C SCL; D* v6 n2 e$ |) v9 ] * PB1 GY521 I2C SDA (用的是IO模拟i2c) 电机 点击用12v升压模块供电,由于不需要反转,用三极管即可直接驱动,电路图如下: , U5 p7 D' F- q( y$ S 8 V! e! }. T3 I 加三极管的目的是为了可以通过调节PWM占空比来限制输出功率,但我的实际情况是100%输出时动力才勉强足够。所以如果你不需要限制电机输出功率,或者通过其他方式限制输出功率,也可以不要三极管,不通过单片机控制。- M- U2 _0 k, `1 m( H0 O 2 B, a4 Y5 }0 W8 |1 d 舵机( L7 \5 W6 m, h; p: ]( Q, { $ m; X3 g7 U2 A4 J8 Q! p% i 舵机是用5v供电的,而单片机是3.3v电平,对于[PWM]控制脚可以通过2个三极管实现同相的电平转换: # D! \- B- v' G- |4 X: @ 2 u6 b. V" Y( c/ e4 Q/ ] 蓝牙模块5 |- g2 f) r# s S% x' K 下图是我使用的蓝牙串口模块,可以实现串口透传,只需要4根线连接:vcc、gnd、txd、rxd。 蓝牙模块是用来调试和遥控的,没有它也能跑。建议还是加上这个模块,在调试PID擦数时会非常方便。) g0 j2 `$ l. m! L. Q * M. A" ~- Z& u2 O+ @ 代码结构7 R/ O) u& t O 代码提交在GitHub,点击阅读原文直达。 主要分为3个部分: * 基础的驱动程序,实现电机、舵机、gy521数据读取;# d& U6 V5 J+ t2 @& S * 平衡控制系统,核心是一个20ms定时器,每20ms进行一次数据采集、计算和响应; * 遥控和调试系统,实现log输出、接收遥控信息。. h" i! p! l6 e3 S* ~ # j1 f Q) c. S. }1 f: H9 o# J . r" G& K' D" @: ~5 F { 平衡控制5 z0 B3 H; f1 a% h: h: y 2 G( c$ I! \% q" Y. y, r; {3 p5 c8 o; E main函数会初始化一个定时器20ms中断一次,调用 main/balance.c 里的 balance_tick 函数,平衡算法在 main/balance.c 实现。2 Q8 }( u. }0 }2 i , P/ @$ e( [0 P5 k 每20ms到来会执行一次:: \$ j3 S; _. L * 读取传感器加速度和角速度信息。 * 互补平衡滤波计算当前姿态。 s1 ~+ B% J/ @ I& v * 用PID算法计算出前轮转角。 遥控和调试 两部分:状态输出和指令接收。 . l8 m: G5 ]0 ?" Z/ R' I3 } 状态输出 ! X% }8 k( Z4 h/ b; N0 q 在main函数的while循环里,利用串口中断构建一个简单的界面显示状态。 , N9 B1 X {" h& o 2 x8 S- T$ u) t$ g. d6 j 指令接收 串口接收到的数据会传给main/control.c,该文件分析串口数据,解释成相应的操作。主要是PID参数调节。4 ~) J1 h% ?' F8 I( m |