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

【经验分享】STM32-增量式旋转编码器测量

[复制链接]
STMCU小助手 发布时间:2022-1-16 17:55
一、增量式旋转编码器1、简介
  • 编码器(encoder)是将信号(如比特流)或数据进行编制、转换为可用以通讯、传输和存储的信号形式的设备。编码器把角位移或直线位移转换成电信号,前者称为码盘,后者称为码尺。
  • 按照读出方式编码器可以分为接触式和非接触式两种;
  • 按照工作原理编码器可分为增量式和绝对式两类。增量式编码器是将位移转换成周期性的电信号,再把这个电信号转变成计数脉冲,用脉冲的个数表示位移的大小。绝对式编码器的每一个位置对应一个确定的数字码,因此它的示值只与测量的起始和终止位置有关,而与测量的中间过程无关。 
  • 旋转编码器是集光机电技术于一体的速度位移传感器。它将被测的角位移直接转换成数字信号(高速脉冲信号)。
  • 我们通常用的是增量型编码器,可将旋转编码器的输出脉冲信号直接输入给PLC,利用PLC的高速计数器对其脉冲信号进行计数,以获得测量结果。不同型号的旋转编码器,其输出脉冲的相数也不同,有的旋转编码器输出A、B、Z三相脉冲,有的只有A、B相两相,最简单的只有A相。A、B为相差90度的脉冲,Z相信号在编码器旋转一圈只有一个脉冲,通常用来做零点的依据,连接时要注意PLC输入的响应时间。旋转编码器还有一条屏蔽线,使用时要将屏蔽线接地,提高抗干扰性。
  • 信号输出有正弦波(电流或电压),方波(TTL、HTL),集电极开路(PNP、NPN),推拉式多种形式,其中TTL为长线差分驱动(对称A,A-;B,B-;Z,Z-),HTL也称推拉式、推挽式输出,编码器的信号接收设备接口应与编码器对应。信号连接—编码器的脉冲信号一般连接计数器、PLC、计算机,PLC和计算机连接的模块有低速模块与高速模块之分,开关频率有低有高。如单相联接,用于单方向计数,单方向测速。A.B两相联接,用于正反向计数、判断正反向和测速。A、B、Z三相联接,用于带参考位修正的位置测量。A、A-,B、B-,Z、Z-连接,由于带有对称负信号的连接,在后续的差分输入电路中,将共模噪声抑制,只取有用的差模信号,因此其抗干扰能力强,可传输较远的距离。对于TTL的带有对称负信号输出的编码器,信号传输距离可达150米。
  • 线数:旋转一周信号线输出脉冲数,也成为分辨率3 R/ V7 a8 \3 F2 z

  • . c3 C1 J7 P2 [7 }
    9 D( A0 W1 A. C) W9 V
1248164-20180510192503629-93708335.png
7 v% ?6 R/ P+ r* q9 S! ~4 Z
1248164-20180510195028614-102457577.png
2、型号
此篇文章使用的旋转编码器型号有两种。
传感器(增量式旋转编码器)

