基于STM32F407的直流減速電機帶編碼器方案

基于STM32F407的直流減速電機編碼器方案

首先，什么是編碼器？

編碼器是將信號或數(shù)據(jù)進行編制、轉(zhuǎn)換為可用以通訊、傳輸和存儲的信號形式的設(shè)備。在這里，編碼器就是能夠?qū)㈦姍C的轉(zhuǎn)動信息（比如轉(zhuǎn)速、轉(zhuǎn)動角度等）轉(zhuǎn)換為脈沖信號的設(shè)備。按照原理可分為（常見的）光電編碼器（光學式）和霍爾編碼器（磁式）。

編碼器的作用以及為什么要用編碼器？

如上所述，編碼器能夠?qū)㈦姍C的機械幾何位移轉(zhuǎn)化為脈沖信號或數(shù)字量。也就是說，有了編碼器，我們通過檢測編碼器輸出的脈沖信號，就能獲取電機轉(zhuǎn)動角度、轉(zhuǎn)速等相關(guān)信息。這樣我們不但能定性的控制電機的轉(zhuǎn)向、轉(zhuǎn)速，還能定量的測量。

編碼器的原理是什么以及怎么運用呢？

簡單來說，就是電機帶動碼盤轉(zhuǎn)動，碼盤的結(jié)構(gòu)使得當電機在轉(zhuǎn)動時會產(chǎn)生A、B兩相的脈沖信號，且這兩路脈沖信號的相位差為90度（即正交）。如下圖：



由于A、B信號正交，因此可以根據(jù)兩個信號哪個先哪個后來判斷方向，根據(jù)每個信號脈沖數(shù)量的多少及每圈電機產(chǎn)生多少脈沖數(shù)就可以算出當前行走的距離，如果再加上定時器的話還可以計算出速度。

好了，現(xiàn)在我們的處境是，我們有一個帶編碼器的直流減速電機，我們知道當電機轉(zhuǎn)動的時候，它會產(chǎn)生A、B兩相正交脈沖信號，通過檢測脈沖信號我們就可以獲取電機的運動狀況。

我們通過什么手段來檢測脈沖數(shù)呢？

其中一種思路是，我們通過定時器的輸入捕獲或者GPIO引腳的外部中斷來檢測邊沿變化，以此來檢測脈沖數(shù)。這方法好像沒毛病，當電機正常運轉(zhuǎn)時行得通。但是如果電機輸出的脈沖信號出現(xiàn)了毛刺呢？這樣誤差就來了，怎么辦？通過軟件編寫算法來濾去毛刺似乎有點困難，于是我們想到通過硬件來處理這個毛刺。（而STM32正好有硬件編碼器，nice?。?br />
這里的脈沖輸入是一種特殊的輸入捕獲情況，因此stm32專門在定時器中提供了編碼器模式，可大大簡化解析過程。

STM32的編碼器接口模式

在該模式下能計算電機輸出脈沖信號的個數(shù)，且stm32根據(jù)其內(nèi)部機制能夠消除毛刺的干擾。

配置過程：

由于編碼器接口模式是一種特殊的輸入捕獲，所以要先配置一下輸入捕獲（畢竟你要通過捕獲邊沿來檢測脈沖）。在輸入捕獲過程中，我們把A6、A7復用為TIM3，作為輸入捕獲的引腳，對電機的A、B相脈沖進行輸入捕獲。

輸入捕獲配置完成之后再配置一下編碼器模式就可以開始工作了。

于是緊接著我們來看看編碼器模式的配置函數(shù)TIM_EncoderInterfaceConfig：



其輸入?yún)?shù)中，TIMx就是輸入捕獲時設(shè)置的TIM3，polarity就分別是TI1和TI2的捕獲極性（TI1是定時器輸入通道1，TI2同理），即A、B兩相信號的捕獲極性（上升沿捕獲或者下降沿捕獲），重點來說說編碼器的模式TIM_EncoderMode：

當模式選為TIM_EncoderMode_TI1時，計數(shù)器僅在TI1的邊沿處計數(shù)

