前言; Z/ T. ?/ v- s7 ~8 _6 T3 E
如果我们想对电机进行速度或者转角的精确控制,需要使用到很多算法,比如非常经典的PID控制算法,或者一些只能算法,但这些算法都需要传感器来提供转速或转角的反馈值,对于电机来说,编码器是非常流行并且实用的电机配套传感器,本文使用STM32F103C8T6+L298N+MG513P30电机进行直流电机的编码器测速。; |( `/ L% B* l, V: X5 }. o
1 E3 j' t& c c& w( X8 I1 e
一、编码器原理. U2 d; e1 R% T" t: T0 R: ~( L& W
1.分类
2 t) p" B& ~+ o8 Z) s/ E3 ?0 Z& j( r, s! h
% ?% t- ~2 d! w
6 `- n; N# I& {" ?0 P( j: N' C7 o! e3 b4 P, a3 I" N1 M3 @
光电式编码器的精准度比霍尔式要高,但是由于它需要红外线发生器和接收器,相对来说造价要贵一些。现在我们比较常用的是霍尔式增量编码器,有很多电机都会自带编码器。
! ~$ `7 S7 {: \4 U1 o5 `4 l D) d4 A. ~# B9 C: U+ A
8 A& C: r5 ]. X8 K* y9 A# h, ~% T" ?& T9 W1 h( i
2.测速方法分类/ i1 o9 [$ T, g/ w/ G) U6 p
(1)M法测速
1 X$ }: W' S; F- M/ E编码器输出的脉冲个数代表了位置,那么单位时间里的脉冲个数表示这段时间里的平均速度。因此,我们可以通过计量单位时间脉冲个数即可以估算出平均速度,称为M法测速(测脉冲个数)测速原理如图所示。% _1 b& b- W6 r- e8 |2 b
# _ R# q* o# A2 `
. q' U! ~+ ~6 B0 B1 } g7 v
1 v# h7 s( I, _* L
例如,若编码器每转产生N个脉冲,在T时间(单位s)产生m个脉冲,那么平均转速如公式所示。
7 }( c- I9 Q( E. @+ E' t2 j* d1 [! E2 [) d; v
+ I$ B7 W4 P9 R6 |' @' n& e
( C2 L0 D9 z8 c) {! w0 e- j式中 n——平均转速(r/min);
" O! W1 k0 z3 {; m) t5 t- m3 M5 v. a7 ~1 o @+ j( Y! e
T——测速采样时间(s);
$ r: A# M2 S+ u) O0 K& e* f1 m0 q8 _+ K
m——T时间内测得的编码器脉冲个数;
) G4 d% r. [6 o
9 E9 u5 k/ L! x5 R4 t+ h& tN——编码器每转脉冲数。
9 t$ g3 }# u* d5 }% O, j' o- \6 b: L* G$ N+ [+ Q2 X
(2)T法测速
) |; a4 r' i2 f若用M法测速,在记录时间短、速度低的时候,只能记录几个脉冲,则分辨率降低。针对该问题,目前解决方法为:可以采用输出码盘脉冲为一个时间间隔,然后用计数器记录在这段时间里高速脉冲源发出的脉冲数。即通过采集到脉冲源脉冲数来计量编码器两个脉冲时间间隔,从而估算出速度,称为T法测速(测脉冲周期),测速原理图如图所示。% e$ r6 D; u2 a" w# S; Z0 ^
: Q$ W) l: W* U9 o d6 ~6 w
8 g2 H# E3 W/ O5 `
/ A8 r: U- h2 U' W# e4 ST法测速,利用编码器产生的脉冲用作门电路的触发信号;用已知频率f的时钟信号做输入。若控制门电路在编码器脉冲上升沿到来时开始导通,再次上升沿到来时关闭,即计数器只记录一个编码器脉冲周期内的时钟脉冲个数。若在编码器相邻脉冲之间记录的脉冲时钟个数为m,那么,可以计算两个编码器脉冲的时间间隔为m /f;若编码器每转有N个线脉冲输出,那么我们就知道编码器转过1/N转时需要时间m /f。据此,可计算与编码器同轴转速为公式所示。3 a9 h% x) b$ ?/ C; H" Y
( ]! W8 T+ h7 M; {" U* [+ m0 u _
# i! i" S& ^" `; U& ]
% V: @" q7 l- k# @" c式中 n——平均转速(r/min);# `7 f: q" {+ R- s3 y( Y5 B9 n! U
# E; A& ?, t) X4 k/ r, B0 `
f——时钟脉冲频率(个/s);
; d: d y4 ^/ I4 D2 M* d v/ S( S' b2 ]9 L# C" b" ?' a. s
m——两个编码器脉冲之间的时钟脉冲个数;- _' y0 ]+ O4 b1 k9 h* H& f1 ]- k* C
1 |" h9 X8 r( qN——编码器每转脉冲数。
. Q: ]: l, j$ I# @: |7 s4 ~& d% L1 l ]
编码器一般会输出两路信号,分别称为A相和B相,它们相差90°,因此编码器也称为十字码盘,通过捕获两路输出信号可以测算出电机的转速和转向。, l& x0 K) f+ u- R; b0 Z
. F: D9 P" S U$ j5 _( E- @STM32使用编码器的方法有两种分别是外部中断法和输入捕获法,这两种方法都属于M法测速,两种方法比较来说外部中断法占用CPU资源较多,平时比较常用的是输入捕获法,但博主两种方法都调试出来了,因此记录下来跟大家分享一下。2 D. o: R! L8 b( i% o
4 E. j3 p3 {& C( T* a, \* u二、外部中断法测速
! w0 ^8 w( h: n+ A! n对于外部中断的知识,各个讲STM32的教程都有,我就不过多赘述,外部中断的初始化都一样,主要是出发外部中断时需要进行的操作。8 Z3 f- e3 t8 t# ?5 T7 w
' Q; [9 `/ d- r& D7 N3 Q# S2 s i
0 F+ C/ M7 U9 R: n$ I$ @ P5 H
" J7 N5 V0 w2 F% }/ @( ~( Q 看这张图,正转方向是信号向右走,因为我们是同时捕获两路信号,有以下几种情况:0 D5 c7 f: |( _+ }1 D
: q+ |, ?- P% L, C5 k
7 U. R. T3 `( ^7 j2 C
. ~9 C2 I6 [+ U; a9 r& R7 H7 Z+ K然后我们设置两个变量用来存储捕获的脉冲数,每捕获到一次脉冲信号根据上表进行判断,正转时使其加1;反转时使其减1;然后配置一个定时器,每隔一段时间反馈一次测速值。% w- @; p/ j: A8 s* z
7 J) H- p0 A8 q# ^
1.外部中断配置
4 l4 _8 `, x; q$ n7 p7 h" y先编写一个函数初始化外部中断,使用PB12-15引脚复用为外部中断输入,外部中断配置步骤如下:
J" q C& R! a8 W5 {! v. O4 R! @. P I S$ r. J
端口初始化:RCC_APB2PeriphClockCmd()、GPIO_Init()0 }2 H# g. E- @
使能复用功能时钟:RCC_APB2PeriphClockCmd()% d/ k# g/ r) i5 V9 z, x, f, C
设置IO口与中断线的映射关系:GPIO_EXTILineConfig()
* @, e2 B$ N' t' V初始化线上中断:EXTI_Init()
2 P1 G' `, n! v1 Q* v, H. A' A- @; u配置中断分组:NVIC_Init(), s' P T) L! v L3 R7 F; }; o
完整函数如下:
4 `) q. m5 p5 S, L
' A$ `% G3 B- h# Z6 |( {! r- /**************************************************************************
0 J2 h% C; s- B8 g1 m - 功能:应用外部中断方式采集编码器数据,使用M法测速反馈车轮实时速度7 k3 a4 \: Y: T: s8 D) `
- 函数:Encoder_EXTIX_Init(void) EXTI15_10_IRQHandler(void)2 X+ z3 u( o$ I( P- j% |+ q
- 作者:K.Fire
* f5 Q5 u) T4 ] - 日期:2022.01.307 p1 {$ R3 C! a, o5 H! _
- 引脚:PB12(左轮A相) PB13(左轮B相) PB14(右轮A相) PB15(右轮B相)
7 i& _% J7 M9 i - 参数:void
% L) d/ S+ Y! j - *************************************************************************/
5 g. v5 F. h% p- u( W+ b - 4 j- T& H5 N* \* K1 }
- int Encoder_L_EXTI=0;1 L+ i1 q, J: S$ J) W: _
- int Encoder_R_EXTI=0;9 {: O5 u9 G7 E. V
- 4 O' ^- i) E: q- w
- void Encoder_EXTIX_Init(void)) }, u7 B# o* i' v- R
- {
; y N o' Y3 S, z3 h* U! S - //1.端口初始化
, @0 F. N `5 t% ~; d3 s - RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB,ENABLE);
' a: g) z* J# M2 P/ X - GPIO_InitTypeDef GPIO_InitStruct;
5 F# c2 m2 A2 ]/ f9 ]. F - GPIO_InitStruct.GPIO_Mode = GPIO_Mode_IPD;- t' W- j8 c1 C1 l& u
- GPIO_InitStruct.GPIO_Pin = GPIO_Pin_12 | GPIO_Pin_13 |GPIO_Pin_14 | GPIO_Pin_15;
$ {6 b* L1 y0 x) u, u -
/ K, [ g: ]) d8 K5 j. j - GPIO_Init(GPIOB,&GPIO_InitStruct);) m" T$ f; @+ ]! s8 c0 ?8 z
-
; O* j& M8 d7 A- T9 J$ s* j8 E& k- Y - //2.使能复用功能时钟3 C* I9 {( o/ D, d
- RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO,ENABLE);
( s: K4 U, _6 Y
; x2 [8 C/ x" V! B0 W- //3.设置IO口与中断线的映射关系1 t6 v2 \0 X& C% Q+ u7 F0 A
- GPIO_EXTILineConfig(GPIO_PortSourceGPIOB,GPIO_PinSource12);
: s/ K! i1 z% A4 q" B$ V& K - GPIO_EXTILineConfig(GPIO_PortSourceGPIOB,GPIO_PinSource13);* O4 U& S* J* z1 @
- GPIO_EXTILineConfig(GPIO_PortSourceGPIOB,GPIO_PinSource14);, X# H7 u3 e* B1 b7 P7 E { O
- GPIO_EXTILineConfig(GPIO_PortSourceGPIOB,GPIO_PinSource15);
" ?/ {' U& i3 j- | - / C" I/ k; j$ G7 e
- //4.初始化线上中断
$ O( [! `3 s) j( i - EXTI_InitTypeDef EXTI_InitStruct;
2 _1 c, {/ f+ A0 F) l. u L - EXTI_InitStruct.EXTI_Line = EXTI_Line12 | EXTI_Line13 | EXTI_Line14 | EXTI_Line15;8 X7 P/ I9 u! f, J8 a x" C4 Y
- EXTI_InitStruct.EXTI_LineCmd = ENABLE;/ U! R8 B |6 i) ~0 q
- EXTI_InitStruct.EXTI_Mode = EXTI_Mode_Interrupt;" r- B' u8 r8 W. [/ s+ P
- EXTI_InitStruct.EXTI_Trigger = EXTI_Trigger_Rising_Falling;//跳变沿触发
2 J }+ T! u- T0 x - EXTI_Init(&EXTI_InitStruct);
1 W( K! O! a5 }6 U( D6 v0 j: C -
9 E9 Z0 K, W+ ?7 |) d% o+ N9 D - //5.配置中断分组
% L& @2 }3 ]% X - NVIC_InitTypeDef NVIC_InitStruct;
. s* z( u0 g8 w - NVIC_InitStruct.NVIC_IRQChannel = EXTI15_10_IRQn;8 H: S7 c4 T% N* @: `+ F; [) F
- NVIC_InitStruct.NVIC_IRQChannelCmd = ENABLE;7 j, S+ A7 ^. y
- NVIC_InitStruct.NVIC_IRQChannelPreemptionPriority = 1;% B8 N, J6 g0 o, b& n
- NVIC_InitStruct.NVIC_IRQChannelSubPriority = 0;
5 P$ G; ?' O# Q( B/ ?+ } - NVIC_Init(&NVIC_InitStruct);/ V3 V0 i/ b8 Y+ q7 g/ G, h
- 4 H( w! j0 {- c
- ' ?/ N' C2 o# [' i# g
- }, [3 U: M& i2 c8 y& b+ ^
复制代码 $ w) N# {+ D8 t! n9 |; J
2.外部中断服务函数& h+ l7 ?/ O& T9 B* L% b! n: V' M) T
函数的判断逻辑与上表一致,外部中断捕获判断函数如下:' Z1 u1 N" N2 e* h( b0 e
3 Q8 }2 R! V* |2 c, i3 C$ t- void EXTI15_10_IRQHandler(void)& I9 c9 W9 b; e" Y, {) ~7 q
- {# }/ c) j' F) P8 y0 H3 J
- if(EXTI_GetITStatus(EXTI_Line12) != RESET)//左轮A相 PB12
: W! M R/ A, P3 M - {' o P# p9 F" F1 F( L
- EXTI_ClearITPendingBit(EXTI_Line12); //清除LINE上的中断标志位: X$ l3 i4 Q) e- K' w
- if(PBin(12)==0) //这里判断检测到的是否是下降沿
6 g! C6 E9 G2 v+ _ - {* s& @" N w. s* K
- if(PBin(13)==0) Encoder_L_EXTI++;//B相的电平如果是低,电机就是正转加1 _8 {2 A8 w5 W5 y: W0 h0 c# T3 i
- else Encoder_L_EXTI--;//否则就是反转减19 u* k# u1 H% E+ u3 I2 C s
- }* |9 j* q" G0 R
- else //上升沿: g( l; c: \1 N: i8 A5 h0 @9 h
- { 2 @* l- p4 o' ?+ v
- if(PBin(13)==1) Encoder_L_EXTI++; //B相电平如果为高,电机就是正转加1
7 }5 m/ O+ u- q, {( ^, k; `- t - else Encoder_L_EXTI--;//否则就是反转减17 R2 R# R4 T% @ B" s5 i, a
- }
! ~8 T+ m5 L: Z- N, F& I/ p - }
, h7 S* x: q1 v2 n" u, C* z4 s - ; e C9 o6 k! c; ~
- if(EXTI_GetITStatus(EXTI_Line13) != RESET)//左轮B相 PB13
" u z6 b) D0 E! _4 q/ w, j+ c( V - {
" G- Y* ?4 H( _- t, {/ v" z - EXTI_ClearITPendingBit(EXTI_Line13); //清除LINE上的中断标志位8 M- i z; p2 i7 e8 @
- if(PBin(13)==0) //这里判断检测到的是否是下降沿1 i6 D6 {6 c( `- A3 r: ?( E8 K
- {6 G2 F. u8 S; P% L$ T
- if(PBin(12)==1) Encoder_L_EXTI++;//B相的电平如果是高,电机就是正转加1
& ~! b0 z5 V' I8 Z. X* a$ n' \ - else Encoder_L_EXTI--;//否则就是反转减1
. b9 v2 y9 J' N) P7 y5 L7 Y - }. `3 j" K; B( |: z; U8 ^
- else //上升沿% X6 K' G0 J1 E+ K/ D) r0 Z
- {
. u$ @9 `9 r' x! m3 E# l, x) X3 @ - if(PBin(12)==0) Encoder_L_EXTI++; //B相电平如果为高,电机就是正转加18 T5 F3 l# l& Y+ O+ j- L7 e
- else Encoder_L_EXTI--;//否则就是反转减1
1 M: k' @' R, L - }" _9 G" g0 Y" _+ V, b" o6 {0 l/ O5 S5 A; L
- }. q( ^7 s& k6 |3 m. u( \% B9 s
- , t: p7 \+ C, E% O2 B
- if(EXTI_GetITStatus(EXTI_Line14) != RESET)//右轮A相 PB14
8 r. Y; C, e8 k6 a) n% T - {
* z. h# q4 M' K8 {' ^! R# Z - EXTI_ClearITPendingBit(EXTI_Line14); //清除LINE上的中断标志位 c2 U$ m+ g( k( H
- if(PBin(14)==0) //这里判断检测到的是否是下降沿& E' {# s, p: r/ o
- {9 @! j% y! d" `
- if(PBin(15)==0) Encoder_R_EXTI++;//B相的电平如果是低,电机就是正转加1
; b* }2 b! `1 b, g - else Encoder_R_EXTI--;//否则就是反转减19 X# O" V0 v$ ?' R0 ?' V2 N+ d2 ~& r
- }. R3 M! g* U# y7 y$ C4 R
- else //上升沿. y$ g) z2 @: N- x' l+ C
- { 9 H* |% F: d8 `7 l
- if(PBin(15)==1) Encoder_R_EXTI++; //B相电平如果为高,电机就是正转加1+ b: T# i* O1 M$ L% { K. b
- else Encoder_R_EXTI--;//否则就是反转减1
/ L5 c0 e. Z- }# y& C6 v% ~- M3 o - }. h& {: o- d$ O# @$ g0 T0 s
- }
0 z: J' G' p: y' E9 E* P# K - ' Z( B" D; o% L" _3 G. w: d/ p& h# Q
- if(EXTI_GetITStatus(EXTI_Line15) != RESET)//右轮B相 PB15
) Y: D b( A! a! a3 a. S+ d- H - {
2 j, ~" E- }( B$ h - EXTI_ClearITPendingBit(EXTI_Line15); //清除LINE上的中断标志位% P/ l6 q- }# n6 M" d3 l9 F
- if(PBin(15)==0) //这里判断检测到的是否是下降沿. J* x" u: n% m
- {1 a6 U3 [1 t6 P8 |2 l: \& v0 ~ e
- if(PBin(14)==1) Encoder_R_EXTI++;//A相的电平如果是高,电机就是正转加1
" U0 D# }" L k( ?% G& h - else Encoder_R_EXTI--;//否则就是反转减1
$ Q0 S) [! x9 g+ x2 B - }
- k. H( Y: c9 {# L2 j - else //上升沿$ k W2 ]8 H9 c
- {
, u" c9 W5 X" w6 v. O - if(PBin(14)==0) Encoder_R_EXTI++; //A相电平如果为低,电机就是正转加1
- h$ o( k. {7 n( x' n - else Encoder_R_EXTI--;//否则就是反转减1
. m, a0 C, g* Z+ j0 V - } w" ^' R1 C; o' Q: E9 V
- }
0 R) ?: q: P# W -
' W/ d0 `* ~9 S% K- S4 F - }
复制代码
; |# U9 L' E5 c+ @注意一下,在使用引脚时不要重复,因为Px0(x=AB..F)都是使用的同一条外部中断线(EXIT0)% x9 E! S3 ^ J/ n, o
% _8 O! b% L* C0 O( J3.读取捕获脉冲数值
% a2 ?+ n4 I4 H. J配置完定时器后,每过一段时间调用读取函数,通过公式可以计算出实际的脉冲值。
! ]' @! j' f: @8 U: T) \
$ {; N0 p$ @) Q1 C, J3 |3 P: I* w) C函数如下:* W& F) q$ x. L' q) b) k+ q3 \
# G+ q& i w7 H" t- /**************************************************************************$ O3 z. `" \2 ]9 j1 y; F/ {
- 功能:获取不同方式下的脉冲值9 F$ |7 _/ D7 K/ s! n: v) i
- 函数:int Read_Encoder(u8 TIMX)! _. H& ?' s/ t- J( N( d
- 作者:K.Fire* p0 A/ L5 x9 R3 A" z- k* f3 K; w
- 日期:2022.01.30
% R5 p' p% b' f8 N& ? - 参数:1:外部中断法左轮 2:外部中断法右轮 3:输入捕获法左轮 4:输入捕获法右轮+ U, c: x2 H9 ^; a
- **************************************************************************// H6 K6 K9 N5 m1 G6 o% e
( ^2 y: q1 M7 b- l1 D' Q5 G- int Read_Encoder(u8 TIMX). k- K- K/ h8 Z2 ^. x6 t
- {
& M" I) u6 _ x( x. q - int Encoder_TIM; ! c B' V# v" t! ?) U
- switch(TIMX)2 v, p2 k/ M* Z- [: q
- {3 l. }' r" J% Y$ r$ v5 E+ [
- case 1:Encoder_TIM=Encoder_L_EXTI; Encoder_L_EXTI=0; break;
2 z6 ]. K* Q; R* p' C8 X: i - case 2:Encoder_TIM=Encoder_R_EXTI; Encoder_R_EXTI=0; break;+ r& [" h. r* q! _
- case 3:Encoder_TIM=TIM3 -> CNT; TIM3 -> CNT=0;break; 9 k4 g8 N- l# j% m2 n7 ~ z, @
- case 4:Encoder_TIM=TIM4 -> CNT; TIM4 -> CNT=0;break;
" z$ M C$ ~7 _2 }% g+ ~9 Q - default:Encoder_TIM=0;break;7 M* ^- R0 S0 k3 Q
- }
! c! ~! K% u1 W; b. V" k7 o - return Encoder_TIM;
' S) D1 ?9 d% M1 j - }0 e7 ]4 x+ D6 c+ d# N( T8 Z
- 2 j/ y* b* T8 D+ a t
- /**************************************************************************/ @2 P4 G% t' e% a- E& C- a
- 功能:获取并打印输出实际速度值
- c5 c8 G5 w( W - 函数:void Get_SpeedNow(float* CurrentVelcity_L,float* CurrentVelcity_R)
8 O4 z/ [( N5 N" t9 S, | - 作者:K.Fire
+ Z! G" ~# Y; S8 j) T - 日期:2022.01.30+ X4 l3 S+ X; a- H3 E4 L I# Q2 h
- 参数:CurrentVelcity_L:左轮实时速度(地址) CurrentVelcity_R:右轮实时速度(地址)( {2 o( h) ?% p, N
- **************************************************************************/
% g3 B5 B4 o/ S2 D - ! Q$ V) P* y0 p) [& d0 y2 R4 p
- extern int Current_LN,Current_RN;//速度脉冲数
+ Z' ^/ l/ `2 i0 R. U, g, x: N - ) Z) |8 o, ?$ k. A: G$ r
- void Get_SpeedNow(int* CurrentVelcity_L,int* CurrentVelcity_R)
1 S: j: Q! y4 s. L+ k2 O, o5 p3 C& T - {
3 L( I+ K5 Q0 e! {, M- t% T -
$ C) E4 P2 h$ N/ Y - /*外部中断方式*/" i. R6 B2 E# T5 {
- Current_LN = Read_Encoder(1);! @, \; x: W, j" M8 C5 K' a9 k4 v
- Current_RN = Read_Encoder(2);& v5 t: Y7 }1 A" N9 n
- 1 d5 l9 O( i% a/ q% t6 M- j% i' c6 F: b
- *CurrentVelcity_L = Current_LN * MPN * 100;//计算实际速度值3 C9 c- E |$ w; x
- *CurrentVelcity_R = Current_RN * MPN * 100;
/ B5 D; i+ i# U: {5 L. |: J( [4 s -
# u1 N& `9 }: w, F$ c! Z - printf("The Current Left Wheel Velocity is: %d mm/s.\r\n",*CurrentVelcity_L);- m# [, U4 L5 ^! g8 u+ V2 y
- printf("The Current Right Wheel Velocity is: %d mm/s.\r\n",*CurrentVelcity_R);5 H! l) q1 H+ P( c1 x
- }
复制代码
6 k4 C$ @, b! n4.测试结果
# q3 V r+ Y0 \ V# y通过USART1串口向电脑输出实时速度值,结果如下:
/ P# _) f* d- s L# n0 b) r$ b3 g; v1 p- W# Z6 E* N
4 Q2 ~7 `% `. L: o+ A1 \
. U! `* w9 \- F0 G
三、输入捕获法测速$ R$ E( s6 c8 a3 \3 X
输入捕获是将TIM定时器的CHx通道配置为输入捕获模式,每捕获到一个信号会将响应定时器的CNT计数器的值加/减1,然后每隔一段时间提取并清空计数器的值就可以测算出电机的实时转速。
) L7 J$ l8 j! \8 K( _; L8 a* y3 q, x1 O7 T3 b8 A' l; V
1.输入捕获模式配置, ~2 Y8 B( ~* \0 k( m
输入捕获模式的初始化,各个STM32的教学视频都有,只是在配置编码器模式时,需要用到一个编码器模式的配置函数:TIM_EncoderInterfaceConfig()
; C& F0 o. D* f2 ~8 G
2 ]# M; ~4 y2 P6 x输入捕获模式的初始化步骤如下:
. t% ?8 T- K$ m* w* e( S使能定时器和通道对应的时钟:RCC_APB1PeriphClockCmd(); f. @/ D1 i) U0 f9 P9 _
初始化IO口:GPIO_Init()
0 _! L3 a4 `! I) ?- U8 `初始化定时器:TIM_TimeBaseInit()
% O3 Q' c, \7 H( F7 W配置编码器模式:TIM_EncoderInterfaceConfig()" r- s- P2 h0 M1 Z( V% \
初始化输入捕获通道:TIM_ICInit()
: j4 I8 O; e, A, Z, B/ T开启更新中断:TIM_ITConfig()
) o) f0 @+ m; G' A! d) U使能定时器:TIM_Cmd()
* f' ?6 c0 |# h9 ]( l; \+ Z+ a
1 G' S( I; P7 t4 t# v! @3 T1 p完整的代码如下:! I5 B1 ?0 Z# _( }2 u; [7 m
% Q$ p5 r3 h- L7 F
- /**************************************************************************
1 y- g4 I! |! n7 n - 功能:应用输入捕获方式采集编码器数据,使用M法测速反馈车轮实时速度
- R4 X4 r2 \7 M R, F$ g - 函数:void Encoder_CAP_Init()
. R: q, l4 k/ l7 X3 Q - 作者:K.Fire) [' j |- X& o5 V# Z
- 日期:2022.01.303 F$ [3 Y8 Y8 [+ f4 l* n
- 引脚:PA6(左轮A相) PA6(左轮B相) PB6(右轮A相) PB7(右轮B相)! s2 q7 g$ p" E
- 参数:无
2 P& a5 e: ~0 z, h2 r2 |' j$ F - **************************************************************************/
, s' v% ]& C) t - / L6 O! n* }/ Z7 ^. [+ V
- void Encoder_CAP_Init_L()
6 h8 T O. X* d, ]3 j - {8 H* ~: Y( i$ ^0 {4 u
- /*1.使能定时器和通道对应的时钟*/" i% c/ K# h0 c+ k& E' t D8 P, h
- RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3,ENABLE);7 V6 l0 m/ c% R% R- X: E
- RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA,ENABLE);% Z, n9 w6 i+ y) {. Z6 v
-
/ D# ]7 ~% Q4 l# N+ K - /*2.初始化IO口*/4 s. t' m$ ?+ n0 |' N
- GPIO_InitTypeDef GPIO_InitStruct;
7 s. _' I T& T! D: L8 q - GPIO_InitStruct.GPIO_Mode = GPIO_Mode_IPD;//推挽下拉输入
, C6 R6 v& m. g. s3 ]7 ^ l+ ?1 l - GPIO_InitStruct.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7;
3 K: Z( u5 {0 {! r; f8 ^: a - GPIO_Init(GPIOA,&GPIO_InitStruct);. E- W9 u" c' o% x( z
- / a- X, s. q! j$ @- h4 x Q1 d
- /*3.初始化定时器*/
% {+ _+ Q7 r) k - TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStruct; m, j. B- C/ ~- W$ E/ j" E
- TIM_TimeBaseInitStruct.TIM_ClockDivision = 0;; N# W+ f% X( g
- TIM_TimeBaseInitStruct.TIM_CounterMode = TIM_CounterMode_Up;
: T9 G9 Q& \: Y0 A - TIM_TimeBaseInitStruct.TIM_Period = 0xffff;
. A) N. k% R. I6 I* M& l$ F0 W - TIM_TimeBaseInitStruct.TIM_Prescaler = 0x0;: v' L: O' E* X+ ]" E' S
- TIM_TimeBaseInit(TIM3, &TIM_TimeBaseInitStruct);
! f* O1 g5 \# W - 2 [3 q7 s1 r% n- f0 Y9 Y/ a
- //配置编码器模式5 J6 d6 \2 k/ A8 |3 h F# `
- TIM_EncoderInterfaceConfig(TIM3,TIM_EncoderMode_TI12,TIM_ICPolarity_Rising,TIM_ICPolarity_Rising);' V1 ~9 `0 o& d
- $ d" M0 @, _. H- X
- /*4.初始化输入捕获通道*/
A1 t. h A J- W' A0 B" S - TIM_ICInitTypeDef TIM_ICInitStruct;( f# @" _. Z0 H: B1 [$ Y
- TIM_ICStructInit(&TIM_ICInitStruct);" Y- S! Z- x X9 W: F
- TIM_ICInitStruct.TIM_ICFilter = 10;//设置滤波器,重复检测10次,防止抖动,增加精度) _/ O. V$ s2 C5 S) U
- TIM_ICInit(TIM3,&TIM_ICInitStruct);3 ]. ^' A7 r3 g: }
-
|' y r2 h( n) p! r - TIM_ClearFlag(TIM3, TIM_FLAG_Update);//清除TIM的更新标志位
& D, `) h' A: [* A$ x" {& F. ~ -
2 f8 F# ^+ t, N" I( [' `+ V! f- I - /*5.开启更新中断*/4 {! I! R& g1 G8 D
- TIM_ITConfig(TIM3, TIM_IT_Update, ENABLE);
9 K2 R B# G. g$ A -
7 W# o4 o, t- O9 D! n - TIM_SetCounter(TIM3,0);//计数器置零& U9 {2 P0 K2 o- _& D! U
- TIM3->CNT = 0x7fff;( @& G3 f+ _# ~8 r
3 k4 C; p9 }) J4 _' h- J- // /*4.初始化输入捕获通道*/
+ l, E0 [& I; C2 {( u# e3 { - // TIM_ICInitTypeDef TIM_ICInitStruct;
' Z- }5 ^. g" U, L- U) n0 Z - // TIM_ICInitStruct.TIM_Channel = TIM_Channel_1 | TIM_Channel_2;//通道1和2 H' T7 `( n& x: G/ e% F% Q! U; m3 L
- // TIM_ICInitStruct.TIM_ICFilter = 10;//设置滤波器,重复检测10次,防止抖动,增加精度) \! ~& @! K+ `- L
- // TIM_ICInitStruct.TIM_ICPolarity = TIM_ICPolarity_TIM_ICPolarity_Rising;//上升沿捕获
0 L, I' F, W: K5 O - // TIM_ICInitStruct.TIM_ICPrescaler = TIM_ICPSC_DIV1;//配置输入分频,不分频: g8 O9 R1 J8 s2 E* b3 l
- // TIM_ICInitStruct.TIM_ICSelection = TIM_ICSelection_DirectTI;//不设置重映射( m1 A. T1 T. J
- // TIM_ICInit(TIM2,&TIM_ICInitStruct);* J3 `( Y; D5 g; ~
- // 4 [+ S* r+ [4 D8 W- v% X0 Z
- // /*5.开启捕获中断,并配置中断*/* a1 ?: C1 l; Q" T' g
- // TIM_ITConfig(TIM2, TIM_IT_CC1 | TIM_IT_CC2, ENABLE);- v l A8 W$ w2 }
- // # h" Y Q" h+ y2 E) F
- // NVIC_InitTypeDef NVIC_InitStruct;
6 s9 R7 |; X- ^ - // NVIC_InitStruct.NVIC_IRQChannel = TIM2_IRQn;
# K, j- j, q; J" m3 W% } - // NVIC_InitStruct.NVIC_IRQChannelCmd = ENABLE;5 p+ a# K0 D- V& `2 v' d5 j
- // NVIC_InitStruct.NVIC_IRQChannelPreemptionPriority = 1;$ v# C3 _) m, n& w; \
- // NVIC_InitStruct.NVIC_IRQChannelSubPriority = 0;0 B, B V. z2 A' i: H
- // NVIC_Init(&NVIC_InitStruct);
" f8 J+ w$ ^$ o0 v2 t! [ -
1 _6 [2 J* A- J0 s# Q - /*6.使能定时器*/; q, A) E# c* r' Z
- TIM_Cmd(TIM3,ENABLE);7 R. q) J3 X7 a) Z# n- b2 X* A( n& ^
-
8 N/ q& I$ |. r: {7 l - /*7.编写中断服务函数*/
# G# i% M+ E/ W9 @/ y. m - + ]" p! C' ^7 q! ~
- }
复制代码 $ B( x: H$ L! i6 z( a( u
3 V* w! r A& r7 i8 r4 t8 M- y1 M注释部分是当时学输入捕获时跟教程写的,不用管。' |" q. ~# R5 Q" F2 v* z5 w
: a* X+ [+ o& Q/ _. p, E一个编码器需要占用一个定时器,这里我使用的是TIM3和TIM4' [7 |* o2 n; V# R7 Z; V8 F7 \4 w4 m
: {: h' Y0 B' |( o
注意:在初始化IO口时,选择输入输出模式有点问题。
$ A: `+ G$ f' n4 R; V, P K7 a% Q5 ]9 B. p2 h7 n
我看网上有的说选择输入浮空模式、有的说选择输入上拉模式,但是我调试的时候这两种都不出结果,我改成输入下拉模式的是才调试成功,大家在实际调试过程中可以几个输入模式都试一下。, F W9 _$ r0 X. T/ v
" O! h: j' a$ D5 C- m; o
2.读取捕获脉冲数值
/ R6 k/ `: p# U1 p% v2 C! L2 b这部分和上面外部中断法的函数一样,输入3和4参数使用输入捕获方式提取计数器的值。! v2 l/ O* A- _3 s: H# X$ j0 B& y
f t: q- [8 s. C
- /**************************************************************************1 A: q3 @& X( P9 ^$ d0 b! ~ _ }# u
- 功能:获取不同方式下的脉冲值& T5 o" B- b% O, O1 _* C: R* f$ d
- 函数:int Read_Encoder(u8 TIMX)( T# ~3 Z9 f& b$ B/ v
- 作者:K.Fire
: P7 G+ a3 ^: a: i8 v - 日期:2022.01.30% o# E# `: V5 `5 }- z& h! ]
- 参数:1:外部中断法左轮 2:外部中断法右轮 3:输入捕获法左轮 4:输入捕获法右轮2 k' A; q& S8 P) q, q2 Z( ]$ h9 s
- **************************************************************************/- f& F: H; {0 f
; ~3 Q. E+ n+ U/ }! T$ @* x* i) ]- int Read_Encoder(u8 TIMX)+ a: L' d B* X8 U* l
- {
* u# m, u0 K) ~; @ - int Encoder_TIM; ; O. M! ~3 i; T p3 |$ o
- switch(TIMX)
$ J# V* b& D0 r% t - {
* Z0 X1 q- _" p/ a2 H2 K% z - case 3:Encoder_TIM=TIM3->CNT-0x7fff; TIM3->CNT=0x7fff;break;
) |, `3 t) c' F% ~ - case 4:Encoder_TIM=TIM4->CNT-0x7fff; TIM4->CNT=0x7fff;break;' `1 j) n3 h/ n m) J
- default:Encoder_TIM=0;break;
' G* J) y4 c& b2 F$ b- V; x- C: a$ p - }
. \) u9 E" d" M* H - return Encoder_TIM;1 [) N& H" H1 @/ P) i. h8 o7 f) v w
- }
' r" Q. R, d4 j3 I - & k8 i# r3 d" N5 W
- /**************************************************************************
4 c) x" C1 E) O - 功能:获取并打印输出实际速度值5 \3 s& m2 d7 c1 X; l
- 函数:void Get_SpeedNow(float* CurrentVelcity_L,float* CurrentVelcity_R)* B, f! U" N' J8 {9 r
- 作者:K.Fire
7 A1 W T) |2 F6 y8 g1 C e! U- { - 日期:2022.01.30- _, H# O4 r1 b2 k
- 参数:CurrentVelcity_L:左轮实时速度(地址) CurrentVelcity_R:右轮实时速度(地址)
& V o9 Y# C) B/ U: v- j# o - **************************************************************************/
& ~2 W* L& F% I& H/ K6 {& g
5 I3 k) }7 p% N3 |7 K- extern int Current_LN,Current_RN;//速度脉冲数( F- D- E7 v* D) }
* y8 n- U8 H( g% q) ~' ~- void Get_SpeedNow(int* CurrentVelcity_L,int* CurrentVelcity_R); W; ^2 b/ x) Y: }) U p2 N
- {
6 T; }( [$ y! z0 J) w2 y - /*输入捕获方式*/
; |. b, J8 e, V* e" } - Current_LN = -Read_Encoder(3);
3 U O; q- q# S) _" C1 a# D. { - Current_RN = Read_Encoder(4);
8 \, w# X* J& a U$ B V: r0 E - 7 E5 w" N" e! l3 i) }9 O" v
- *CurrentVelcity_L = (MPN * Current_LN * 1000 * 10)/T;//单位:mm/s
" U& b% U8 c0 E1 A3 f6 @6 k2 z! x - *CurrentVelcity_R = (MPN * Current_RN * 1000 * 10)/T;
+ V" |9 k% B; i( ~$ v6 H) f3 J - 0 S M9 {/ _' J1 ~5 A/ D, X/ z
- printf("The Current Left Wheel Velocity is: %d mm/s.\r\n",*CurrentVelcity_L);
3 b8 r+ r. m/ J: G0 U& L7 v$ X - printf("The Current Right Wheel Velocity is: %d mm/s.\r\n",*CurrentVelcity_R);
3 }4 e/ f' ?3 }! Z' b: G -
3 c; w: I9 w+ V7 E0 v/ O9 ^ - }
复制代码 1 ?+ D0 R/ u+ s8 Y* V
3.测试结果+ c+ P; l- D. o. P% F, Y
/ t8 ]7 e, [- U" i. l( O; ?
0 N# h: ? {: W2 [0 f9 a: C
4 j; c' K( v, Z5 F9 Q 测试结果略有误差...
3 U( i" V! D5 i4 `$ r5 D5 Q4 }# Q8 g4 {5 T! A
程序源代码在此
6 J/ [" [* u/ Y% K# g. N. P9 y& c/ ^1 N3 B/ g) k) H0 _% x
总结( _$ }; r) @0 p: _* G) l
注意:左轮电机和右轮电机是相反的,需要实际测试确定,比如我这里,向前走的时候,右轮是正转,这时左轮反转的时候才是前进,在编写程序时需要给左轮的脉冲值加个负号。# z+ h9 p$ E2 \, }' x
$ G( D/ k. M7 C; m8 k- n# W获取到了实时速度值后,就可以用PID算法对电机转速进行准确控制了。9 h: B' j* d" J! {4 _
: E; w+ S0 r% @' h B4 `4 [% f
% u4 J. P% I( e. o ~
# l' Q$ z3 U9 n: ? |