詳解幾種常用的測量角度速度的方法原理

1.提出問題

提問： 那么，對于動(dòng)力過剩的B車，是否可以通過測量反電動(dòng)勢的方法，不用編碼器獲得電機(jī)的轉(zhuǎn)速呢？

提問： 卓大大，三輪車可以用編碼器測速嗎？還是只能用光電編碼盤？？

提問： 親愛的卓大大，給你問聲好，這個(gè)新車模的迷你編碼器好貴呀！215一個(gè)啥時(shí)候有空能否揮一揮你飄逸的手法，寫一個(gè)推文，把一些好的測速方法講講。 我們自己掏錢買東西好貴喲，我是很熱愛這個(gè)比賽的孩子！你看新F車模和C車模給的安裝孔都是那種小型迷你編碼器的安裝形式，一般的大的都放不下去?，F(xiàn)在又想做車又想搞事情又想節(jié)約錢，哎，是真的煩呀。

各式各樣的直流電機(jī)

上面三個(gè)問題雖然不是在同一天提到的，反映了同學(xué)們對于反饋控制中測量環(huán)節(jié)的重視。需要在眾多方案中選擇一個(gè)性價(jià)比最好的方案。

2、基本原理

角速度度測量時(shí)空間物體運(yùn)動(dòng)（平動(dòng)、轉(zhuǎn)動(dòng)）參數(shù)測量的重要一方面，是衡量和控制電機(jī)運(yùn)動(dòng)的最重要的參數(shù)。根據(jù)角度、角速度、角加速度之間的微分關(guān)系，任何能夠測量角度、角加速的方法都可以用于測量角速度。

角度、角速度、角加速度之間的關(guān)系

下面介紹幾種常用的測量角度速度的方法原理。

一、使用角度傳感器測速

A. 光電碼盤：

這種形式采用在電機(jī)同軸，或者傳動(dòng)軸上安裝同步轉(zhuǎn)動(dòng)的碼盤，利用光電管檢測碼盤轉(zhuǎn)動(dòng)，輸出與轉(zhuǎn)動(dòng)角度成正比的脈沖個(gè)數(shù)。有增量式和絕對式碼盤之分。常用到的是將碼盤與光電檢測傳感器集成在一起的傳感器，可以直接連接單片機(jī)IO口或者定時(shí)器端口。

光電編碼角度傳感器

增量式角度碼盤輸出信號包括有兩路A，B兩路正交的脈沖信號和零位Z信號，通過單片機(jī)的正交編碼定時(shí)器可以方便進(jìn)行正反轉(zhuǎn)向角度測量。對于智能車競速比賽，通常只有正向速度，所以也可以僅僅使用一路脈沖信號完成速度測量。具體測量硬件和軟件內(nèi)容以后會(huì)另文介紹。

B. 霍爾傳感器

這種角度傳感器分為兩大類，一類使用開關(guān)型霍爾傳感器，直接測量電機(jī)同軸的永磁鐵的極對數(shù)，輸出相應(yīng)的開關(guān)脈沖。另外一類是使用模擬型霍爾元器件測量電機(jī)同軸永磁鐵的磁場方向角度。

開關(guān)型霍爾速度傳感器

由于永磁鐵磁極個(gè)數(shù)無法制作很多，所以通常開關(guān)型霍爾速度傳感器需要配合著減速器來增加對于輸出角度測量精度。

使用特殊半月形圓形磁鐵與能夠測量兩個(gè)正交方向磁場強(qiáng)度的霍爾器件配合，可以計(jì)算出磁場的角度。通常這類傳感器是將霍爾器件、信號調(diào)理電路以及數(shù)字信號處理電路都集成在一起，可以直接輸出SPI、I2C等接口形式的數(shù)字角度數(shù)據(jù)。這類編碼器通?？梢赃_(dá)到每周12bit的分辨率。

模擬型霍爾角度傳感器

為了兼容光電碼盤，這類傳感器芯片還會(huì)輸出增量脈沖信號。

C.電磁感應(yīng)式

有一類采用直流發(fā)電機(jī)原理形式的感應(yīng)角速度傳感器，它直接輸出與轉(zhuǎn)速成正比的直流電壓信號。

另外一類則采用則采用同步感應(yīng)器原理的角度傳感器。

角度感應(yīng)同步器

由于電磁感應(yīng)可以獲得與位置相關(guān)的相位信息，所以這類感應(yīng)同步器比光電碼盤更高的空間分辨率。此類傳感器通常用于精密測量、機(jī)械手臂、云臺等控制方面。作為速度反饋有點(diǎn)大材小用。