當模式選為TIM_EncoderMode_TI2時，計數(shù)器僅在TI2的邊沿處計數(shù)

當模式選為TIM_EncoderMode_TI12時，計數(shù)器在TI1和TI2邊沿處均計數(shù)

也就是說，模式1，我只以A相的脈沖信號為我的檢測信號，TI2我就不管了。（B只是相對A滯后了90度，其它都是一樣的，所以檢測A就夠了）。其它同理。

模式1和模式2顯然就沒什么差別了，那模式3前者有何不同呢？

這就涉及到網(wǎng)友們所說的編碼器軟件四倍頻技術(shù)了：

如圖，A、B兩相正交信號，如果根據(jù)模式1或模式2對脈沖信號進行檢測，假設(shè)我們上升沿捕獲一次，那么圖中的信號我們只檢測到3個上升沿，也就是三個脈沖。但是如果采用模式3，對TI1和TI2檢測上升沿，那么同一段時間我們檢測到6個上升沿。如果下降沿也檢測，那么一共就是12個邊沿跳變。每個實際來的脈沖會被檢測4次，同樣是12/4=3個脈沖，但是這樣的話精度大大提高了。

入口參量：(TIM3, TIM_EncoderMode_TI12, TIM_ICPolarity_Rising ,TIM_ICPolarity_Rising);

通過這樣配置，我們就完成了編碼器軟件的初始化。通過以上配置，我們完成了TIM3輸入捕獲的初始化以及編碼器接口模式的相關(guān)配置，每來一個跳變沿，計數(shù)值變化一次。

至此，為了避免我們忘了初衷，現(xiàn)在我們來回顧一下我們最開始用編碼器的初衷，前面我們說要用編碼器來干嘛來著？獲取電機轉(zhuǎn)動角度、轉(zhuǎn)速。

現(xiàn)在的處境是，我們通過STM32的TIM3的編碼器模式，能夠測出任意時刻的脈沖值了?，F(xiàn)在要解決的就是如何將這個脈沖值轉(zhuǎn)換成我們所要得到的信息（即轉(zhuǎn)動角度、轉(zhuǎn)速）。

首先，根據(jù)帶編碼器的直流減速電機的原理，顯然無論電機的轉(zhuǎn)速如何，每轉(zhuǎn)產(chǎn)生的脈沖數(shù)是固定的。這里假設(shè)電機每轉(zhuǎn)產(chǎn)生260個脈沖（具體數(shù)據(jù)各位自行查看自己的電機參數(shù)啦），那么只要我們用‘電機已產(chǎn)生的脈沖數(shù)’除以‘260個/轉(zhuǎn)’，就可以得到電機轉(zhuǎn)了多少圈，一圈即為360度，由此便可將脈沖數(shù)和轉(zhuǎn)動角度聯(lián)系起來。

這里要注意一點，由于我們用的是編碼器模式3（也就是TIM_EncoderMode_TI12），我們得到的脈沖數(shù)是電機實際產(chǎn)生的脈沖數(shù)的四倍。則電機實際產(chǎn)生的脈沖數(shù)應為‘得到的計數(shù)值’除以4。于是，電機轉(zhuǎn)動圈數(shù)為脈沖數(shù)除以260再除以4。

轉(zhuǎn)動角度算出來了，轉(zhuǎn)速呢？則是根據(jù)計數(shù)方向（遞增計數(shù)或遞減計數(shù)）來判斷的，所以我們接下來的工作就是要搞清楚計數(shù)方向和編碼器信號的關(guān)系。

讓我們來看一下STM32的中文參考手冊:



網(wǎng)上幾乎在這張表的講解上都是一帶而過，真正能把這張表講清楚的幾乎沒有。后來看到一個人在表格上做了類似上圖的注釋，我才終于搞懂了。

大家還記得我們前面提到的TIM_EncoderInterfaceConfig函數(shù)嗎，里面有個參量就是選擇模式的，對吧。讓我們再來回顧一下：

注意到各模式后面的“xx edge depending on xx level”了嗎？這就是上面這個表里的第二縱列所提到的“相反信號的電平”。