7 f1 e$ `: b/ j
型号
供电电压
输出方式
分辨率
品牌/厂家
输出电平
S20-1000型拉线位移传感器
5-24V
NPN集电极开路
400
Omron/欧姆龙

2 k, i8 c. y$ r
DT100E40R1024-HI
增量型大孔径编码器
5-30V
HTL(推挽式)
1024
冬莅自动化技术(上海)有限公司
www.shdongli.cn
高:VCC*70%
低:1V
- g2 k& ~3 w/ |5 P/ \* y
) j$ R( c- A" M" W; q6 j0 q! M
二、硬件设计
  由于增量型编码器输出脉冲,可以直接接入PLC单片机,利用PLC高速计数器进行测量。将编码器接入STM32单片机需要一个定时器资源,并将定时器配置为编码器模式,稍后会简要介绍配置方法。根据传感器的输出方式,进而来判断是否需要进行信号预处理。对于集电极开路输出的传感器接入必须使用上拉电阻。注意STM32大多数引脚的输入电压都在3.3V左右,尽量不要过压。如果电压较大,最好加隔离电路,比如6N136光耦,类似下图
9 V5 X9 A( ~+ \" c/ C
1248164-20180510200405732-66175176.png

! G# Z4 m2 H" x
  我在这里并没有使用隔离电路,而是对传感器统一使用了5V供电,并在信号接入端人为加了3.3V上拉(上拉电阻1K),这种接口电路在我自己设计的采集板上统一留出了8个。编码器应用中并未使用Z相,仅使用了A、B两相进行编码器计数。按照线序说明接入STM32的定时器引脚,PA6、PA7对应TIM3的CH1、CH2通道,PB6、PB7对应TIM4的CH1、CH2通道。对于第二种传感器的推挽输出方式而言,实验证明这种接入电路也是可行的。(具体电路没有进行分析,只是图个方便。但是5*70%=3.5V应该是勉强可以直接接入stm32引脚的)
$ V! a! g+ u9 o! H) @6 V5 y$ @
1248164-20180510202458411-1027273337.png

9 M1 F$ A- V1 l5 M* ]( \三、软件设计1、STM32定时器编码器模式简介
  参考官方文档,摘录几个要点:
  • 编码器接口模式基本上相当于使用了一个带有方向选择的外部时钟。
  • 两个输入TI1和TI2被用来最为增量编码器的接口,TI1FP1和TI2FP2是TI1和TI2在通过滤波器和极性控制后的信号,计数器由每次在TI1FP1和TI2FP2的有效跳变驱动,根据跳变顺序,产生计数脉冲和方向信号,计数器向上或向下计数,同时硬件对TIMx_CR1寄存器的DIR位进行相应设计
  • IC1、TI1概念理解:TI1是定时器输入通道,IC1是输入捕获通道(两者可以交错)。配置CCMR1寄存器的CC1S位可以指定IC1的映射方式。可配置滤波器和预分频器。: j; `7 n2 F% K# H4 v* z( R* y" C
    - P+ l# V. g5 o4 t. B
8 Y8 b- Q1 X4 l- Y, W
1248164-20180510211213519-2095565993.png
+ b/ W' q/ o4 d3 N4 Y* q! _3 h6 H
1248164-20180510210619647-836174267.png

