角度位移傳感器原理

　　角度傳感器用來檢測角度的。它的身體中有一個(gè)孔，可以配合樂高的軸。當(dāng)連結(jié)到RCX上時(shí)，軸每轉(zhuǎn)過1/16圈，角度傳感器就會(huì)計(jì)數(shù)一次。往一個(gè)方向轉(zhuǎn)動(dòng)時(shí)，計(jì)數(shù)增加，轉(zhuǎn)動(dòng)方向改變時(shí)，計(jì)數(shù)減少。計(jì)數(shù)與角度傳感器的初始位置有關(guān)。當(dāng)初始化角度傳感器時(shí)，它的計(jì)數(shù)值被設(shè)置為0，如果需要，你可以用編程把它重新復(fù)位。

　　角度位移傳感器實(shí)例

　　如果把角度傳感器連接到馬達(dá)和輪子之間的任何一根傳動(dòng)軸上，必須將正確的傳動(dòng)比算入所讀的數(shù)據(jù)。舉一個(gè)有關(guān)計(jì)算的例子。在你的機(jī)器人身上，馬達(dá)以 3:1的傳動(dòng)比與主輪連接。角度傳感器直接連接在馬達(dá)上。所以它與主動(dòng)輪的傳動(dòng)比也是3:1。也就是說，角度傳感器轉(zhuǎn)三周，主動(dòng)輪轉(zhuǎn)一周。角度傳感器每旋轉(zhuǎn)一周計(jì)16個(gè)單位，所以16*3=48個(gè)增量相當(dāng)于主動(dòng)輪旋轉(zhuǎn)一周?，F(xiàn)在，我們需要知道齒輪的圓周來計(jì)算行進(jìn)距離。幸運(yùn)地是，每一個(gè)LEGO齒輪的輪胎上面都會(huì)標(biāo)有自身的直徑。我們選擇了體積最大的有軸的輪子，直徑是81.6CM（樂高使用的是公制單位），因此它的周長是 81.6×π=81.6×3.14≈256.22CM。現(xiàn)在已知量都有了：齒輪的運(yùn)行距離由48除角度所記錄的增量然后再乘以256。我們總結(jié)一下。稱R 為角度傳感器的分辨率（每旋轉(zhuǎn)一周計(jì)數(shù)值），G是角度傳感器和齒輪之間的傳動(dòng)比率。我們定義I為輪子旋轉(zhuǎn)一周角度傳感器的增量。即：

　　I=G×R

　　在例子中，G為3，對(duì)于樂高角度傳感器來說，R一直為16.因此，我們可以得到：

　　I=3×16=48

　　每旋轉(zhuǎn)一次，齒輪所經(jīng)過的距離正是它的周長C，應(yīng)用這個(gè)方程式，利用其直徑，你可以得出這個(gè)結(jié)論。

　　C=D×π

　　在我們的例子中：

　　C=81.6×3.14=256.22

　　最后一步是將傳感器所記錄的數(shù)據(jù)-S轉(zhuǎn)換成輪子運(yùn)動(dòng)的距離-T，使用下面等式：

　　T=S×C/I

　　如果光電傳感器讀取的數(shù)值為296，你可以計(jì)算出相應(yīng)的距離：

　　T=296×256.22/48=1580 距離（T）的單位與輪子直徑單位是相同的。

　　角度位移傳感器實(shí)際上應(yīng)用

　　使用角度傳感器來控制你的輪子可以間接的發(fā)現(xiàn)障礙物。原理非常簡單：如果馬達(dá) 角度傳感器構(gòu)造運(yùn)轉(zhuǎn)，而齒輪不轉(zhuǎn)，說明你的機(jī)器已經(jīng)被障礙物給擋住了。此技術(shù)使用起來非常簡單，而且非常有效;唯一要求就是運(yùn)動(dòng)的輪子不能在地板上打滑 （或者說打滑次數(shù)太多），否則你將無法檢測到障礙物。如果是一個(gè)空轉(zhuǎn)的齒輪連接到馬達(dá)上就可以避免這個(gè)問題，這個(gè)輪子不是由馬達(dá)驅(qū)動(dòng)而是通過裝置的運(yùn)動(dòng)帶動(dòng)它：在驅(qū)動(dòng)輪旋轉(zhuǎn)的過程中，如果惰輪停止了，說明你碰到障礙物了。

　　在許多情況下角度傳感器是非常有用的：控制手臂，頭部和其它可移動(dòng)部位的位置。值的注意的是，當(dāng)運(yùn)行速度太慢或太快時(shí)，RCX在精確的檢測和計(jì)數(shù)方面會(huì)受到影響。事實(shí)上，問題并不是出在RCX身上，而是它的操作系統(tǒng)，如果速度超出了其指定范圍，RCX就會(huì)丟失一些數(shù)據(jù)。Steve Baker用實(shí)驗(yàn)證明過，轉(zhuǎn)速在每分鐘50到300轉(zhuǎn)之間是一個(gè)比較合適的范圍，在此之內(nèi)不會(huì)有數(shù)據(jù)丟失的問題。然而，在低于12rpm或超過 1400rm的范圍內(nèi)，就會(huì)有部分?jǐn)?shù)據(jù)出現(xiàn)丟失的問題。而在12rpm至50rpm或者300rpm至1400rpm的范圍內(nèi)時(shí)，RCX也偶會(huì)出現(xiàn)數(shù)據(jù)丟失的問題。