利用加速度計(jì)和陀螺儀測(cè)量車(chē)輛運(yùn)動(dòng)

當(dāng)測(cè)試車(chē)輛時(shí)，人們常常需要測(cè)量車(chē)輛的動(dòng)態(tài)運(yùn)動(dòng)以及車(chē)輛相對(duì)于道路的傾角。我們可以通過(guò)加速度計(jì)來(lái)獲得車(chē)輛轉(zhuǎn)彎、加速或者制動(dòng)時(shí)產(chǎn)生的沖擊力，但是，除非車(chē)輛在進(jìn)行上述運(yùn)動(dòng)時(shí)保持水平，否側(cè)測(cè)試結(jié)果是不準(zhǔn)確的。比如，你想用加速度計(jì)測(cè)量車(chē)輛的制動(dòng)力，但車(chē)輛是向前傾斜的，測(cè)量結(jié)果中就會(huì)有重力分量。

大多數(shù)傾斜傳感器把重力方向當(dāng)作參考方向。重力是一種加速度，并且不斷變化（應(yīng)該是隨高度變化吧）。制動(dòng)、加速和轉(zhuǎn)彎時(shí)，車(chē)輛會(huì)產(chǎn)生加速度。然而當(dāng)進(jìn)行傾斜測(cè)量時(shí)，我們只需要得到重力加速度；當(dāng)進(jìn)行車(chē)輛動(dòng)力測(cè)量時(shí)，卻又只想得到運(yùn)動(dòng)加速度。

有運(yùn)動(dòng)加速度時(shí)，傾斜傳感器將得到一個(gè)不準(zhǔn)確的傾角。也就是說(shuō)，在車(chē)輛傾斜時(shí)只通過(guò)加速度計(jì)將無(wú)法得到準(zhǔn)確的傾角。

通過(guò)測(cè)量繞車(chē)輛重心的旋轉(zhuǎn)，陀螺儀有助于糾正車(chē)倆向前傾斜帶來(lái)的不利影響。不幸的是，陀螺儀有其自身的缺陷。它測(cè)量旋轉(zhuǎn)速度，不是旋轉(zhuǎn)角度，通過(guò)不斷積分得到角度。當(dāng)旋轉(zhuǎn)速度的測(cè)量出現(xiàn)偏差，積分后所得的角度將會(huì)有很大的偏差。但是，你可以結(jié)合角速度值和加速度值，計(jì)算出車(chē)輛動(dòng)態(tài)運(yùn)動(dòng)時(shí)的精確數(shù)據(jù)。角速度和加速度的缺點(diǎn)可以相互彌補(bǔ)。當(dāng)擁有足夠強(qiáng)的計(jì)算能力，我們就可以得到實(shí)時(shí)的加速度和角度的精確值。

要實(shí)現(xiàn)這一點(diǎn)，你需要測(cè)量沿三個(gè)軸的加速度和角速度。于是我們沿著車(chē)身安裝了三軸加速度計(jì)，和與值對(duì)應(yīng)的三軸陀螺儀。見(jiàn)圖1。如果可能，傳感器最好安裝在車(chē)輛重心，盡量減少旋轉(zhuǎn)加速度對(duì)測(cè)量帶來(lái)的不利影響。

圖1 車(chē)輛各軸上的傳感器

我們可以用陀螺儀測(cè)量車(chē)輛繞給定軸的旋轉(zhuǎn)。如果一直對(duì)角速度積分，將會(huì)得到角度關(guān)于時(shí)間的函數(shù)。例如，您可以使用陀螺儀來(lái)跟蹤車(chē)輛沿著X和Y軸的旋轉(zhuǎn)，然后對(duì)傳感器信號(hào)積分，計(jì)算出車(chē)輛俯仰角和翻滾角。這是一個(gè)關(guān)于時(shí)間的函數(shù)。根據(jù)這個(gè)計(jì)算得到的俯仰角和翻滾角，從加速度傳感器信號(hào)中減去由于傾斜帶來(lái)的重力分量，最終得到運(yùn)動(dòng)加速度。

要得到可靠的俯仰角和翻滾角，你必須對(duì)角速度信號(hào)積分。結(jié)果是，角速度信號(hào)的偏差，會(huì)造成角度的偏差，并且隨時(shí)間線性增加。此外，陀螺儀的隨機(jī)噪聲會(huì)導(dǎo)致計(jì)算角度的隨機(jī)波動(dòng)，這種波動(dòng)使得角度以與時(shí)間的平方根成正比的速度漂移。這些影響將限制昂貴的陀螺儀在超過(guò)幾分鐘測(cè)量時(shí)的應(yīng)用。

幸運(yùn)的是，我們可以利用陀螺儀短時(shí)測(cè)量準(zhǔn)確的優(yōu)勢(shì)和加速度計(jì)長(zhǎng)時(shí)穩(wěn)定的特點(diǎn)，兩者結(jié)合，得到即能短時(shí)穩(wěn)定又能長(zhǎng)時(shí)穩(wěn)定的傾角。用陀螺儀測(cè)量短時(shí)內(nèi)角度變化，把加速度傳感器當(dāng)做傾角傳感器測(cè)量?jī)A角，并在一個(gè)長(zhǎng)時(shí)間范圍內(nèi)，迫使陀螺儀得到的傾角慢慢匹配加速度傳感器得到的傾角。

要執(zhí)行這些操作，需要有傳感器，以及數(shù)據(jù)采集和處理設(shè)備。我們使用一個(gè)三軸加速度計(jì)和（三個(gè)）3軸陀螺儀。不管沿哪個(gè)方向，你都需要以能測(cè)量車(chē)輛完整運(yùn)動(dòng)的目的來(lái)安裝這些傳感器。還可以添加一個(gè)溫度傳感器，用其采集的數(shù)據(jù)補(bǔ)償溫度對(duì)加速度計(jì)和陀螺儀輸出的影響。然后將傳感器信號(hào)數(shù)字化，并輸入計(jì)算機(jī)或存儲(chǔ)器。

可以使用電腦對(duì)得到的數(shù)據(jù)進(jìn)行計(jì)算。但是，如果想看到實(shí)時(shí)的計(jì)算結(jié)果，那得需要一臺(tái)數(shù)字信號(hào)處理器（DSP），作為信號(hào)采集設(shè)備之一。然后，將計(jì)算得到的角度數(shù)據(jù)、已修正的加速度和角速度信息用數(shù)據(jù)線傳送到電腦。如果發(fā)送的是二進(jìn)制數(shù)據(jù)包，工作在38.4K波特率的串行RS-232數(shù)據(jù)線應(yīng)該滿足超過(guò)200Hz的傳輸速率。這大大快于陀螺儀的帶寬。

盡量把傳感器安裝在靠近車(chē)輛運(yùn)動(dòng)中心的地方。否側(cè)旋轉(zhuǎn)產(chǎn)生的離心力將會(huì)被加速度計(jì)測(cè)量。請(qǐng)注意，我們使用加速度計(jì)只是測(cè)量車(chē)輛重心的線性加速度，所以要盡量減少旋轉(zhuǎn)運(yùn)動(dòng)對(duì)加速度測(cè)量的耦合。