芯圣SH79F1611做一个小电机测速板,霍尔信号单路进外部中断。转速范围30到6000rpm,用测周期法比计频法更准,但低速时要处理定时器溢出,记录一下做法。
一、为什么选测周期法
测频法(固定1s计数脉冲)在低速时只有一个脉冲甚至没有,误差极大;测周期法测两个脉冲之间的时间,低速时时间长、分辨率高。所以用捕获两次上升沿之间的定时器计数差算转速。
二、双沿与消抖
SH79F1611的外部中断可配上升沿/下降沿/双沿。单路霍尔信号用双沿可以把分辨率提高一倍(每转的脉冲数×2)。但磁钢经过时信号有抖动,中断里先关中断、延时几十微秒再开,或者用软件计数+最小间隔门限(小于200us的边沿忽略)来滤毛刺。
三、定时器溢出的处理
16位定时器在fSYS/12下约5.5ms就溢出,30rpm时一转要2秒,必然多次溢出。中断里累加溢出次数,用 (溢出次数×65536 + 当前计数值) 的形式拼成32位时间戳,减法得到间隔。注意读CNT和溢出次数之间存在竞争:先读溢出次数,再读CNT,再读一次溢出次数,若两次不同则重读。
四、转速计算
转速 = 60 × f_timer / (间隔计数 × 每转脉冲数×2)。整数运算即可,用移位代替除法以免引入浮点库。低速用间隔测速,高速(>3000rpm)切回固定窗口计脉冲,做区间切换。
五、踩坑记录
1)忘记关WDT导致的看门狗复位,测速时看不出但会随机清零;2)中断里做除法耗时太长,导致漏沿,把计算挪到主循环;3)信号线长时加不了RC滤波(会延迟边沿),改用软件门限或施密特整形;4)示波器测得信号干净但读数跳,最后发现是地线问题,共地后正常。
六、效果
30rpm时误差小于0.5rpm,6000rpm时小于15rpm,整体响应时间约100ms,满足风机控制需求。
供参考,欢迎交流低速测速的实现方式。
|
|