二、利用電機(jī)模型測速

電機(jī)不僅可以完成電能向轉(zhuǎn)動(dòng)機(jī)械能的轉(zhuǎn)換，也可以反過來當(dāng)做發(fā)電機(jī)將機(jī)械能轉(zhuǎn)換成電能。對于小型直流電機(jī)，它發(fā)出的電壓與轉(zhuǎn)速成正比。因此，電機(jī)本身是可以同時(shí)當(dāng)做換能器和速度傳感器的。

電機(jī)轉(zhuǎn)動(dòng)產(chǎn)生感應(yīng)電動(dòng)勢

下面圖對使用H橋電路驅(qū)動(dòng)小型直流電機(jī)電路進(jìn)行了簡化。其中E是H橋電路輸出PWM電壓的等效直流電壓。Re，Rm分別是H橋電路的內(nèi)阻、電機(jī)等效串聯(lián)電阻。Lm是電機(jī)電樞的電感，這個(gè)電感相對比較小，電機(jī)轉(zhuǎn)動(dòng)慣性環(huán)節(jié)來講，它所造成的電流過渡過程可以忽略。Um是電機(jī)轉(zhuǎn)動(dòng)后的感應(yīng)電動(dòng)勢，它近似于電機(jī)轉(zhuǎn)速成正比，Um=k×ω。

電機(jī)驅(qū)動(dòng)電路的等效電路模型

如果忽略電機(jī)電感Lm造成的電流穩(wěn)定的過渡過程，那么根據(jù)上述電路模型可以得到：

E=I×（Re+Rm）+Um=I×（Re+Rm ）+k×ω

其中E是H橋輸出的PWM等效直流電壓：

E=Ub×占空比

Ub是H橋電路的母線電壓；占空比是由單片機(jī)輸出PWM的參數(shù)決定。所以，E是可控和已知的。如果通過電流采樣，可以獲得此時(shí)電機(jī)的工作電流I，那么，單機(jī)的轉(zhuǎn)速就可以有下面公式計(jì)算而得：

ω=［Ub×占空比 - I ×（Re+Rm）］/k

上面公式中，Re，Rm，k，Ub都可以通過測量、參數(shù)估計(jì)等方法進(jìn)行測量而到。

三、間接測速

A.電流波動(dòng)方法

小型直流有刷電機(jī)由于存在著換流部件，它會(huì)造成流過電流出現(xiàn)換流中斷；再加上內(nèi)部磁鋼所產(chǎn)生的磁場不是中心對稱，因此在電機(jī)轉(zhuǎn)動(dòng)過程中產(chǎn)生的感應(yīng)電動(dòng)勢Um出現(xiàn)波動(dòng)。這都會(huì)造成電機(jī)工作電流的波動(dòng)。

小型有刷直流電機(jī)內(nèi)部結(jié)構(gòu)

下圖是使用電流霍爾傳感器測量得到的電機(jī)工作電流波形，可以看出在不同的負(fù)載下，電流大小會(huì)出現(xiàn)很大的波動(dòng)。在平均電流值上面疊加了一個(gè)與電機(jī)轉(zhuǎn)速成正比的波動(dòng)信號，這就是由于直流電機(jī)內(nèi)部的換流以及磁場不均勻造成的波動(dòng)。

小型直流電機(jī)工作電流波形

通過測量這個(gè)波動(dòng)信號的頻率可以間接得到電機(jī)的轉(zhuǎn)速。

B.測速輪

電機(jī)的轉(zhuǎn)動(dòng)通過減速齒輪最終作用在車模輪胎上。如果車輪與地面之間沒有滑動(dòng)，因此車模的行進(jìn)速度就與電機(jī)轉(zhuǎn)速成正比?？梢酝ㄟ^固定在一個(gè)與車模底盤軟連接的支架頂端的一個(gè)轉(zhuǎn)動(dòng)測速輪（實(shí)際上是安裝有光電碼盤的小輪子）來測量車模底盤的行進(jìn)速度，進(jìn)而可以得到電機(jī)的轉(zhuǎn)速。

由于電機(jī)測速最終是用來控制車模行進(jìn)速度，所以使用測速輪可以準(zhǔn)確獲得車模行進(jìn)速度，它不會(huì)受到車輪打滑的影響，因此對于控制車模速度更加有力。

