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

STM32控制舵机讲解

[复制链接]
STMCU小助手 发布时间:2022-8-15 19:00
前言" K, z3 w# I5 z2 g8 ~$ W  a' j8 [
我们这里拿STM32F103C8T6作为我们的芯片,通过PB9端口输出PWM,实现控制舵机。我们这里就拿180°的SG90舵机。
7 H. c2 L! |0 s* C: f* G
" V# f, ], Z0 @6 R, F一、PWM
7 H$ {# x; ]/ }3 W( f& {( ePWM是什么?
3 N2 y; Q; t/ A6 v6 }5 B) |PWM,英文名Pulse Width Modulation,是脉冲宽度调制缩写,它是通过对一系列脉冲的宽度进行调制,等效出所需要的波形(包含形状以及幅值),对模拟信号电平进行数字编码,也就是说通过调节占空比的变化来调节信号、能量等的变化,占空比就是指在一个周期内,信号处于高电平的时间占据整个信号周期的百分比,例如方波的占空比就是50%.8 J% o6 D# B; I( m+ X0 y/ {
5 q6 h  I# z' f1 A6 K/ h' b
STM32 的定时器除了 TIM6 和 7。其他的定时器都可以用来产生 PWM 输出。其中高级定时器 TIM1 和 TIM8 可以同时产生多达 7 路的 PWM 输出。而通用定时器也能同时产生多达 4路的 PWM 输出,这样, STM32 最多可以同时产生 30 路 PWM 输出!这里我们仅利用 TIM4的 CH4产生一路 PWM 输出。
$ p9 t3 d! }: r  r( G OV~}T{JL4HCU$%6LP2`{685.png
( v- L& L2 c! b; @, P3 Q& n
  E6 }6 g! v  I* i0 HPWM的频率: 是指1秒钟内信号从高电平到低电平再回到高电平的次数(一个周期);. K5 K7 P$ C& ]
也就是说一秒钟PWM有多少个周期
; C; h6 Q' Q$ u) F- F' w' M2 r6 W+ I0 ^+ P/ g
单位: Hz
3 i. F& S' Q" }7 G4 Q* H) {" ]: Y# z! \' q
表示方式: 50Hz 100Hz6 S' u3 e5 W0 l0 [- ]2 @8 b

% v, L" N$ E1 r4 T9 R! X$ RPWM的周期:% Y( b1 r  p# Y5 r9 s: Q5 n  u
3 `  w3 w; b6 E/ t$ y
T=1/f
, S0 c( o' t( \/ V# g* D
& z& ~0 T) w6 n9 r, p& s4 N周期=1/频率" t" y1 [5 j" _, c2 C

# O1 O2 U1 W+ M; ~50Hz = 20ms 一个周期1 j: z* I6 G; ~& i4 c- F

" @0 o. S8 h! l" b2 }" c4 w' B如果频率为50Hz ,也就是说一个周期是20ms 那么一秒钟就有 50次PWM周期
7 F! U0 ]' R5 {PWM占空比: 是指在一个周期内,信号处于高电平的时间占据整个信号周期的百分比,由于PWM周期为20ms,所以(以舵机会转动 45°为例),占空比就应该为1ms/20ms = 5%,所以TIM_SetCompare1的 TIMx 捕获比较 1 寄存器值就为200-200*5% = 190" G9 `& o3 r1 _- T; r
9 r8 K" F9 V( {. _% t1 X4 \
单位: % (0%-100%). ^+ \. F2 s  \
5 e+ E8 F7 d1 `2 `$ J
表示方式:20%
" q9 M$ D1 x0 }- h# Z; ], u  n1 k8 o
如何实现PWM信号输出?9 r# T6 c1 c* b/ g# `0 K, Y' F
<1> 可以直接通过芯片内部模块输出PWM信号,前提是这个I/O口要有集成模块,只需要简单几步操作即可,这种自带有PWM输出的功能模块在程序设计更简便,同时数据更精确。如下图,一般的IC口都会标明这个是否是PWM口;4 r" @' T1 O7 j
# S9 T& m& e( W) t1 N
aHR0cHM6Ly9zczEuYmFpZHUuY29tLzZPTlhzamlwMFFJWjh0eWhucS9pdC91PTQxOTg4NzAyODUsMzcw.jpg
3 }! q0 a2 }8 Q2 |+ V% M
3 M' R- B* B7 R& E<2> 但是如果IC内部没有PWM功能模块,或者要求不是很高的话可以利用I/O口设置一些参数来输出PWM信号,因为PWM 信号其实就是一高一低的一系列电平组合在一起。具体方法是给I/O加一个定时器,对于你要求输出的PWM信号频率与你的定时器一致,用定时器中断来计数,但是这种方法一般不采用,除非对于精度、频率等要求不是很高可以这样实现。) l  i8 _0 w; R4 o; X: @