TIM_EncoderMode_TI1: Counter counts on TI1FP1 edge depending on TI2FP2 level，意思就是當選擇模式1時，計數(shù)器根據(jù)TI2的電平高低來記錄TI1的邊沿信號。

這樣說可能不好理解，我們來舉個具體的例子：



如上圖，電機轉(zhuǎn)動時產(chǎn)生A、B兩相信號通過TI1、TI2輸入到TIM3。

假設(shè)我們選擇的是模式1，即計數(shù)器僅在TI1的邊沿處計數(shù)。我們觀察TI1的上升沿，若此時對應的TI2信號處于低電平（下圖紅框），于是根據(jù)表格我們可以得到計數(shù)方向為遞增，假設(shè)計數(shù)器遞增時電機正向轉(zhuǎn)動，則可判斷此時電機正轉(zhuǎn)。



再譬如，假設(shè)我們選擇模式2，即計數(shù)器僅在TI2的邊沿處計數(shù)。我們觀察TI2的下降沿，若此時對應的TI1信號為高電平（下圖藍框），于是根據(jù)表格我們可以得到計數(shù)方向為遞減，假設(shè)計數(shù)器遞減時電機反向轉(zhuǎn)動，則可判斷此時電機反轉(zhuǎn)。



也就是說，當以TI1為計數(shù)信號時，需要根據(jù)TI2的電平（也就是第二縱列的“相對信號的電平”）來進行判斷是向上計數(shù)還是向下計數(shù)。TI2也同理。

e.g.如果“僅在TI1計數(shù)”，當TI1為“上升”沿（表中第三縱列），此時要根據(jù)TI2的電平來做判斷。根據(jù)下圖，可知當TI1為上升沿的時候TI2為低電平，則根據(jù)上表可得知計數(shù)器為向上計數(shù)。這在下圖得到了驗證。



再例如，如果“僅在TI2計數(shù)”時，當TI2為下降沿時，如果TI1為低電平，則為向上計數(shù)（上圖左側(cè)）；當TI2為下降沿時，如果TI1為高電平，則為向下計數(shù)（上圖中部）；當TI2為上升沿時，如果TI1為高電平，則為向上計數(shù)（上圖左部）；當TI2為上升沿時，如果TI1為低電平，則為向下計數(shù)（圖中中部）；
至此為止，我們便實現(xiàn)了這樣的操作：通過使用帶編碼器的直流減速電機產(chǎn)生正交脈沖，通過STM32的TIM的編碼器模式對脈沖進行計數(shù)，根據(jù)計數(shù)方向和編碼器信號的關(guān)系來判斷電機轉(zhuǎn)動方向，利用脈沖計數(shù)值來計算電機轉(zhuǎn)動位移。

接下來是代碼部分，有些容易讓人迷惑的地方：

輸入捕獲初始化時Period和Prescaler的作用：

這里的period即為計數(shù)器的重裝載值，prescaler即為預分頻系數(shù)。注意在編碼器模式時，要把TIM理解為計數(shù)器，而不是定時器，這樣的話，時鐘信號就不是系統(tǒng)內(nèi)部產(chǎn)生的，而是通過PA6、PA7輸入到TIM3的TI1和TI2的。

有了這么個理解，再來看Period和Prescaler就不難理解了。Period就是計數(shù)器每一次能檢測脈沖的最大值，每來一個脈沖計數(shù)值就加一，當計數(shù)值超過period就溢出中斷。Prescaler就是對電機產(chǎn)生的脈沖信號進行分頻的分頻系數(shù)。比如當分頻系數(shù)為2時，每當電機產(chǎn)生兩個脈沖，stm32才認為接收到一個有效脈沖，計數(shù)值才加一。

了解更多編碼器相關(guān)知識，敬請關(guān)注西安德伍拓自動化傳動系統(tǒng)有限公司網(wǎng)站。公司技術(shù)團隊為您免費提供編碼器的選型、安裝、調(diào)試、保養(yǎng)等技術(shù)指導服務，盡量避免企業(yè)因為編碼器技術(shù)人員的短缺帶來的損失，采取“線上+線下”服務的服務形式，幫助企業(yè)解決技術(shù)難題。