3、問題分析

對本文一開始提出的問題做如下分析：

一、是否要測量電機(jī)速度？

由于車模運(yùn)行速度會(huì)直接影響比賽成績以及車模在賽道上行進(jìn)的穩(wěn)定性，所以需要能夠準(zhǔn)確控制車模速度。車模行進(jìn)的動(dòng)力都來自于車模電機(jī)，它的轉(zhuǎn)速會(huì)直接影響車模運(yùn)行速度。如果不進(jìn)行速度測量，使用速度反饋來控制速度，那么電池電壓、車模傳動(dòng)阻力、賽道表面阻力和坡道等各種因素都會(huì)影響到車模運(yùn)行速度。

因此，測量電機(jī)速度是實(shí)現(xiàn)車模精確控制的必要手段。特別是對于直立車模來講，電機(jī)速度的反饋也決定了車模直立控制的效果。

二、如何選擇測量方案？

測量電機(jī)轉(zhuǎn)速（角度、角加速度）的方法很多，上面所列寫的也僅僅是常用到的方法。選擇不同測量方案，需要從以下幾個(gè)方面來考慮：

測量精度的要求。需要能夠滿足控制性能需求，特別是速度控制范圍以及精度要求。

傳感器尺寸和安裝。由于競賽車模體積很小，所以對于傳感器較大的方案在安裝上會(huì)受到限制，又是也會(huì)影響車模整體的機(jī)械性能。

方案的經(jīng)濟(jì)性，即價(jià)格。上面提問中就涉及到如何來消除傳感器昂貴的因素。如果車模上有兩個(gè)電極，有的時(shí)候兩個(gè)傳感器就比整個(gè)車模還貴。因此需要在精度、價(jià)格方面做權(quán)衡。

測量的可靠性、功耗等其他方面。

本文一開始提出的電機(jī)速度測量問題

三、智能車競賽中的測速方案

根據(jù)往屆比賽中參賽隊(duì)伍方案選擇來看，常見到的電機(jī)測速有光電編碼盤、測速輪方案居多。

由于智能車模屬于競賽比賽，所以對于車模速度測量精度沒有太大的要求，實(shí)際使用中每圈分辨率在8bit（256線）左右就可以滿足要求了。這個(gè)結(jié)論只是一個(gè)經(jīng)驗(yàn)值。

車模行進(jìn)過程中，電機(jī)實(shí)際上都沒有達(dá)到滿負(fù)荷，因此電機(jī)的性能還是處于線性范圍內(nèi)。所以利用電機(jī)模型，通過采集電機(jī)工作電流進(jìn)行輸出電壓補(bǔ)償也是可以達(dá)到非常好的效果。

對于其中需要測量的系數(shù)Rm，Re，Ub，K等可以化簡成一個(gè)補(bǔ)償形式，即通過調(diào)整一個(gè)等效電阻參數(shù)Requ，乘以電機(jī)工作電流I，去補(bǔ)償輸出PWM的占空比。通過實(shí)驗(yàn)的方法，確定Requ來使得規(guī)定PWM下，通過電流補(bǔ)償使得電機(jī)的轉(zhuǎn)速基本上不受外部負(fù)載的影響。這種方案是最省錢的方法。

4、實(shí)驗(yàn)驗(yàn)證

實(shí)驗(yàn)一：電機(jī)感應(yīng)電動(dòng)勢

轉(zhuǎn)動(dòng)小型直流電動(dòng)機(jī)，測量其輸出電刷上的電壓，會(huì)發(fā)現(xiàn)該電壓與轉(zhuǎn)速近似成正比。使用電機(jī)模型方法就是利用這個(gè)原理完成對于電機(jī)轉(zhuǎn)速測量的。

直流電機(jī)轉(zhuǎn)動(dòng)后產(chǎn)生感應(yīng)電動(dòng)勢

真正應(yīng)用過程中，則是通過測量電機(jī)工作電流，乘以等效內(nèi)阻，再從控制電壓中減去上述電阻壓降測量到感應(yīng)電動(dòng)勢。

實(shí)驗(yàn)二：小型直流電機(jī)PWM控制轉(zhuǎn)速

下面實(shí)驗(yàn)使用555時(shí)基IC電路控制一個(gè)大功率MOSFET，產(chǎn)生可調(diào)PWM信號，控制電機(jī)的轉(zhuǎn)速。

PWM波形控制電機(jī)轉(zhuǎn)速