# R$ `- a& F/ S/ ]4 p" }二、舵机( k$ ~! [; z+ F5 y0 U
什么是舵机?9 Y' n8 Z5 n' E- y3 g
舵机也叫也叫 RC 伺服器,通常用于机器人项目,也可以在遥控汽车,飞机等航模中找到它们。) [9 {, ~$ \' S7 ~
类似舵机这样的伺服系统通常由小型电动机,电位计,嵌入式控制系统和变速箱组成。5 s; z3 P8 R9 A: v
电机输出轴的位置由内部电位计不断采样测量,并与微控制器(例如STM32,Arduino)设置的目标位置进行比较;
% d# }1 ]" ~' e) G  p根据相应的偏差,控制设备会调整电机输出轴的实际位置,使其与目标位置匹配。这样就形成了闭环控制系统。4 _4 B6 a- P( E/ W& g

0 B" l8 ?# {: g6 n 3M3QQQ6OO4V_FOCV7AOEY~0.png
4 S( ]2 a- r2 x0 Q0 H  m" s3 k$ @+ C# Q  A" \9 X' a
控制原理
1 R' F% H8 B0 L) T* f5 ~通过向舵机的信号信号线发送PWM信号来控制舵机的输出量;
7 I1 v, d/ o( @  k  E: |1 X! Q3 s" H/ v" P9 z
一般来说,PWM的周期以及占空比,我们是可控的,所以PWM脉冲的占空比直接决定了输出轴的位置。
  S- O: W5 @( N  X; ]+ A% W' E# t! _. r. l( ]" S# Z
下面举个例子;9 E" P4 [7 B7 t$ \$ e1 _3 \+ e3 q
7 N: t8 K% |! W
当我们向舵机发送脉冲宽度为1.5毫秒(ms)的信号时,舵机的输出轴将移至中间位置(90度);
. g: s, E7 w$ }# F% D( l
/ D7 _8 }  S" ]0 _脉冲宽度为1ms时,舵机的输出轴将移至最小的位置(0度);. o  Q, l, a; o4 h: @3 d' q% a

8 z2 W% g9 V: p0 r* ~脉冲宽度为2ms时,舵机的输出轴将移至最小的位置(180度);& Q; G" F1 c; n8 v) E/ O8 f

- `4 c4 ?8 j% S7 |; g& d注意:不同类型和品牌的伺服电机之间最大位置和最小位置的角度可能会不同。许多伺服器仅旋转约170度(或者只有90度),但宽度为1.5 ms的伺服脉冲通常会将伺服设置为中间位置(通常是指定全范围的一半);
* z* X' `8 D# O5 f" j" Q. r) j$ u: r
具体可以参考下图;
; P1 Y7 f% m" i' S# \4 J$ v. B( y% Z6 T0 U  N2 |* e6 p
20200128155221315.gif
1 v7 w/ X2 M4 y3 \# S- ~# U) W$ b8 K9 T6 W' @* p
占空比 = t / T 相关参数如下:
3 P8 Y7 Y$ f& h4 y" n: c+ ]! x5 E! {+ S7 {& w$ x: j
t = 0.5ms——————-舵机会转到 0 °! G* R9 m, |- [& M
t = 1.0ms——————-舵机会转到 45°
  S( N; g+ a& H6 ^3 O3 X# [* }+ [t = 1.5ms——————-舵机会转到 90°- K& W  h& s# d) h; c" L1 C1 I
t = 2.0ms——————-舵机会转到 135°0 ?3 o/ w1 U3 W/ e0 n
t = 2.5ms——————-舵机会转到 180°
9 B! Q, b" F4 }, H3 P8 R
% \1 x9 ~( q$ Y因为:PWM周期为20ms = (7200*200)/72000000=0.02
+ I+ z7 _! U1 X& I1 C! l所以:TIM_Period = 199,TIM_Prescaler = 7199,就是我的程序入口参数
# \. ^6 y8 I" ^8 c
( L/ K  n& c$ R, g7 t参考代码9 C* |& t* \1 S8 n. v6 B
编写步骤:) Y# a- H9 ]% x# L# l  o' \2 K: U6 r% F

3 }/ }4 u; v! n5 J' S<1>开启 TIM4 ,GPIOB时钟,配置 PB9 为复用输出。
  1. RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE); //使能定时器 4 时钟1 g, i0 I! f# O
  2. RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO|RCC_APB2Periph_GPIOB, ENABLE); //复用时钟使能
