【導讀】檢測系統傾斜的一種常用方法是對陀螺儀輸出進(jìn)行積分。雖然這種方法直截了當，但與零點(diǎn)偏置穩定性有關(guān)的誤差會(huì )隨著(zhù)積分周期的增加而快速累積，使設備發(fā)生明顯旋轉——哪怕此時(shí)設備是靜止的。
在某些應用中，若整個(gè)時(shí)間范圍內作用于系統的凈加速或力是重力，那么可以使用加速度計來(lái)測量?jì)A斜的靜態(tài)角度。這類(lèi)應用有：游戲機、相機中的水平檢測，以及在工業(yè)和醫療應用中檢測設備的駛向。
對于采用加速度計的傾斜檢測，假設重力是唯一的加速激勵因素。在實(shí)際使用中，可在信號輸出端執行信號處理，移除輸出信號的高頻成分，因此一定程度的交流加速度是可以接受的。
傾斜檢測利用重力矢量及其在加速度計軸上的投影來(lái)確定傾斜角度。由于重力是直流加速度，任何產(chǎn)生額外直流加速度的力均會(huì )破壞輸出信號，導致計算錯誤。直流加速度的來(lái)源包括車(chē)輛在一定時(shí)間內以恒定速度加速，以及旋轉器件在加速度計上產(chǎn)生向心加速度。此外，通過(guò)重力旋轉加速度計，隨著(zhù)目標軸上的重力投影變化，會(huì )引起明顯的交流加速度。在計算傾斜之前，對加速度信號進(jìn)行任何形式的濾波都會(huì )影響建立輸出新靜態(tài)值的速度。
本應用筆記討論將加速度計輸出轉換為傾斜角度的基本原理。討論內容包括如何計算單軸、雙軸或三軸解決方案的理想傾斜角度。此外還包括一些關(guān)于校準的基本信息，以減少失調和靈敏度失配所引起的誤差。
傾斜計算
單軸傾斜計算
在只需對有限的角度范圍內進(jìn)行傾斜檢測的應用中(該應用的分辨率精度較低)，可使用單軸器件(或多軸器件中的單個(gè)軸)。
例如，在圖1中，單軸(本例中是x軸)通過(guò)重力旋轉。由于此方法僅使用單軸，且需要重力矢量，因此只有當器件的x軸始終位于重力平面上時(shí)，傾斜計算角度才是精確的。其他軸上的任何旋轉都會(huì )降低加速度在x軸上的幅度，計算傾斜角度時(shí)便會(huì )產(chǎn)生誤差。
圖1. 用于傾斜檢測的單軸
根據基本三角恒等式，x軸上的重力矢量投影會(huì )產(chǎn)生輸出加速度，大小等于加速度計x軸和水平面之間夾角的正弦值。水平面通常是與重力矢量正交的平面。當重力為理想值1 g時(shí)，輸出加速度為：
使用單軸解決方案時(shí)——也就是說(shuō)，輸出的變化引起輸入的某些變化——傾斜計算隨著(zhù)水平面與x軸夾角的增加而下降，當夾角接近±90°時(shí)，數值接近0。這點(diǎn)可以從圖2中看出，其中繪出了輸出加速度(以g表示)與傾斜角之間的關(guān)系圖。接近±90°時(shí)，傾斜角出現很大變化時(shí)，輸出加速度只會(huì )產(chǎn)生很小變化。
圖2. 輸出加速度與傾角的關(guān)系(單軸傾斜檢測)
由于以數字化的方式執行傾斜計算，輸出加速度根據最低有效位(LSB)或代碼表現為恒定加速度，并由模數轉換器(ADC)獲取，或者直接從數字輸出部分獲取。由于輸出分辨率是恒定的加速度，傾斜分辨率(以度為單位)是可變的，其最佳分辨率接近0°，最差分辨率為±90°。
圖3和圖4顯示傾角步進(jìn)為1°和0.25°時(shí)的增量靈敏度。增量靈敏度等于輸出變化，以mg顯示，表示每個(gè)傾角的步進(jìn)，或者：
其中：
N為當前角度。
P為步長(cháng)。
圖3. 步進(jìn)為1°時(shí)的增量?jì)A斜靈敏度
圖4. 步進(jìn)為0.25°時(shí)的增量?jì)A斜靈敏度
測量輸出加速度時(shí)，為了滿(mǎn)足應用在整個(gè)范圍內所需的傾斜分辨率，可利用這些曲線(xiàn)確定需達到的最小分辨率。例如，設計最大步長(cháng)為1°，則針對±63°范圍，分辨率至少需達到8 mg/LSB。類(lèi)似地，為達到±63范圍內的0.25°最大步長(cháng)，則分辨率至少為2 mg/LSB。請注意，如果存在較大的擾動(dòng)，可以使用過(guò)采樣以獲得更佳分辨率。
通過(guò)重力旋轉時(shí)，由于加速度計輸出符合正弦關(guān)系，使用反正弦函數可以將加速度轉換為角度。
其中，傾斜角θ單位為弧度。
如果需要窄范圍傾斜，可以使用線(xiàn)性近似法取代反正弦函數。線(xiàn)性近似與小角度正弦近似有關(guān)。
其中，傾斜角θ單位為弧度。
額外的比例系數k可用于傾角的線(xiàn)性近似計算中，若容許的誤差有所增加則可擴大近似的有效范圍。
其中，傾斜角θ單位為弧度。
將等式5的結果乘以(180/π)，可轉換為度。圖5顯示使用反正弦函數與使用k = 1時(shí)線(xiàn)性近似的對比。隨著(zhù)傾角幅度的增加，線(xiàn)性近似開(kāi)始下降，計算得到的角度與實(shí)際角度發(fā)生偏差。
圖5. 傾角計算中反正弦函數與線(xiàn)性近似的對比
由于計算角度根據實(shí)際傾角繪制，因此線(xiàn)性近似在靠近尾部時(shí)開(kāi)始彎曲。這是因為線(xiàn)性近似僅在對比輸出加速度時(shí)才表現為線(xiàn)性，如圖2所示。隨著(zhù)傾角增加，輸出加速度的表現與之相似。然而，反正弦函數應當產(chǎn)生與實(shí)際傾角一對一對應的輸出，從而當描繪實(shí)際傾角時(shí)，計算得到的角度為一條直線(xiàn)。
例如，假設傾斜檢測所需的分辨率為1°，則±0.5°的誤差是可以接受的，因為它低于計算的舍入誤差。若在k = 1的情況下繪制實(shí)際傾角與計算傾角之間的誤差(如圖6所示)，則線(xiàn)性近似的有效范圍僅為±20°。若比例系數經(jīng)調節后，使得誤差最大但依然保持在計算得到的舍入限值內，則線(xiàn)性近似的有效范圍增加到±30°以外。
圖6. 不同比例系數下計算得到的角度誤差
雙軸傾斜計算
單軸傾斜檢測的一個(gè)限制，是需要高分辨率ADC或數字輸出來(lái)實(shí)現大范圍的有效傾角，如圖3和圖4所示；另一個(gè)限制，是單軸測量無(wú)法提供360°的測量，因為在傾角N°時(shí)產(chǎn)生的加速度與傾角180° − N°時(shí)產(chǎn)生的加速度相同。在某些應用中，這是可以接受的；但對于需要更高分辨率或要求在完整的360°弧度范圍內區分傾角的應用而言，則需要第二條軸(如圖7所示)，或者需要第二個(gè)傳感器。若使用了第二個(gè)傳感器，則其朝向應使第二個(gè)傳感器的檢測軸與第一個(gè)傳感器的檢測軸相互正交。
圖7. 用于傾斜檢測的雙軸
增加一個(gè)軸對確定傾斜角有三大好處。下文說(shuō)明這些好處。
恒定靈敏度
增加一個(gè)軸的第一大好處在于兩個(gè)軸相互垂直。與單軸解決方案相同，x軸檢測到的加速度與傾斜角的正弦值成比例。由于兩個(gè)軸相互垂直，因此y軸加速度與傾斜角的余弦值成比例(見(jiàn)圖8)。隨著(zhù)一條軸的增量靈敏度下降(比如該軸的加速度接近+1 g或−1 g)，另一條軸上的增量靈敏度將會(huì )上升。
圖8. 輸出加速度與傾角的關(guān)系(雙軸傾斜檢測)
將測量的加速度轉換為傾角的一種方法，是計算x軸的反正弦函數和y軸的反余弦函數，與單軸解決方案類(lèi)似。但是，更簡(jiǎn)單有效的方法是使用兩個(gè)數值之比，可得到如下結果：
其中，傾斜角θ單位為弧度。
與單軸示例不同，使用兩軸之比來(lái)確定傾角會(huì )使得增量靈敏度的確定變得十分困難。相反，假設所需的傾斜分辨率已知，則確定加速度計需達到的最低分辨率用處更大。假定一條軸的增量靈敏度隨著(zhù)另一條軸的增量靈敏度下降而上升，則凈結果將是數值基本恒定的有效增量靈敏度。這表示若針對某一角度，為達到所需的傾斜步長(cháng)要求而選擇加速度計，則該加速度計將具備足夠的分辨率以應付所有角度。
為確定所需的最小加速度計分辨率，可檢查等式6，確定分辨率的極限。由于每條軸的輸出和傾角的正弦或余弦有關(guān)，并且每種函數的傾角均相同，因此可求解的最小角度與可求解的最小加速度有關(guān)。
如圖3和圖4所示，正弦函數在0°附近具有最大速率變化，且可以看出，余弦函數在該點(diǎn)處具有最小速率變化。由于這個(gè)原因，傾斜導致的x軸加速度變化將先于y軸加速度變化而被識別。因此，系統在0°附近的分辨率主要取決于x軸的分辨率。如需確定P°的傾斜變化，加速度計必須要能檢測根據下式所確定的變化量近似值：
對于所需的傾斜步長(cháng)，圖9可用來(lái)確定所需的最小加速度計分辨率(或最大加速度計比例因子)。注意，加速度計分辨率的提升不僅與加速度計比例因子的降低有關(guān)，還與檢測更小的輸出加速度變化的能力有關(guān)。因此，針對目標傾斜步長(cháng)選擇具有適當分辨率的加速度計時(shí)，比例因子應當小于圖9所示的限值。
圖9. 用于目標傾角分辨率的最小加速度計分辨率
降低與重力平面對齊的依賴(lài)性
使用至少兩個(gè)軸的第二大好處是，與單軸解決方案不同，增加一個(gè)軸后，即使第三個(gè)軸上存在傾斜，也可以測出精確值。而在單軸解決方案中，只要除x軸以外的任何其它軸上存在傾斜，就會(huì )造成顯著(zhù)誤差。這是因為有效增量靈敏度與目標軸上重力的和方根(RSS)值成比例。
若重力完全包含在xy平面中，那么在理想情況下，那些軸上檢測到的加速度RSS值等于1 g。若在xz或yz平面上存在傾斜，則重力導致的總加速度將下降，從而降低有效增量靈敏度。這樣會(huì )增加給定加速度計分辨率的傾斜步長(cháng)，但依然可以提供精確的測量結果。傾角計算結果與xy平面上的旋轉有關(guān)。
若系統足夠傾斜，以至于xy平面上只有極少量由于重力而造成的加速度，那么傾角步長(cháng)將會(huì )分辨率過(guò)低而不可用；因此，建議限制xz或yz平面的傾斜程度。
完整360°傾斜檢測
增加一個(gè)軸的第三大好處是，能夠區分各個(gè)象限并在整個(gè)360°弧度范圍內測量角度。如圖10所示，每個(gè)象限都具有與x和y軸加速度關(guān)聯(lián)的不同符號組合。
圖10. 象限檢測的傾角和加速度符號
如果操作數AX,OUT/AY,OUT為正值，反正切函數會(huì )返回第一象限中的值；如果操作數為負值，則反正切函數會(huì )返回第四象限中的值。第二象限內的操作數為負值，因此在計算該象限內的角度時(shí)應將結果加上180°。第三象限內的操作數為正值，因此在計算該象限內的角度時(shí)應從結果中減去180°。而該角度所處的確切象限則可以通過(guò)各軸上測得的加速度符號來(lái)確定。
三軸傾斜計算
引入第三條軸后，便可在全部范圍內確定傳感器。經(jīng)典的矩形(x, y, z)到球形(ρ, θ, φ)轉換方法可將xy平面的傾角θ以及重力因素產(chǎn)生的傾角φ與每條軸上的測量加速度相關(guān)聯(lián)，如下所示：
假設重力是唯一測得的加速度原因，則等式10分母上的操作數可以常數代替(最好是1)，因為此時(shí)所有軸上的RSS值為常數。角度如圖11所示；圖11c顯示θ只在xy平面上存在，而圖11d顯示φ為z軸與重力矢量之間的夾角。
圖11. 球形坐標系統的角度
由于三軸法與單軸/雙軸法具有相似的等式，因此三軸解決方案的分析與單軸和雙軸法結合使用時(shí)相同。兩條正交軸之比有助于θ的測量，并且要達到要求的傾斜分辨率需要具備一個(gè)最小加速度計分辨率，如等式8所示。
φ的測量不僅與單軸解決方案的傾角測量有關(guān)，還與目標范圍內實(shí)現特定傾角分辨率所需的最小加速度計分辨率的確定有關(guān)。區別在于，使用反余弦函數確定φ會(huì )使φ在90°時(shí)具有最大的增量靈敏度，而在0°和180°時(shí)具有最小的增量靈敏度。
以余弦代替等式2中的正弦，即可產(chǎn)生類(lèi)似圖3和圖4的曲線(xiàn)。重要的是需注意，雖然θ的范圍為−180°至+180°，但φ的范圍僅為0°至180°。若φ的角度為負數，則θ的角度也會(huì )變?yōu)樨摂怠?/div>
三軸傾斜檢測的一種替代方法是單獨確定加速度計每條軸與參考位置之間的夾角。參考位置通常選擇器件的x軸和y軸位于水平面的方向上(0 g場(chǎng))，并且z軸與水平面垂直(1 g場(chǎng))。圖12顯示該方法，其中，θ表示水平面與加速度計x軸之間的夾角，ψ表示水平面與加速度計y軸之間的夾角，φ表示重力矢量與z軸之間的夾角。當位于x和y軸的0 g以及z軸的1 g初始位置時(shí)，所有計算的角度均為0°。
圖12. 獨立傾斜檢測的角度
可利用基本三角恒等式計算傾角，如等式11、12和13所示。
等式13中操作數出現明顯反轉，這是因為初始位置為1 g場(chǎng)。若需使用水平面作為z軸的參照，則可將操作數反轉。角度為正表示對應的加速度計正軸指向水平面上方，而角度為負表示軸指向水平面下方。
由于采用反正切函數和加速度之比，因此具有雙軸示例中提及的優(yōu)勢，也就是說(shuō)有效增量靈敏度是恒定的，并且單位范圍內的角度可在所有點(diǎn)上精確測得。
校準失調和靈敏度失配誤差
本應用筆記中的分析假設采用理想加速度計。該假設等同于使用無(wú)0 g失調且具有完美靈敏度的器件——靈敏度以mV/g(模擬傳感器)或LSB/g(數字傳感器)表示。雖然傳感器經(jīng)過(guò)調節，但器件本質(zhì)上是機械的，這便意味著(zhù)系統完成裝配后，器件上的任何靜態(tài)應力都有可能影響失調和靈敏度。再加上工廠(chǎng)校準的限制，便有可能使誤差超出應用允許的限值以外。
失調誤差的影響
為了表明誤差到底有多大，可以設想一下，某個(gè)雙軸解決方案具有完美的靈敏度，但x軸上存在50 mg失調。0°時(shí)，x軸讀數為50 mg，y軸讀數則為1 g。由此計算得出的角度就是2.9°，因而會(huì )造成2.9°的誤差。±180°時(shí)，x軸的讀數為50 mg，y軸的讀數則為−1 g。由此計算得出的角度會(huì )存在−2.9°的誤差。圖13所示為本例中算出的角度和實(shí)際角度之間的誤差情況。失調引起的誤差可能不僅大于系統所需的精度，而且還會(huì )發(fā)生變化，使簡(jiǎn)單地通過(guò)校準消除誤差角變得困難。當多個(gè)軸上都存在失調時(shí)，這將會(huì )變得更為復雜。
圖13. 加速度計失調引起的角度計算誤差
靈敏度失配誤差的影響
在雙軸傾斜檢測應用中，由加速度計靈敏度導致的主要誤差成分是目標軸之間的靈敏度差異(在單軸解決方案中，如果實(shí)際靈敏度和預期靈敏度之間存在任何偏差，則會(huì )導致出現誤差)。由于使用的是x和y軸的比值，因此如果兩者靈敏度相同，則可以消除大多數誤差。
下面舉例說(shuō)明加速度計靈敏度失配的影響。假設某個(gè)雙軸解決方案具有完美的失調調整功能，且y軸具有完美的靈敏度，但x軸的靈敏度為+5%。這表示在1 g場(chǎng)中，y軸讀數為1 g，x軸讀數則為1.05 g。圖14所示為因為這種靈敏度失配而造成角度計算出現的誤差情況。與失調誤差類(lèi)似，加速度計靈敏度失配引起的誤差會(huì )在整個(gè)旋轉范圍內不斷變化，使在計算出傾斜角后進(jìn)行誤差補償變得困難。改變y軸的靈敏度會(huì )進(jìn)一步增加失配，從而使誤差更大。
圖14. 加速度計靈敏度失配引起的角度計算誤差
基本校準技術(shù)
當失調引起的誤差和靈敏度失配引起的誤差兩者相疊加時(shí)，誤差可能會(huì )變得相當大，完全超出傾斜檢測應用所能接受的范圍。要減少這類(lèi)誤差，就應當對失調和靈敏度進(jìn)行校準，并使用校準后的輸出加速度來(lái)計算傾斜角。包括失調和靈敏度的影響后，加速度計輸出變化如下：
其中：
AOFF表示失調誤差，單位為g。
Gain表示加速度計的增益，理想值為1。
AACTUAL表示加速度計的真實(shí)加速度和目標值，單位為g。
一種簡(jiǎn)單的校準方法是假設增益為1并測量失調。經(jīng)過(guò)此校準之后，系統的精度即會(huì )限制為未校準的靈敏度誤差。這種簡(jiǎn)單的校準方法可通過(guò)將目標軸置于0 g場(chǎng)中并測量輸出(大小等于失調)來(lái)完成。然后，應在處理信號之前從加速度計的輸出中減去該值。這種方法通常稱(chēng)為無(wú)調頭或單點(diǎn)校準，因為器件的典型取向會(huì )將x和y軸置于0 g場(chǎng)中。如果使用的是三軸器件，則應針對z軸包含至少一個(gè)調頭或第二個(gè)點(diǎn)。
一種更加精確的校準方法是每個(gè)目標軸上取用兩個(gè)點(diǎn)(三軸設計最多可取用六個(gè)點(diǎn))。當某個(gè)軸處于+1 g和−1 g場(chǎng)中時(shí)，測得的輸出如下：
其中，失調AOFF的單位為g。
利用這兩個(gè)點(diǎn)確定的失調和增益如下：
其中，+1 g和−1 g測量結果A+1g和A−1g均以g表示。
由于測量目標軸時(shí)，正交軸都處于0 g場(chǎng)，因此這種校準方法還有助于將跨軸靈敏度影響降至最低。利用這些值，首先可以從加速度計測量結果中減去失調，然后將所得結果除以增益。
其中，AOUT和AOFF的單位為g。
等式15至等式19中，計算AOFF和增益時(shí)，假設加速度值A+1g和A−1g均以g表示。如果加速度單位采用mg，則等式17中AOFF的計算結果會(huì )保持不變，但等式18中增益的計算結果需要除以1000，以處理單位上的變化。
推薦閱讀：
