時(shí)間:2018-05-21 17:15:21來(lái)源:網(wǎng)絡(luò)轉(zhuǎn)載
車輪位置的確定是在制作小車的過(guò)程中必不可少的部件,好在STM32中包含了硬件的編碼器。但使用的過(guò)程中卻存在諸多不方便。下面由我一一道來(lái):
1、編碼器原理
什么是正交?如果兩個(gè)信號(hào)相位相差90度,則這兩個(gè)信號(hào)稱為正交。由于兩個(gè)信號(hào)相差90度,因此可以根據(jù)兩個(gè)信號(hào)哪個(gè)先哪個(gè)后來(lái)判斷方向、根據(jù)每個(gè)信號(hào)脈沖數(shù)量的多少及整個(gè)編碼輪的周長(zhǎng)就可以算出當(dāng)前行走的距離、如果再加上定時(shí)器的話還可以計(jì)算出速度。
2、為什么要用編碼器
從上圖可以看出,由于TI,T2一前一后有個(gè)90度的相位差,所以當(dāng)出現(xiàn)這個(gè)相位差時(shí)就表示輪子旋轉(zhuǎn)了一個(gè)角度。但有人會(huì)問(wèn)了:既然都是脈沖,為什么不用普通IO中斷?實(shí)際上如果是輪子一直正常旋轉(zhuǎn)當(dāng)然沒(méi)有問(wèn)題。仔細(xì)觀察上圖,如果出現(xiàn)了毛刺呢?這就是需要我們?cè)谲浖芯帉?xiě)算法進(jìn)行改正。于是,我們就會(huì)想到如果有個(gè)硬件能夠處理這種情況那不是挺好嗎?
3、STM32編碼器
還是剛才那張圖,但這時(shí)候我們看到STM32的硬件編碼器還是很智能的,當(dāng)T1,T2脈沖是連續(xù)產(chǎn)生的時(shí)候計(jì)數(shù)器加一或減一一次,而當(dāng)某個(gè)接口產(chǎn)生了毛刺或抖動(dòng),則計(jì)數(shù)器計(jì)數(shù)不變,也就是說(shuō)該接口能夠容許抖動(dòng)。在STM32中,編碼器使用的是定時(shí)器接口,通過(guò)數(shù)據(jù)手冊(cè)可知,定時(shí)器1,2,3,4,5和8有編碼器的功能,而其他沒(méi)有。編碼器輸入信號(hào)TI1,TI2經(jīng)過(guò)輸入濾波,邊沿檢測(cè)產(chǎn)生TI1FP1,TI2FP2接到編碼器模塊,通過(guò)配置編碼器的工作模式,即可以對(duì)編碼器進(jìn)行正向/反向計(jì)數(shù)。如果用的是定時(shí)器3,則對(duì)應(yīng)的引腳是在PA6和PA7上。根據(jù)stmn32手冊(cè)上編碼器模式的說(shuō)明,有6中組合計(jì)數(shù)方式,見(jiàn)下表。
由此可知,通過(guò)選擇可以確定使用定時(shí)器的哪種方式來(lái)得到我們所要的結(jié)果。STM32編碼器的使用也非常簡(jiǎn)單,其基本步驟和開(kāi)發(fā)STM32其他部件的操作一致,都是打開(kāi)時(shí)鐘,配置接口,配置模式,如果要用中斷則打開(kāi)中斷。具體可以參考以下代碼(這里使用的是TIM4,引腳采用GPIOA11和GPIOA12):
4、編碼器的中斷
由于編碼器是基于定時(shí)器的,所以編碼器的中斷實(shí)際上就是定時(shí)器的中斷啦。也就是說(shuō)定時(shí)器是每隔一定時(shí)間加一個(gè)數(shù)(或減一個(gè)數(shù)),當(dāng)數(shù)到達(dá)預(yù)設(shè)值時(shí)就產(chǎn)生中斷,而編碼器是每一個(gè)有效脈沖就加一個(gè)數(shù)(或減一個(gè)數(shù)),當(dāng)數(shù)到達(dá)預(yù)設(shè)值時(shí)就產(chǎn)生中斷。若預(yù)設(shè)值為1000則編碼器與定時(shí)器中斷不同的是,當(dāng)編碼器反轉(zhuǎn)時(shí)值到達(dá)999產(chǎn)生一次中斷,而當(dāng)編碼器正轉(zhuǎn)到達(dá)0時(shí)同樣產(chǎn)生一次中斷。在硬件上這兩個(gè)中斷是沒(méi)法區(qū)分的,這也就造成了有種情況的誤判。
5、STM32編碼器沒(méi)有考慮的情況
想象一下,如果編碼器的預(yù)設(shè)值為1000,當(dāng)某次我們使得編碼器正轉(zhuǎn)產(chǎn)生中斷后,立即反轉(zhuǎn)則又該怎么辦呢?根據(jù)上面的說(shuō)法,這時(shí)候會(huì)產(chǎn)生兩次一樣的中斷。如果在算法上沒(méi)有處理的話,極有可能認(rèn)為是行走了兩次正向。但實(shí)際上并沒(méi)有。所以這個(gè)時(shí)候必須結(jié)合方向來(lái)判斷行走的情況(判斷方向使用的是DIR寄存器位)或者在產(chǎn)生中斷后讀一次count寄存器位(看看是999還是0,以此來(lái)判斷當(dāng)前的方向)。只有上一次為正且這一次同樣為正,距離才是相加的。
具體中斷處理函數(shù)代碼如下:
6、最后一個(gè)問(wèn)題
那么如果當(dāng)前并沒(méi)有到一個(gè)中斷怎么辦?難道這個(gè)時(shí)候就不能得到編碼器的精確位置了嗎?
其實(shí)只是個(gè)非常簡(jiǎn)單的算法:
每次把中斷的次數(shù)記錄下來(lái),然后再把距離上次中斷共走了多少個(gè)脈沖,再把兩者相加即可。
標(biāo)簽:
中國(guó)傳動(dòng)網(wǎng)版權(quán)與免責(zé)聲明:凡本網(wǎng)注明[來(lái)源:中國(guó)傳動(dòng)網(wǎng)]的所有文字、圖片、音視和視頻文件,版權(quán)均為中國(guó)傳動(dòng)網(wǎng)(www.wangxinlc.cn)獨(dú)家所有。如需轉(zhuǎn)載請(qǐng)與0755-82949061聯(lián)系。任何媒體、網(wǎng)站或個(gè)人轉(zhuǎn)載使用時(shí)須注明來(lái)源“中國(guó)傳動(dòng)網(wǎng)”,違反者本網(wǎng)將追究其法律責(zé)任。
本網(wǎng)轉(zhuǎn)載并注明其他來(lái)源的稿件,均來(lái)自互聯(lián)網(wǎng)或業(yè)內(nèi)投稿人士,版權(quán)屬于原版權(quán)人。轉(zhuǎn)載請(qǐng)保留稿件來(lái)源及作者,禁止擅自篡改,違者自負(fù)版權(quán)法律責(zé)任。
產(chǎn)品新聞
更多>2025-04-30
性能躍升20%!維宏NK300CX Plus數(shù)控系統(tǒng)...
2025-04-11
rpi-image-gen:樹(shù)莓派軟件鏡像構(gòu)建的終...
2025-04-08
【產(chǎn)品解讀】全面提升精密制造檢測(cè)節(jié)拍...
2025-03-31
激光閃耀 智慧引領(lǐng) | WISE MASER 黑武士...
2025-03-20