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

实战经验 | 在STM32中实现电机测速的方法介绍

[复制链接]
STMCU-管管 发布时间:2025-3-6 16:16
01 电机测速方法介绍, h; C; }& m3 o5 o& ]
3 `. r) ?" D1 w$ h3 Q8 F
' B7 H9 }% }/ m1 r
在电机控制类应用中,经常会需要对电机转速进行检测,测速常用的方式有M法测速和T法测速。1 ]# ?7 u; p0 Z+ v( j4 G
M法测速是利用在规定时间Ts内编码器输出脉冲数量M1计算电机转速,如下图所示,信号A和B为正交编码器的输出信号,C解码后的计数脉冲(4x)。
( G: n' @& i9 `  T* @, u  n4 c
13.png
▲ 图1. M法测速原理
单位时间(1s)内编码器输出脉冲数量,即脉冲频率:8 d% j4 Q- L' G9 Z( N
14.png
假设电机每旋转一圈正交编码器(4x)的输出脉冲数量为Z,则电机转速为(r/min 代表圈/分钟):
5 b, F9 ]2 e' T. s
15.png
M法测速的分辨率为:* x; ^, P, R: W0 n
16.png
M法测速的误差率为:
) m& Z' h+ }6 [3 k- ~, ?
17.png
由上可知,M法测速的分辨率与速度无关,要提高分辨率,即减小Q值,必须增大编码器每圈输出的脉冲个数Z,或者增大采样周期Ts。M法测速误差率与测定时间内的脉冲数量成反比关系,转速越高M1值越大,当转速很低时,M1值很小,误差率会变大,因此M法适合高速测量。. ?0 I$ }( j& V: L/ R5 y! Z* S
T法测速是测量编码器输出两个脉冲之间的间隔来计算转速,通过计算高频时钟脉冲数量M2来衡量编码器两个脉冲间隔的时间。6 f% w( @' |3 y$ F. v+ n$ W
18.png
▲ 图2. T法测速原理
假设高频时钟的频率为ft,那么编码器两个脉冲之间的时间:
) r' b' [6 Q9 j5 ?+ R$ |: g% w
19.png
假设电机每旋转一圈正交编码器(4x)的输出脉冲数量为Z,则电机转速为:- s3 r4 @& |, V/ j2 F- a9 w) y* Z' Y2 X8 g
20.png
T法测速的分辨率为:
$ r' k: h' {$ ^) b1 b# [
21.png
2 x# X- t7 A0 Q. l* M5 a; Y
) h! B" M% L% P9 e- c# o' H
T法测速的误差率为:
+ |0 h* z1 @: m: L
22.png
由上可知,T法测速的分辨率Q与M2相关,当转速越低时M2的值越大,Q值越小,分辨能力越强。T法测速的误差率也与M2相关,当转速越低时M2的值越大,误差率越小,因此T法测速非常适合低速测量。% \' t. e. v/ E( R* m
0 u8 J0 C! s  [4 v* e7 ]$ W4 J2 y/ \
02M法与T法测速在STM32中的实现8 ~6 J8 M  p$ a: Y* p
STM32中的很多定时器都带编码器接口,在对输入编码器信号进行计数的同时,还通过该接口可以将正交编码器的输入信号解码成脉冲输出映射到TIMx_TRGO,手册中的原文描述如下:
8 N# A6 ?; b, X2 @; _
23.png
结合上述的测速原理,在STM32中应用定时器的编码器接口完成M法测速和T法测速的方案框图如下:
: g3 j% W6 l( s) m
24.png
▲ 图3. STM32定时器测速方案框图
使用两个32bit的定时器TIM2和TIM3来处理编码器信号,TIM3的编码器接口与外部的编码器信号连接直接实现4x计数;解码后的输出映射到TIM3_TRGO,并作为TIM2的定时器捕获和复位的触发源。TIM6作为基本定时器,实现一个ms级别的中断,在中断服务程序中实现M法和T法测速的计算。) ^" E' W, f" Q6 n7 J+ y
M法测速中,在TIM6的定时中断服务程序中读取TIM3的计数值TIM3_CNT,两次连续读取值的差值即为图1种的M1,TIM6的中断定时时间即为Ts,在Z为已知固定值的情况下,根据公式(1)即可计算出转速n。1 g4 s0 {, @2 Q# i: K3 f
T法测速中,在TIM6的定时中断服务程序中读取TIM2捕获值 TIM2_CCR1(TIM3_TRGO内部连接到TIM2_CH1),TIM2_CCR1即为图2中所示的编码器连续两个输出脉冲之间的高频脉冲数量M2,TIM2的时钟频率即为ft,在 Z为已知固定值的情况下,根据公式(2)即可计算出转速n。' F& F& N9 {1 F4 V/ p6 t
( l: o& n6 ^) Y. z% v
03方案测试结果2 N8 l# a, N0 H% }& t& q2 k1 ]
基于以上的方案,通过定时器模拟生成编码器输出信号A和B,分别的高速和低速情况下进行模拟测试,结果如下,图中Speed_M_Ref和Speed_T_Ref为速度参考值,Speed_M和Speed_T为测试结果值。
. p+ F0 G5 N$ @) q' W/ i高速M法测试结果(1460rpm~2920rpm):
1 ?1 Q2 p7 Z6 u. a
25.png
高速T法测试结果(1460rpm~2920rpm):
( U" ?5 ?! {- ~  i6 k
26.png
中速M法测试结果(146rpm~292rpm):
; v0 o( p8 K5 p8 o0 I
27.png
中速T法测试结果(146rpm~292rpm):( v. V/ s  }1 G. [* a  i2 X
28.png

9 R' A& P9 Z1 q/ f4 k, ]. n

7 ?7 v1 H. O+ E! D5 v8 \低速M法测试结果(19rpm~35rpm):
9 B: Y" m( A) u  a& G2 p
29.png
低速T法测试结果(19rpm~35rpm):, R7 z5 \4 q5 H& ]' O9 V4 C/ Y
30.png
04 小结# W7 C8 q' \! }, o! t1 s# q
本文简单介绍了电机控制中M法和T法测速的原理,给出了在STM32中如何利用定时器的编码器接口和多个定时器合作的方式实现两种测速的方案,并对方案进行了模拟测试,给出测试结果,高速下M法的效果更好,在低速情况下M法测速偏差大,T法测速更适合低速测速。
6 m; i& A& q' F% p4 i& H5 P▼▼▼
# ~. C2 C* n% h7 b5 x下载《在STM32中实现电机测速的方法介绍》原文档。
- t6 o1 r2 P# P0 ~: n LAT1447_电机测速方法以及在STM32中的实现v1.0.pdf (805.66 KB, 下载次数: 33)
赞 1 收藏 1 评论0 发布时间:2025-3-6 16:16

举报

0个回答

所属标签

相似技术帖

官网相关资源

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