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

(转载)STM32编码器速度和方向检测,371电机方向与速度检测

[复制链接]
nyszx 发布时间:2017-12-26 19:42
                        

原文:编码器速度和方向检测,371电机方向与速度检测,stm32编码器接口模式

转载链接:http://www.yfrobot.com/thread-2411-1-1.html

出处:yfrobot论坛
! c& ?. z% ?$ p- g  z" v3 ]$ z: d

作者:aosini3 C: y9 ?" X3 v* M/ C. ?- P* \

编码器是什么玩意呢,它可是一个好玩的东西,做小车测速必不可少的玩意,下面,我将从编码器的原理讲起,一直到用stm32的编码器接口模式,测出电机转速与方向。

1.编码器

1.gif
图1 编码器示意图
      图1为编码器的示意图,中间是一个带光栅的码盘,光通过光栅,接收管接收到高电平,没通过,接收到低电平。电机旋转一圈,码盘上有多少光栅,接受管就会接收多少个高电平。371电机中的码盘就是这样的,他是334线码盘,具有较高的测速精度,也就是电机转一圈输出334个脉冲,芯片上已集成了脉冲整形触发电路,输出的是矩形波,直接接单片机IO就OK。        
( q3 s8 F. e! h     增量式旋转编码器通过内部两个光敏接受管转化其角度码盘的时序和相位关系,得到其角度码盘角度位移量增加(正方向)或减少(负方向)。下图为编码器的原理图:

# X5 q, o) y- S8 i' i8 N
2.jpg
图2 增量式旋转编码器

A,B两点对应两个光敏接受管,A,B两点间距为 S2 ,码盘的光栅间距分别为S0和S1。S0+S1的距离是S2的四倍。这样保证了A,B波形相位相差90度。旋转的反向不同,锯齿波A,B先到达高电平的顺序就会不同,如上图左侧所示,顺序的不同,就可以得到旋转的方向。

2.stm32编码器接口模式(寄存器)
! Q: B4 b, \/ L2 S5 Q( ~        stm32的编码器接口模式在STM32中文参考手册中有详细的说明,在手册273页,14.3.12节。程序是完全按照 下图方式,设置寄存器的。
  p! i  F4 ^- N) b. @      
5 c# o  S' _6 |- P
       3.jpg
图3
         从图3中可以看出,TI1波形先于TI2波形90°时,每遇到一个边沿变化是,计数器加1(可以通过寄存器设置加减),可以看出一个光栅,被计数了4次。TI1波形后于TI2波形90°时 ,每遇到一次边沿变化,计数器减1。1 v  {0 G3 }. Y$ Z' h% V
[color=rgb(51,102,153) !important]
0 Z& Z% c# Z0 p, C' I- m
  1. //TIM2_Encoder_Init,Tim2_CH1(PA0);Tim2_CH2(PA1)
    - T: g. f3 b3 u3 @: R1 K. n; q2 l
  2.     //arr:自动重装值 0XFFFF3 j; U, c$ d0 u( {
  3.     //psc:时钟预分频数        ,不分频
    % ]5 X8 b; P, ^5 l& B/ q
  4.     void TIM2_Encoder_Init(u16 arr,u16 psc)
    $ F" r/ s; Y; q
  5.     {
    ' G: C, Y3 u' I: H. A* T
  6.         RCC->APB1ENR|=1<<0;       //TIM2时钟使能
    " J4 L3 s$ L8 V( N7 t. Y
  7.             RCC->APB2ENR|=1<<2;       //使能PORTA时钟
    ( [" |  a6 r7 e. e! l( {" c  \
  8.             
    7 O/ e* X* b- `+ A0 B2 ]
  9.         GPIOA->CRL&=0XFFFFFF00;   //PA0、PA1 清除之前设置( L  o! n' a3 {% R( A
  10.         GPIOA->CRL|=0X00000044;   //PA0、PA1 浮空输入! r; S+ q& g0 k8 `0 f
  11.                
    . r& T- P$ Y) \* d$ ~) m, A/ N
  12.         TIM2->ARR=arr;            //设定计数器自动重装值
    % Y- a& o' r. s+ f0 m  K/ h
  13.         TIM2->PSC=psc;            //预分频器% u6 X" O; i3 m4 G
  14. / ~1 O3 e/ w& m& q- J
  15.             TIM2->CCMR1 |= 1<<0;          //输入模式,IC1FP1映射到TI1上
    7 J9 a/ Y  C8 B5 w# a
  16.             TIM2->CCMR1 |= 1<<8;          //输入模式,IC2FP2映射到TI2上  N- x3 g) d! n
  17.             TIM2->CCER |= 0<<1;                  //IC1不反向
    # ?1 c5 A7 @9 T. j, l' j
  18.             TIM2->CCER |= 0<<5;           //IC2不反向( x$ u2 i& N2 f& W- o8 |
  19.             TIM2->SMCR |= 3<<0;                  //所用输入均在上升沿或下降沿有效* y/ [5 m0 F4 m
  20.             TIM2->CR1 |= 1<<0;                  //使能计数器7 Q& X. f9 D, H# F2 I7 G
  21.     }