4 R& _8 l; b: H8 x' k
  • 计数方向与编码器信号的关系6 r- E( C6 a: [/ ]$ o- d
    0 v( v* {6 Q) X+ o8 q/ ?
* j: A) G9 `% F5 r+ s2 R: D( e

1 b; s2 ]% N# L. h( g# ` 1248164-20180510211455433-476773874.png
' o# e9 }* t* ]0 a: t3 F7 v( o) o
) V: p& c& B; i
2、软件实现
  1. 1 /********************************************1 k" f5 t" V; w) b3 Q
  2.   2 + p1 G- N# l6 Q, p+ w
  3.   3 TIM3、TIM4定时器编码器模式配置
    " B& ^" B* A3 e3 q
  4.   4 & w+ i! `8 K& b0 Q9 p8 m; }: o
  5.   5 *********************************************/
    ( q- u2 k! ]+ P7 }  z
  6.   6
    : A/ X% @/ b- H7 b3 ?
  7.   7 #include "sys.h"
    0 {4 ]9 U% L% g8 M+ d
  8.   8 #include "encoder.h"" o4 ^' d' j5 g1 m2 Z5 e
  9.   9 2 D6 i# h: ?" H# @/ y
  10. 10 int TIM3ITCount=0;//中断溢出次数
    / i) Q9 _* k  F3 F/ [' b( }
  11. 11 int TIM4ITCount=0;//中断溢出次数
    ! Y2 [' f* G! |/ Z# \
  12. 12
    , @* y. _! d6 g/ {
  13. 13 void TIM3_IRQHandler(void)
    4 z1 P% M5 h. {( B. }! R  F
  14. 14 {   ' p: x. S/ R7 y& L; B
  15. 15     if(TIM3->SR&0x0001)//溢出中断
    ; o  z- C% d7 Z1 E
  16. 16     {. f, E8 d  _1 l) u
  17. 17         
    9 e' A, Y7 u# ^, c
  18. 18     }   
    8 j: i! T: o4 x( H% O
  19. 19     TIM3->SR&=~(1<<0);//清除标志位    1 B7 g) ?* Y. J( g4 l) o& ^
  20. 20 }0 q7 x* y! B1 D. N
  21. 21
    6 l5 z) F  ?9 m& d5 g
  22. 22 void TIM4_IRQHandler(void)- L, n6 t5 E6 J6 _* U- W
  23. 23 {   
    6 C/ L) w# V. A% G
  24. 24     if(TIM4->SR&0x0001)//溢出中断
    " U2 h" |9 a' z& Y; |8 i( L8 Z9 l' e
  25. 25     {
    $ Y+ V6 I/ J- Y  p0 O- F
  26. 26     }   . i1 g0 W" Z2 o
  27. 27     TIM4->SR&=~(1<<0);//清除标志位   
    . y7 [6 M+ s0 H7 i) |
  28. 28 }
      X' y0 G' `+ i" J8 w, O; D( ?" K1 n
  29. 29 5 [* X& o1 K. ?. K! q2 r7 ^6 q
  30. 30 void TIM3_Encoder_Init()
    8 I6 N; M: y# m* d2 [' Y
  31. 31 {: P) U. }6 o6 J! x  `( N9 z
  32. 32     TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;2 ~3 u8 B* H' C) }! f8 ~; Z1 s1 T
  33. 33     TIM_ICInitTypeDef TIM_ICInitStructure;
    ' b& C2 Q$ W0 D$ B3 U
  34. 34     GPIO_InitTypeDef GPIO_InitStructure;" p  c( L5 i1 ^
  35. 35     NVIC_InitTypeDef NVIC_InitStructure;
    & W+ m9 g5 g$ @5 a! W
  36. 36     
    1 \$ d& l0 r- N! y2 ~6 v, m7 g+ j4 ]2 g9 |
  37. 37     //时钟使能9 m  \. w1 M& @% J$ i5 a+ L
  38. 38     RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE);  //使能 TIM3 时钟% \* F5 e1 d: k$ {" p4 I* y1 u
  39. 39     RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); //使能 GPIOA 时钟( b4 D/ d) P7 n$ G5 H" Q/ r- a
  40. 40     5 U+ ?8 I9 x5 A, _" _( {% F. i
  41. 41     //GPIO配置
    1 n" A0 n2 p2 }7 |, `8 J0 l% h
  42. 42     GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7; //PA6、PA7设置/ A' Y6 }/ t0 j9 `) D2 \3 Z- i, U
  43. 43     GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING; //浮空输入
    2 @- L9 T  V6 ]& X  c
  44. 44     GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    # i$ |6 R6 L" Z. Z
  45. 45     GPIO_Init(GPIOA, &GPIO_InitStructure); //初始化 GPIOA, m0 \0 q7 q( F. }( d
  46. 46     $ o6 }4 \+ @  H& a% K
  47. 47     //定时器初始化
    + y( @  {. G, f, _" {! ^( z* `
  48. 48     TIM_DeInit(TIM3);
    : [+ {" i+ t$ J' I
  49. 49     TIM_TimeBaseStructInit(&TIM_TimeBaseStructure);
    2 _. @. n6 P( F3 I
  50. 50     TIM_TimeBaseStructure.TIM_Period =65535;//预装载值; g' `% X) ?/ p& a( J/ S, f- V
  51. 51     TIM_TimeBaseStructure.TIM_Prescaler = 0;//预分频" `$ P, h* S. x2 f5 C" v
  52. 52     TIM_TimeBaseStructure.TIM_ClockDivision =TIM_CKD_DIV1 ;9 f3 n4 k9 R7 g
  53. 53     TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
    ; G" f. V. O  A1 J7 X! i* c  v
  54. 54     TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); 2 A% E5 a3 ^6 b. \& Y
  55. 55     
    2 v- ]0 \& O# E! ~0 k
  56. 56     //编码器模式配置
    ( V" L2 R  P$ ^  b% w$ n3 ^) P
  57. 57     TIM_EncoderInterfaceConfig(TIM3, TIM_EncoderMode_TI12, TIM_ICPolarity_Falling, TIM_ICPolarity_Falling);
    & S3 v% V: L0 `$ `
  58. 58     TIM_ICStructInit(&TIM_ICInitStructure);
    1 V5 i8 c: W: H* l; ]6 f$ _* m
  59. 59     TIM_ICInitStructure.TIM_ICFilter = 6;//ICx_FILTER;
    - [% o" N& X. l0 h
  60. 60     TIM_ICInit(TIM3, &TIM_ICInitStructure);7 \1 C  a! W4 {) ~  T
  61. 61     1 S8 E* U( ], q3 B3 ]% s$ z
  62. 62     //初始化 NVIC 中断优先级分组
    " S' n" y1 t; L
  63. 63     NVIC_InitStructure.NVIC_IRQChannel = TIM3_IRQn; //TIM3 中断9 K" H, t8 p, j) T/ a  _; j
  64. 64     NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2; //先占优先级 2 级
    ) x; o% w) f4 Y
  65. 65     NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; //从优先级 0 级: H8 J/ |& I& C' H0 h! Y
  66. 66     NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ 通道被使能
    8 H% w' U* Q! a! h$ s: p
  67. 67     NVIC_Init(&NVIC_InitStructure); //初始化 NVIC
    1 B1 E1 n# F9 V! ^: ?
  68. 68     
    8 r1 R" V! k6 D) G
  69. 69     //中断配置
      q2 T3 h9 ]+ b; @& J
  70. 70     TIM_ClearFlag(TIM3, TIM_FLAG_Update);
    9 F5 N, [6 z. j* i& S# t( H& T" M
  71. 71     TIM_ITConfig(TIM3, TIM_IT_Update, ENABLE);$ I" _( t; s' v  S4 C
  72. 72     , C3 p: E# @4 Z4 Y6 `  _" O
  73. 73     //Reset counter
    - ^8 E8 {0 A$ b2 |
  74. 74     TIM3->CNT = 0;; {% x" ]7 I9 I+ s" ]7 K: N
  75. 75     //使能定时器
    , e& I  A! ^" F/ ?. o% e
  76. 76     TIM_Cmd(TIM3, ENABLE);   
    $ K% a4 b7 Z2 \
  77. 77 }
    + V' S5 R5 M1 l5 h/ t) I
  78. 78
    & J- ?8 l( x9 d6 U
  79. 79 void TIM4_Encoder_Init()1 d' k1 B4 e) D: ]+ B& `% s  t
  80. 80 {5 \2 D0 G1 T1 o% F
  81. 81     TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;- W7 M# Y& Y# S9 @+ c
  82. 82     TIM_ICInitTypeDef TIM_ICInitStructure;
    * m, {5 ~$ f/ ?2 M, ~: i/ G
  83. 83     GPIO_InitTypeDef GPIO_InitStructure;; N9 H1 Z2 R: e3 h
  84. 84     NVIC_InitTypeDef NVIC_InitStructure;
    * }' N2 c9 }6 j' P
  85. 85     3 O2 I5 b" p5 ]& E/ g6 q/ \9 k
  86. 86     //时钟使能3 l" L! Z. r: Z: G: ]
  87. 87     RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);  //使能 TIM4 时钟( ^: }( n! L1 V4 w: a
  88. 88     RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE); //使能 GPIOB 时钟" d0 N$ ^/ ~& q0 Y# v! c
  89. 89     
    ; Q9 G4 K4 T9 o6 Y# o3 e( ^
  90. 90     //GPIO配置7 B* D; c8 ?, ?3 m% \3 k7 h
  91. 91     GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7; //PB6、PB7设置9 ]! E) S1 Q3 L8 d$ ?; q
  92. 92     GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING; //浮空输入
    ; A: \5 C+ b& w
  93. 93     GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    8 a) L( S+ h- i- T
  94. 94     GPIO_Init(GPIOB, &GPIO_InitStructure); //初始化 GPIOA: D' j$ e8 I& B3 f- v8 ?( q/ ~/ }, a+ x+ u
  95. 95     0 c9 B1 I+ N- n$ r
  96. 96     //定时器初始化
    5 W6 n; o! u  ?# U
  97. 97     TIM_DeInit(TIM4);
    & Q/ U- T* m: K' K& i
  98. 98     TIM_TimeBaseStructInit(&TIM_TimeBaseStructure);+ H. ?- o+ i8 M4 X9 f- m" U
  99. 99     TIM_TimeBaseStructure.TIM_Period =65535;//预装载值, w1 n  m. l' T* }& R) `
  100. 100     TIM_TimeBaseStructure.TIM_Prescaler = 0;//预分频# X3 s5 K7 T5 l9 ^* O
  101. 101     TIM_TimeBaseStructure.TIM_ClockDivision =TIM_CKD_DIV1 ;
    ( ^+ h) I) ?+ a/ c4 }* `+ w: v: m
  102. 102     TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
    6 ]& E5 W# F$ E( j! b
  103. 103     TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure); ' D8 |# O( Z1 X
  104. 104     
    $ {% }: Y3 F6 I2 H
  105. 105     //编码器模式配置# `$ S. i( ]. [7 d
  106. 106     TIM_EncoderInterfaceConfig(TIM4, TIM_EncoderMode_TI12, TIM_ICPolarity_Falling, TIM_ICPolarity_Falling);" m$ ~1 o  A2 S* `* N1 \
  107. 107     TIM_ICStructInit(&TIM_ICInitStructure);
    & j' z6 H) B3 G( Q- M6 t
  108. 108     TIM_ICInitStructure.TIM_ICFilter = 6;//ICx_FILTER;: f( V- [. b# q+ l9 L
  109. 109     TIM_ICInit(TIM4, &TIM_ICInitStructure);
    & k' E. F4 E0 Q- t6 n2 @( P$ G
  110. 110     
    % g8 D3 D9 U( J: W6 z( N
  111. 111     //初始化 NVIC 中断优先级分组
    % ?# W9 n( @3 ~% w  `6 r5 F0 n
  112. 112     NVIC_InitStructure.NVIC_IRQChannel = TIM4_IRQn; //TIM4 中断
    * f" P7 S  o. t  x. L
  113. 113     NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2; //先占优先级 2 级$ G: p/ |! n; k' \2 L+ M! c
  114. 114     NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1; //从优先级 0 级1 Y% w7 h2 q% k9 k9 s$ l
  115. 115     NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ 通道被使能
    1 t5 R1 A. k! y9 b6 N) ~9 `! [
  116. 116     NVIC_Init(&NVIC_InitStructure); //初始化 NVIC' [* p5 D, B; i! f$ r# L. ]% D
  117. 117     
      x) y" j# Z1 ?1 A, M
  118. 118     //中断配置2 F; v% [6 P9 s' a
  119. 119     TIM_ClearFlag(TIM4, TIM_FLAG_Update);
      p/ B7 Q4 \  X4 a4 V
  120. 120     TIM_ITConfig(TIM4, TIM_IT_Update, ENABLE);/ @" `; G. `, i, n. y
  121. 121     
    # E" Y6 z: Z2 R1 m3 \/ H1 P3 z0 @
  122. 122     //Reset counter; m1 V, D7 p+ y! A5 F4 M) o
  123. 123     TIM4->CNT = 0;5 M  Z( Z: Y" n* l, H8 V
  124. 124     //使能定时器( M( k0 e* X5 S. ~) J8 h
  125. 125     TIM_Cmd(TIM4, ENABLE);   
    0 D) @6 m3 e7 ]' k! O, K# N( m% y
  126. 126 }
    7 ^5 f4 t! Y' ?* x' l: A+ L
  127. & F% |. L; |* g. E+ u3 H6 G
  128. encoder.c
复制代码

, b- t* ]( K  K/ q
5 G* `  |5 x3 B$ J; ?' R
3、注意事项
  • 更新中断可以不开。但是由于没有使用Z相信号,所以这里保留更新中断,实际上目前中断里什么也没做
  • 由于是双相下降沿计数,所以转一次会输出两个脉冲,转一周脉冲数为分辨率*2,注意处理。当然你也可以配置为其它计数倍数
  • 这里预装载65535,可改为线数*2,即可对转一周的位置进行严格编码
  • TIMx->CNT的值即为编码器的位置(并不一定是输出脉冲值,跟旋转方向和预装载值有关,增量编码器的零点是初始化自己定义的)
  • GPIO配置为浮空输入模式。对于集电极开路输出的编码器,如果你没有外部上拉,则使用内部上拉,配置为上拉输入模式即可。
    6 O# {/ T3 q0 V' E& o

    8 k4 B* l, B0 V. |5 Y
6 @, X3 F4 b+ b$ m0 g0 z- X

8 A) b3 ~5 D7 W, L, i: X
赞 收藏 评论0 发布时间:2022-1-16 17:55

举报

0个回答

所属标签

相似技术帖

官网相关资源

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