實(shí)驗(yàn)中，影響電機(jī)轉(zhuǎn)速的一個(gè)主要因素是施加在電機(jī)兩端的等效直流電壓。因此改變PWM占空比就可以改變等效直流電壓，進(jìn)而調(diào)節(jié)電機(jī)轉(zhuǎn)速。

上述實(shí)驗(yàn)中的電機(jī)是空載，工作電流很小。如果電機(jī)輸出力矩，此時(shí)電機(jī)的工作電流就會(huì)上升，由于等效電阻的存在，使得最終穩(wěn)定轉(zhuǎn)速就會(huì)隨著電流的增加而降低。

實(shí)驗(yàn)三：測量電機(jī)工作電流的波動(dòng)

通過霍爾電流傳感器可以測量電機(jī)工作電流。通過單片機(jī)采集霍爾輸出電壓信號發(fā)送到計(jì)算機(jī)進(jìn)行顯示和測量。

實(shí)際測量電機(jī)電流波動(dòng)信號

測量電機(jī)工作電流電路

下圖是通過MATLAB顯示所采集到的工作電流波形，可以看出其中包含著呈現(xiàn)周期波動(dòng)的電流信號。

電機(jī)工作電流數(shù)據(jù)曲線

利用傅里葉分析，獲得電流信號的頻譜，其中存在著明顯的諧波分量。最大的一個(gè)諧波分量則對應(yīng)著電機(jī)的轉(zhuǎn)速。

電機(jī)工作電流信號的頻譜分析

電機(jī)工作電流波動(dòng)的頻率與電機(jī)轉(zhuǎn)速之間的比值等于電機(jī)的極對數(shù)。常見的有刷直流電機(jī)的極對數(shù)為1，或者2，可以從電機(jī)內(nèi)磁鋼的槽數(shù)，或者線圈的個(gè)數(shù)來獲得。

5、延伸討論

對控制對象參數(shù)的測量時(shí)進(jìn)行反饋控制的必要條件。通過反饋控制，可以將一些影響系統(tǒng)運(yùn)行的干擾、不確定、變化著的因素消除，使得控制對象始終保持著確定的運(yùn)行性能。所以，反饋控制的一個(gè)目的就是用來消除各種不確定的干擾因素。

反饋控制也可以將原來不穩(wěn)定的系統(tǒng)變成穩(wěn)定的系統(tǒng)。例如在直立車模比賽中，通過對于車模傾角以及角加速度的反饋控制，便可以保持車模穩(wěn)定的狀態(tài)。反饋控制思想不僅在工程中有著重要的應(yīng)用，還可以擴(kuò)展到很多其他的領(lǐng)域。

測量精度對于控制性能有一定的影響。但此時(shí)需要綜合考慮到執(zhí)行器的精度，包括驅(qū)動(dòng)電路的PWM精度、電機(jī)以及傳動(dòng)機(jī)構(gòu)的精度、控制要求的精度，在滿足要求的情況下，就需要考慮到測量的成本、安裝維護(hù)方便性以及可靠性等因素。

利用對于電機(jī)電壓、電流的測量，加上電機(jī)運(yùn)行模型來實(shí)現(xiàn)電機(jī)轉(zhuǎn)速控制是所有方法中最便宜的方案，在實(shí)現(xiàn)上也很方便。對于競速比賽的車模這種方法實(shí)際上可以滿足比賽的需要。

在現(xiàn)代電機(jī)控制中，特別是隨著永磁同步電機(jī)（PMSM），無刷直流電機(jī)（BLDC）推廣使用，很多方案就是使用電機(jī)模型的方法，通過電機(jī)工作電流、電壓的觀測獲得電機(jī)轉(zhuǎn)子的位置和轉(zhuǎn)速，進(jìn)而使用電子驅(qū)動(dòng)電路完成換流。省去了用于測量轉(zhuǎn)子位置的霍爾器件，降低了設(shè)備的成本，提高了系統(tǒng)的可靠性。

電機(jī)原本內(nèi)收的不對稱性，反過來也可以提供轉(zhuǎn)子的位置信息。上面的工作電流諧波分析獲得電機(jī)轉(zhuǎn)速的方法，就是這樣一種變廢為寶的思路。這些都是建立在對于電機(jī)工作機(jī)制理解和應(yīng)用的基礎(chǔ)之上。活學(xué)活用就會(huì)創(chuàng)造出很多巧妙新穎的方法，來實(shí)現(xiàn)新的突破。
編輯：hfy