复制代码
" ~& I' p  b/ H1 ~4 c, d6 ?; o
3 硬件
  n: {3 K5 {' J" k& c0 o0 ~

用到的模块有STM32核心板、L298电机驱动、371带编码器电机(1:34)。这里主要介绍一下电机,1:34指的是电机轴转动34圈,电机输出1圈。1:X,X值越小,电机的输出转速也就越快,扭矩也就越小;反之,X值越大,电机的输出转速越慢,扭矩也越大。

4.jpg
: g( W: Q' ~' Z
图4 电机实物图

左边两根黄线是电机两极。绿线和白线是脉冲输出线,分别接编码器的接收管A、B,用一根可以测得速度,两根同时用可测出电机速度与转向。红线和黑线是编码器电源接线,红正黑负,电压3.3V-5V,不不可接反。

4 控制代码0 H6 Y; T$ o. ]: H$ |! ^4 b

工作指示灯、电机方向与速度控制代码。

  1. //LED IO 初始化 端口PD.2  运行指示灯
    " P5 [6 t9 \1 }: j  Z* @+ j
  2. void LED_Init(void)2 u+ j0 Z+ l& V- W
  3. {                    
    0 S) c; Q0 C/ \. n7 M% `
  4.         RCC->APB2ENR|=1<<5;      //使能PORTD时钟         
    + w( P3 Z- w1 d8 h2 Y' K
  5.         GPIOD->CRL&=0XFFFFF0FF;
    ; p7 M, J4 h" }
  6.         GPIOD->CRL|=0X00000300;  //PD.2推挽输出" O" `% z' y. O* e$ P. }% o5 W
  7.         GPIOD->ODR|=1<<2;        //PD.2输出高   w0 c& O. p# T4 x- X1 J
  8. }0 F" V1 x7 f3 [1 F' g: e1 B
  9. //电机旋转方向控制信号端口初始化
    ) {, B2 y  ^7 i5 p: P8 Y: H, B
  10. //PC1~0推挽输出,输出高$ O+ B/ s4 k! P+ X& ~4 u2 C# c
  11. void M_Init(void)
    ' B& E8 @; t: T( l
  12. {
    $ x, R( [8 R" ?
  13.         RCC->APB2ENR|=1<<4;      //使能PORTC时钟
    , f4 O. |2 w: L7 r+ H; U; m- K
  14.         GPIOC->CRL&=0XFFFFFF00;. B+ R7 u! r; I! v2 \$ ~% ?
  15.         GPIOC->CRL|=0X00000033;  //PC1~0推挽输出
    ! m3 d* [/ n  w; ?# A3 D6 }
  16.         GPIOC->ODR|=0XF<<0;             //PC1~0输出高电平7 D/ f' Q+ a" }: Q7 v# e
  17. }
    ; ~, C- h7 E2 X8 H+ P. j

  18. 1 E: N0 _; x7 C" g, K
  19. //定时器TIM3,PWM输出初始化,CH1(PA6)9 Q; c4 Y+ Q3 ]6 n/ @3 G" T+ F
  20. //arr:自动重装值
    5 `- |: x/ u0 V: g
  21. //psc:时钟预分频数' Z" h& T+ i! v9 t9 ?/ v& v
  22. //设置自动重装值为900,那么PWM频率=72000/900=8Khz
    + i+ ]- q+ b  `" P' ]! [# _7 R
  23. ////见STM32参考手册,14.3.9PWM模式。0 I4 S. M# H- D6 @/ Y* }- w
  24. void TIM3_PWM_Init(u16 arr,u16 psc) //arr设定计数器自动重装值   
    2 q4 i$ Q# T8 Y
  25.                                     //psc预分频器不分频,psc=0; }; d8 T6 |2 Z
  26. {5 n  `0 E4 w% b3 E) {
  27.         RCC->APB1ENR|=1<<1;       //TIM3时钟使能    : N1 t) G& y4 r8 b7 x$ ^, ~
  28.                   
      B' [) ^; C$ j$ G
  29.         GPIOA->CRL&=0XF0FFFFFF;//PA6输出
    ! k. U: O0 p9 h7 ^) p# F
  30.         GPIOA->CRL|=0X0B000000;//复用功能输出           
    9 l, Y7 O9 P' m
  31.         GPIOA->ODR|=1<<6;//PA6上拉        
    + ]2 o4 v  D2 {* l3 T

  32. % O, |5 p% o0 y" r7 i5 h0 t3 ?
  33.         TIM3->ARR=arr;//设定计数器自动重装值 4 h, J/ }2 q; a  [. D
  34.         TIM3->PSC=psc;//预分频器不分频6 ?) D- B1 x% ]) u. r
  35.         - H6 S5 G& g% B2 Y0 H- B
  36.         TIM3->CCMR1|=6<<4;  //CH1 PWM1模式        高电平有效         
    " x7 R0 Q- d4 ~5 F5 w
  37.         TIM3->CCMR1|=1<<3; //CH1预装载使能
    9 x* K0 U. A' ?/ M

  38. 0 ^/ t( P! V6 v; t4 X' ]( ]
  39.         TIM3->CCER|=1<<0;   //OC1 输出使能   # _5 ?6 r4 f( J0 k

  40. 5 ^/ k  Q1 g" a$ w$ o# Z
  41.         TIM3->CR1=0x0080;   //ARPE使能 7 T4 R0 j$ A" a8 o$ B7 o4 o# I4 M
  42.         TIM3->CR1|=0x01;    //使能定时器3
    / f! V( k- Z0 ?$ Y: \& T" O8 b
  43. }, {3 }" \: t7 J. A# K3 Q
  44. # x: \* A6 I0 c# P7 Q5 d9 Q
  45. //电机方向与速度控制,速度调节范围为-100~+100
    . [! u& p6 ~, ^$ U2 B
  46. //大于0时,正转,小于0时,反转2 P& ?# @" {* i9 g( ?
  47. // 占空比低于0.4时电机不转4 |) n3 \( q2 {
  48. //(占空比是指高电平在一个周期之内所占的时间比率)" i. a2 u" L) w& V5 m2 B0 @& z8 K
  49. //TIM3->CCR1的设定范围为0~900(因为arr=900)5 T7 X2 N% R9 r$ `" X
  50. //见STM32参考手册,14.3.9PWM模式。5 c; i1 v  ?* M2 f; @
  51. void Motor_Speed_Control(s16 motorSpeed)         
    ! o: I% K/ m" X. a- K& i8 ^
  52. {5 g2 K. K6 G8 e2 T: n6 X' H
  53.     s16 speed = 0 ;        3 I7 L3 b* z# J
  54.         4 W# \1 H; N7 a" I4 F
  55.     if(motorSpeed>100)  speed = 100;9 P( b" a% G" s; z4 s  \! T4 e2 y6 T
  56.             else if (motorSpeed<-100)  speed = -100;
    2 A4 Y! F) T6 [7 P
  57.                         else  speed = motorSpeed;, n0 f1 X; ?; m' @* m
  58.         if(speed == 0)( J2 u( ^8 _/ {
  59.         {
    - n. T- y: _0 a* t
  60.                 M_1 = 0;
    4 S1 q" g: E5 V  ~
  61.                 M_2 = 0;
    : |, R* G% _1 @+ L2 |+ K
  62.         }; b6 d) [9 U0 g2 s4 f  t
  63.             else if(speed > 0)6 m, j* g2 ^; r4 ]6 ~& i, v2 c
  64.                 {
    " w1 N. J9 w$ _
  65.                         M_1 = 0;4 A& P- W+ r/ I
  66.                         M_2 = 1;, C; r7 W8 i, ~( m0 }3 X- |, G
  67.                         TIM3->CCR1 = speed * 9;. p8 t+ W$ n# k& Q' I! b
  68.                 }
      S9 K7 {; }% J# @1 N
  69.                         else& w4 S; T: H' d) H: b* v
  70.                         {( Y' l& U+ V4 K$ f  P! @; E
  71.                                 M_1 = 1;0 L/ x" l9 ^7 D; A& D! s5 w
  72.                                 M_2 = 0;8 s8 }3 G% ?' J) h; r! `+ ?/ e' L
  73.                                 TIM3->CCR1 = -speed * 9;
    & h! K. }, U3 r9 L
  74.                         }
    4 ~0 B# F+ [% g0 i& v$ q! n& s
  75. }
复制代码

1 y! m- i! |: C) \# u

电机速度与方向检测代码


  1. ; W, ~" q/ O3 K; b4 \; _
  2. # l" k9 J1 k/ J% f
  3.     //TIM2_Encoder_Init,Tim2_CH1(PA0);Tim2_CH2(PA1)+ s  ]! H- s- p8 g
  4.     //arr:自动重装值 0XFFFF: ~  e8 e& v; i
  5.     //psc:时钟预分频数        ,不分频; t6 P2 ^& G; U" _
  6.     //见STM32中文手册 14.3.12编码器接口模式
    ; g- q" b$ U! r( @- W0 l
  7.     void TIM2_Encoder_Init(u16 arr,u16 psc)# x# s: R) S5 |+ b. H) N8 r
  8.     {- E9 n) D& O- |5 z3 O: W
  9.         RCC->APB1ENR|=1<<0;       //TIM2时钟使能9 T0 G/ |2 D: K% I4 t: p
  10.             RCC->APB2ENR|=1<<2;       //使能PORTA时钟! J- U4 X6 q' c! M2 ^3 ~1 c9 Y
  11.             
    4 Y" U0 t3 x5 ~9 {) J
  12.         GPIOA->CRL&=0XFFFFFF00;   //PA0、PA1 清除之前设置
    2 l8 J' z9 P2 G# z/ n9 k
  13.         GPIOA->CRL|=0X00000044;   //PA0、PA1 浮空输入! c6 U3 b8 g4 }
  14.                
    : O/ g6 K9 S# {$ E5 a( S: d' j7 }
  15.         TIM2->ARR=arr;            //设定计数器自动重装值 ) c7 ^# I; X& ]& x! k* }% m6 i: O
  16.         TIM2->PSC=psc;            //预分频器% V+ Z7 c7 r3 ^

  17. . ]7 ~$ E! W6 n& i; m9 I6 r8 T1 H
  18.             TIM2->CCMR1 |= 1<<0;          //输入模式,IC1FP1映射到TI1上( y' q$ p( T' |7 A7 [: `
  19.             TIM2->CCMR1 |= 1<<8;          //输入模式,IC2FP2映射到TI2上- b. c3 D/ T5 O6 c* p6 ^  `
  20.             TIM2->CCER |= 0<<1;                  //IC1不反向0 X3 T: x1 M  w/ a
  21.             TIM2->CCER |= 0<<5;           //IC2不反向5 U& C" y; \" q( H* }0 n. n
  22.         TIM2->SMCR |= 3<<0;                  //所用输入均在上升沿或下降沿有效# e) N9 K% o- l8 D& R
  23.             TIM2->CR1 |= 1<<0;                  //使能计数器# i% ]+ L  J" m7 z% a& m& y1 c4 M
  24.     }, D  u' C3 o1 k8 M. D; K: T' t
  25.     //计数寄存器赋值
    + f1 T% ?) }6 _8 K6 k
  26.     void TIM2_Encoder_Write(int data)
    - B% ?, r+ d5 W9 @9 f, K) o
  27.     {$ K/ Z) l( f9 k3 k
  28.         TIM2->CNT = data;
    ; y- `! B% o3 Y8 X
  29.     }
    , C5 m5 T/ m8 W' W2 F  G7 n9 r
  30.     //读计数个数
    - c: c; @6 Q" G
  31.     int TIM2_Encoder_Read(void)- g: g- q. c0 [* P* z* z
  32.     {
    5 F/ W3 y' i0 J( d* f7 c4 x
  33.         TIM2_Encoder_Write(0);        //计数器清0
    5 O! e0 p! f/ q; n9 b( y: K
  34.             delay_ms(10);          //检测时间,可调节- `9 ]+ U3 F; x% J# c
  35.         return (int)((s16)(TIM2->CNT));           //数据类型转换
    ) P: _/ ?5 f* D& o
  36.                                  //记录边沿变化次数(一个栅格被记录4次)
    ' d" f& X4 e8 E' T. ]4 r
  37.     }