复制代码
7 H! i0 n4 E# i( [/ L
<2>初始化 TIM4,设置 TIM4 的 ARR 和 PSC。  y8 K+ C' L& V+ `- @8 G1 s
8 j' V6 Y4 w$ s  z  T; j, X
  1. TIM_TimeBaseStructure.TIM_Period = arr; //设置自动重装载值' O* k9 _- T$ z) @
  2. TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置预分频值' ]! @' w$ Q# g
  3. TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim: L' ?5 K& q1 P6 ?% i
  4. TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //向上计数模式2 S9 F: }5 |9 O0 A
  5. TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure); //根据指定的参数初始化 TIMx 的
复制代码

; L/ y  |" ~) ?. @' z) @0 A1 C<3>设置 TIM4_CH4的 PWM 模式,使能 TIM4 的 CH4 输出。" r$ Q3 ^7 A5 I6 w5 V

8 a# a1 z1 o7 ?5 S, n  u
  1. void TIM_OC4Init(TIM_TypeDef* TIMx, TIM_OCInitTypeDef* TIM_OCInitStruct);
复制代码
7 E: y/ Q; q8 g1 I! F
看看结构体 TIM_OCInitTypeDef的定义:
& Q+ g4 ~/ u' S0 Q; h2 s1 O/ E) g3 l2 z- v8 d: i! B1 s
  1. typedef struct
    7 N, l% ~6 ~+ U2 h( ~
  2. {
    / Z, A) g8 p. A9 x4 Z' ^9 [4 H
  3.         uint16_t TIM_OCMode;
    4 C7 Z* e9 N. g7 d
  4.         uint16_t TIM_OutputState;
    & U8 J' k7 s8 T. b' Y: s4 ^* F
  5.         uint16_t TIM_OutputNState;
    + H) q9 z+ E# K9 T$ v7 X( G7 L
  6.         uint16_t TIM_Pulse;
    : B7 _% J4 z2 m, l8 Y
  7.         uint16_t TIM_OCPolarity;
    ( l* `" @7 p% U  e
  8.         uint16_t TIM_OCNPolarity;4 V  o6 F! i$ Z! q$ L4 L
  9.         uint16_t TIM_OCIdleState;
      O3 i7 E* q: v  J5 ~) D. Y! @- o- G
  10.         uint16_t TIM_OCNIdleState;
    4 Y; A$ Y4 ~& W7 c" ~
  11. } TIM_OCInitTypeDef;
复制代码

. |  C9 K5 B; O1 i我们来看看里面的参数:
. h  K7 J& ?9 v; Y! A6 {6 X+ q: T: A$ H3 _2 p3 l, q
参数 TIM_OCMode 设置模式是 PWM 还是输出比较,这里我们是 PWM 模式。
. z( r0 @7 U( i2 W- s参数 TIM_OutputState 用来设置比较输出使能,也就是使能 PWM 输出到端口。
, d- H, F& K( g6 S% c参数 TIM_OCPolarity 用来设置极性是高还是低。# V9 M/ G- d1 v- k3 T8 k
其他的参数 TIM_OutputNState, TIM_OCNPolarity, TIM_OCIdleState 和 TIM_OCNIdleState 是$ p% |' X0 W8 R* D& K  c5 C
高级定时器 TIM1 和 TIM8 才用到的。" S2 d- R  ^4 \. G" P5 J6 e4 D

* D  X( ?( P9 U' i配置如下:
1 A' q9 f4 K3 J$ {, [, P
/ p4 n0 t0 V1 ^
  1. TIM_OCInitTypeDef TIM_OCInitStructure;6 ?+ {3 w" V8 Z& Q' M
  2. TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2; //选择 PWM 模式 2' S. k- o: V; B3 F1 M5 G, x' ?6 r
  3. TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //比较输出使能
    8 m! _. p2 e" c+ |5 Q$ z- r3 Z
  4. TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; //输出极性高
    - w; k5 V9 ?( V" M" W0 ?; O
  5. TIM_OC4Init(TIM4, &TIM_OCInitStructure); //初始化 TIM4 OC4
复制代码
: `5 `! {; s5 b2 ^& S! b, h
<4>使能 TIM4。6 f% N9 s& k" _

+ N, P4 s' r/ I2 b
  1. TIM_OC4PreloadConfig(TIM4, TIM_OCPreload_Enable);
    - w$ M! Y9 i  t: v9 t
  2. TIM_Cmd(TIM4, ENABLE); //使能 TIM4
复制代码
. n% g; B+ l. x& l4 I7 {
<5>修改 TIM4_CCR4 来控制占空比。4 h: ]2 P3 ~$ Q1 ^! y

0 y- L0 f7 j7 Y+ P# K
  1. void TIM_SetCompare4(TIM_TypeDef* TIMx, uint16_t Compare4);
复制代码

. P# T& r6 D3 S. \. T最终代码段:/ ]. H% E5 B6 z. t
, }+ ~5 {" q  O1 @) d5 n8 E
  1. //time.c) u: v: n& A% \' [7 N- J4 e
  2. #include "time.h"
    : \6 {8 r% r* {4 V' B- t' {7 R6 C  O
  3. #include "stm32f10x.h"
    " u" \$ i/ k: T4 U2 u" C/ C( g4 W5 V
  4. #include "sys.h"1 T$ q  R8 c2 l# u; z  {, {( F) \
  5. 5 u( I& Y% K( t. b
  6. void TIM4_PWM_Init(u16 arr,u16 psc)! t! p  `. `2 ]
  7. {; ~/ k5 |; V2 u6 Q0 I! J
  8.         GPIO_InitTypeDef GPIO_InitStrue;# X9 V9 i. |1 I, Z8 V0 L, x, ~  p" q
  9.         TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
    + R' b2 b# q. W, ?# }) N. ]
  10.         TIM_OCInitTypeDef TIM_OCInitStructure;
    0 y# @) [( j5 j2 \# o
  11.         : _; F* y) X' f* G( u4 |  G6 I
  12.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB|RCC_APB2Periph_AFIO,ENABLE);
    7 w6 i/ u$ n, u' }3 T  ~
  13.         RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);' P! s$ N$ n8 [* \+ J  \

  14. 5 u9 j" G; K  G5 d% t
  15.         GPIO_InitStrue.GPIO_Mode=GPIO_Mode_AF_PP;
    % y2 I& Z* L8 R% y7 C, e1 O
  16.         GPIO_InitStrue.GPIO_Pin=GPIO_Pin_9;
    . o! ]" T- F+ P) {" W: J
  17.         GPIO_InitStrue.GPIO_Speed=GPIO_Speed_50MHz;# t& `0 o9 ?- W
  18.         GPIO_Init(GPIOB,&GPIO_InitStrue);1 n. i- V- A7 v
  19.         
    2 U  f8 H- F7 c0 X
  20.         TIM_TimeBaseStructure.TIM_Period = arr;
    8 M: z  d, M3 `( P1 ~- B
  21.         TIM_TimeBaseStructure.TIM_Prescaler =psc;
    1 Q& O( n0 O6 O% h# _# ~$ S
  22.         TIM_TimeBaseStructure.TIM_ClockDivision = 0; 8 u! @& m, ]# z8 T
  23.         TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; & x, R) P9 x; |0 W! d
  24.         TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure); 3 m# p: M. e: q4 C: ?
  25.         
    ( J" K8 \4 F# i0 W4 z
  26.         TIM_OCInitStructure.TIM_OCMode=TIM_OCMode_PWM2;; K) ~4 s2 f/ I. U+ V' s$ i$ x
  27.         TIM_OCInitStructure.TIM_OCPolarity=TIM_OCPolarity_High; # z: C6 @, `# ?5 E1 d& C  b
  28.         TIM_OCInitStructure.TIM_OutputState=TIM_OutputState_Enable;
    : Q5 Q) e3 e% E
  29.         TIM_OC4Init(TIM4,&TIM_OCInitStructure);% l6 X& Q+ J* F  F) j- H; X7 V, j; ~
  30.         
    3 L* T, s$ A9 c& q% R! V7 C
  31.         TIM_OC4PreloadConfig(TIM4, TIM_OCPreload_Enable);8 K+ Y; D" z7 m! w
  32.         TIM_Cmd(TIM4,ENABLE);1 l% o6 y6 w& j1 {2 I
  33. }