复制代码

: w8 w- v7 }2 E" Y3 P8 ~

这里我们只显示边沿变化次数,没有具体的算出速度。
# R+ l' G7 t& ]  y主函数


  1.   t; h' U  W- g0 l
  2. 3 q' |0 \" }/ B. |+ I  Y
  3.     int main(void)
    " _2 K' L5 F. z, {# x: J
  4.     {
    5 |. [# K; W" h
  5.     //        motorSpeed的范围为-100 ~ +100;' d+ y; g+ u2 @3 F0 Q: i
  6.             s16 motorSpeed = 100; , B$ S5 X- W4 F0 ~! C9 z
  7.             Stm32_Clock_Init(9); //系统时钟设置
    ( B9 n1 n+ Z4 m! x5 G
  8.             delay_init(72);             //延时初始化
    0 y; @9 i) |* i- r8 k% c( t& Y& Z) V
  9.             uart_init(72,9600);  //串口1初始化) `' f( `2 }1 b, a
  10.             LED_Init();                         //初始化与LED连接的硬件接口/ U9 o: L# Z2 y, l0 b
  11.             M_Init();                           ////初始化电机运行方向控制端口
    ( T7 z& S: g  r% k- W+ L/ X! w
  12.             TIM3_PWM_Init(900,0);          //不分频。PWM频率=72000/900=8Khz9 F8 J; Z: F2 G; D) w5 T
  13.             TIM2_Encoder_Init(0xffff, 0); //计数器自动重装值为最大
    # h6 r- m; _' i: D- y5 Y3 T$ ?  Q

  14. 5 b9 ?; _1 |7 U* w. G* U! {
  15.             while(1)% |4 Z5 \, u, H& ?+ ?! _. B9 s
  16.         {
    ! h8 q4 |( t6 G! {) Z0 D
  17.                     LED =! LED;
    " E; @  ~6 V' }8 `$ V& M
  18.                 Motor_Speed_Control(motorSpeed);
    7 K1 u+ q) [# H+ |) M; A
  19.                     printf("编码器值:%d\n ",TIM2_Encoder_Read());
    * }4 \8 B: F7 Z' b0 V' ^
  20.         }               
    ) I9 p* @1 z4 A' C# t7 r" ~
  21.     }
复制代码
6 e, r: o5 x8 L$ |' ~" U
5 估算验证9 U0 f$ {  v" d+ ~4 g8 m
         这里我们只是大概的估算验证测量值是否正确,不具有完全正确性。
5 l+ M: f& K; G. r0 Z4 J& O9 @        我们设置motorSpeed = 100 ,得到测量值如下图:

' i; y1 R2 u3 X( q7 R% z
5.png
图5 motorSpeed = 100

因为误差是不可避免的,所以看到每次检测的值都是不一样的。我们取462,因为一个光栅被记录了4次,所以在10ms内一共检测到了462/4=115.5,那么得到11.55个/ms,每ms内检测到11.55个光栅。

     通过码表,记录电机输出50圈,用时50.2s,那么这时应该检测到的光栅个数为50*34(电机转34圈,输出1圈)*334(每圈有334个光栅)=567800,除以时间,得到估算值11.31个/ms。可以看出估算值与测量值是相近的,认为测量是准确的。
/ k7 @6 J" u& i2 W4 [+ h" }      设置motorSpeed = -50 ,得到测量值如下图 :
0 F6 d* E* V1 b- _1 u( u  [
6.png
图6 motorSpeed=-50
可以看到测量值是负值,说明电机是反转,与实际设置相符。
  附件
stm32 编码器接口.rar (76.87 KB, 下载次数: 259)       我们读的是计数器TIM2->CNT中的值,此值为什么会是负的,这里为什么这样用?      编码器模式中使用上下计数,假设我们初始化TIM2_Encoder_Init_1(0xff, 0);自动装载值为0xFF,这时,计数器中的值,就会在0x00与0xFF之间循环变化,由0x01减为0x00,再减1时,计数器中的值为0xFF,我们将此数做为有符型整数处理,当然,计数的前提是每个周期的计数个数不能超过0x7F,超过,计数将不准确。
0 a' ]+ p9 m$ j      符号强制转换,return (int)((s16)(TIM2->CNT));里面有个类型转换,强制转换返回有符型数据。数值都是以补码表示的,正整数补码是源码,负整数补码是绝对值取反加1。向下计数时减1,为0时,就需要向高位借位减“1”,可以这样理解,一个8位数00000000B-00000001B,但0不够减1的,就向不存在的第9位借1,100000000B-00000001B=11111111B,数是以补码形式表示的,这样11111111B就为-1了。
/ w7 V& N' ]3 X6 U4 W& G" [5 i8 H      在例程中,初始化自动重装值为0xFFFF可以做个实验,直接输出TIM2->CNT的值看一下:      printf("编码器值1:%x \r\n",TIM2->CNT)。                    9 U! h9 D5 Z/ v& I3 P. J

3 I9 \' U" n9 q1 z2 e+ U5 g
赞 收藏 评论0 发布时间:2017-12-26 19:42

举报

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