复制代码

( _4 B, S5 B# P) @下面就是主函数的代码:% n- _  V/ K9 }

2 P; r. E" b  v  F' v5 r
  1. //main.c
    7 p7 a' N: |* E
  2. #include "stm32f10x.h"
    - |. a- [+ {5 N* L5 w
  3. #include "time.h"1 b! U, z& w. P1 O  c  V% S" L, N
  4. #include "sys.h"( F  f% \$ O% \/ c! H/ A& U
  5. #include "usart.h"6 ^$ d; Q5 n+ J- P
  6. #include "delay.h"$ p; g- A( t- P* k
  7. 7 q2 }% y% W  a- ~' i% c
  8. int main(void)
    . Y+ c- {4 ^: \& F: _+ n9 k% N
  9. {" O9 D9 T2 \7 }1 Z& t( h: F
  10.         delay_init();) c) r2 X; _3 ~1 {
  11.         TIM4_PWM_Init(199,7199);
    : Z! H% [- E3 x* O9 }
  12.   while (1)
    ; a( {/ l+ ~- L1 s# v1 O" U
  13. {
    5 _- l0 F$ L5 m- h9 ^' S+ G) v
  14.          
    1 M: P( q( y) B9 U
  15.                 delay_ms(10);
      a% u6 ]* R' Y2 J4 I% J2 ]
  16.          
    ; V. W2 ~/ O6 U# W5 Z6 S! @  k
  17.                 TIM_SetCompare4(TIM4,190);) x/ u- d' V/ W
  18.         
    * V* W( p$ f, H* d
  19. }
    ) J# ~/ g, \/ @
  20. }% u) N2 ]1 ]7 ]' n
复制代码

3 T( C* X9 ~. k; U" o: j; k1 T# ?2 u, z- \; v$ y# B' v& i% m6 s2 f. j
1 `9 f# p6 O9 \: j2 I' ^; R+ q$ {

1 T# i% F* J% R. D+ E& A7 O4 s; Q
4 |1 z& }8 ~) |
收藏 评论0 发布时间:2022-8-15 19:00

举报

0个回答

所属标签

相似分享

官网相关资源

关于
我们是谁
投资者关系
意法半导体可持续发展举措
创新与技术
意法半导体官网
联系我们
联系ST分支机构
寻找销售人员和分销渠道
社区
媒体中心
活动与培训
隐私策略
隐私策略
Cookies管理
行使您的权利
官方最新发布
STM32N6 AI生态系统
STM32MCU,MPU高性能GUI
ST ACEPACK电源模块
意法半导体生物传感器
STM32Cube扩展软件包
关注我们
st-img 微信公众号
st-img 手机版