加速度計(jì)姿態(tài)與運(yùn)動(dòng)檢測

 

加速度傳感器可以用來檢測物體的加速度，這個(gè)加速度包括了物體本身運(yùn)動(dòng)的加速度以及由于重力產(chǎn)生的加速度，前者主要用于檢測物體的運(yùn)動(dòng)，而后者主要用于檢測物體的姿態(tài)。

 

我們?cè)谏弦黄锩嬖敿?xì)介紹了加速度計(jì)的關(guān)鍵性能指標(biāo)以及應(yīng)用選型，本篇中我們會(huì)介紹如何通過加速度計(jì)內(nèi)部集成的功能實(shí)現(xiàn)更理想的超低功耗電池供電設(shè)備的姿態(tài)與運(yùn)動(dòng)檢測，以便能更好的平衡性能與耗電這個(gè)電池供電設(shè)備的重要需求。

 

軟的還是硬的，電池供電物聯(lián)網(wǎng)設(shè)備設(shè)計(jì)初始的抉擇

 

典型的電池供電的物聯(lián)網(wǎng)設(shè)備一般包含了感知單元（各種傳感器），邊緣計(jì)算單元（微控制器），無線連接單元（藍(lán)牙BLE，NBIOT，LPWLAN等）以及相應(yīng)的人機(jī)界面和電源管理部分，電池視使用場景需要工作十年或者數(shù)天，傳感器本身的超低功耗以及數(shù)據(jù)處理的超低功耗有助于延長電池壽命，減少帶寬用量并因此降低成本，是智能物聯(lián)網(wǎng)設(shè)備方案設(shè)計(jì)中的重要考量。

  

圖1. 典型物聯(lián)網(wǎng)系統(tǒng)框圖

 

電池供電的物聯(lián)網(wǎng)產(chǎn)品，部分采用不可充電的紐扣電池，而部分需要更強(qiáng)運(yùn)算功能的需要采用可充電鋰電池，在有限的電池資源下如何延長電池壽命，對(duì)于傳感器部分，常用的方式通常有兩種：

 

● 采用超低功耗的微處理器，通過利用傳感器本身自帶的FIFO功能，減少微處理器周期喚醒的次數(shù)和喚醒時(shí)間。

● 利用傳感器本身的搭載的低功耗邊緣計(jì)算功能，最大限度的降低微處理器的功耗。

 

圖2. 常用電池電壓和容量

 

  以上兩種方式取決于系統(tǒng)的需求，得益于微處理器能耗比的提高特別是近年來亞閾值電壓（低于0.5V）微處理器的推廣以及傳感器Always on需求下的大容量FIFO的普及，純軟件的方式，可以在保證低功耗的情況下靈活處理數(shù)據(jù)應(yīng)對(duì)需求的變化和算法的改進(jìn)。而針對(duì)特定需求在傳感器內(nèi)部采用硬件實(shí)現(xiàn)的功能，比如靜止檢測、運(yùn)動(dòng)檢測、屏幕翻轉(zhuǎn)、失重、位置識(shí)別、單雙擊，計(jì)步，抬手亮屏，睡眠監(jiān)測等等，用戶只需簡單配置算法對(duì)應(yīng)的寄存器即可開始檢測，一旦檢測到目標(biāo)事件，傳感器通過中斷管腳喚醒微處理器進(jìn)行相應(yīng)的處理，這種方式可以用戶無需自行開發(fā)驗(yàn)證算法，可以更簡便的使用傳感器實(shí)現(xiàn)相應(yīng)的功能，并能獲得更低的功耗。

 

下圖解釋了微處理器配合加速度計(jì)的32級(jí)FIFO進(jìn)行雙擊檢測和微處理器配合硬件雙擊檢測的加速度計(jì)的工作時(shí)序，由于加速度計(jì)硬件實(shí)現(xiàn)雙擊檢測，微處理器只需要在獲得加速度計(jì)中斷后很短的時(shí)間確認(rèn)，而無需周期喚醒去讀取FIFO數(shù)據(jù)并進(jìn)行雙擊的計(jì)算判別。

 

圖3. 雙擊FIFO模式和中斷模式處理器工作時(shí)序

 

上海矽?？萍嫉募铀俣葌鞲衅骺梢蕴峁╈o止檢測、運(yùn)動(dòng)檢測、屏幕翻轉(zhuǎn)、位置識(shí)別、單雙擊，計(jì)步，抬手亮屏等等功能，我們將針對(duì)姿態(tài)和運(yùn)動(dòng)檢測需要的運(yùn)動(dòng)檢測，靜止檢測以及用于無按鍵人界界面響應(yīng)的雙擊進(jìn)行介紹，并補(bǔ)充如何利用這些硬件特性配合微處理器軟件在低功耗下更好的檢測姿態(tài)的改變以及位移的改變。

 

圖4. 雙擊/計(jì)步器/抬手亮屏功耗對(duì)比

 

運(yùn)動(dòng)和靜止檢測

 

加速度計(jì)的運(yùn)動(dòng)和靜止檢測可以判定搭載加速度計(jì)的物件是靜止的，還是從靜止轉(zhuǎn)換到移動(dòng)狀態(tài)，以及是如何移動(dòng)的，物體感受到的震動(dòng)的方式，物體的姿態(tài)是什么樣的，以及物體被旋轉(zhuǎn)了多少角度或者被移動(dòng)了多遠(yuǎn)的距離。所有的方向、搖晃、單擊、雙擊、下落、傾斜、運(yùn)動(dòng)、定位、沖擊的識(shí)別都可以依據(jù)加速度計(jì)的相關(guān)數(shù)據(jù)來判定。

 

加速度計(jì)的運(yùn)動(dòng)狀態(tài)檢測常見的用途有：

 

● 檢測由靜到動(dòng)，比如車輛防盜系統(tǒng)中可以用加速度計(jì)判定異常的震動(dòng)；電表水表汽表檢測非法打開測量設(shè)備；手機(jī)里面依據(jù)震動(dòng)加上角度判斷識(shí)別手機(jī)是否被用戶拿起了；車載視頻監(jiān)控檢測到車輛啟動(dòng)自動(dòng)錄像操作，遙控器被拿起后進(jìn)入快速連接狀態(tài)等等；

 

● 檢測由動(dòng)到靜，主要是用于依靠這個(gè)狀態(tài)信息進(jìn)行相應(yīng)的控制，比如玩具如果在設(shè)定時(shí)間內(nèi)是靜止的，自動(dòng)關(guān)機(jī)節(jié)省電源等等；

 

● 檢測動(dòng)的方式，比如TWS耳機(jī)或者電子煙上使用敲擊的方式來實(shí)現(xiàn)無按鍵控制，比如計(jì)步檢測，撞擊檢測，雙擊實(shí)現(xiàn)類似電源開關(guān)或者打開費(fèi)電的射頻單元等等。

 

運(yùn)動(dòng)檢測（motion detection）主要包含了Anymotion detection（有效運(yùn)動(dòng)檢測），Signification Motion Detection（大幅度有效運(yùn)動(dòng)檢測），no motion（靜止檢測）以及Tap（單擊/雙擊/三擊），Pedometer（計(jì)步器） 。

 

除了Pedometer（計(jì)步器）之外，其他的幾種運(yùn)動(dòng)檢測都依賴于加速度計(jì)在相鄰兩個(gè)時(shí)間點(diǎn)的變化值，實(shí)現(xiàn)的計(jì)算量很小，功耗很低，另外由于加速度計(jì)在相鄰兩個(gè)時(shí)間點(diǎn)的間隔時(shí)間很短（4ms~100ms），由于重力產(chǎn)生的加速度不會(huì)快速變化，因此信號(hào)斜率檢測的方式對(duì)于設(shè)備的初始姿態(tài)不敏感，而且對(duì)于芯片本身的零偏不敏感，而且可以指定任意的XYZ軸作為檢測軸，是一種很方便高效的檢測方式。

 

下圖為Anymotion detection（有效運(yùn)動(dòng)檢測），no motion（靜止檢測）的示意圖。

 

圖5. Anymotion detection 時(shí)序圖

 

斜率定義為兩個(gè)相鄰時(shí)間點(diǎn)的加速度計(jì)值：Slope(t2)=(acc(t2)−acc(t1))，輸入允許是XYZ的任意一軸或者多軸的組合，需要設(shè)置斜率的閾值（Threshold）以及超過該閾值需要持續(xù)的時(shí)間（Duration），如果芯片檢測到符合這個(gè)設(shè)置的波形，將會(huì)提供一個(gè)中斷給微處理器，微處理器可以通過讀取相關(guān)的中斷寄存器確認(rèn)是Anymotion detection中斷，并可以讀取狀態(tài)寄存器獲取下面信息：

 

1） 最先滿足觸發(fā)條件的是哪個(gè)軸 ；

 

2） 觸發(fā)的信號(hào)是正方向的還是負(fù)方向的。

 

閾值（Threshold）與持續(xù)時(shí)間（Duration）的設(shè)置依賴于芯片的ODR，對(duì)于Anymotion detection的檢測，可以以較低的ODR實(shí)現(xiàn)，而較低的ODR可以獲得良好的功率控制。Duration可以選擇的點(diǎn)數(shù)目最多4個(gè)點(diǎn)，閾值最小為16LSB（3.9mg@FS+/-2G），閾值最大為4G@FS=+/-8G，因此該檢測器可以檢測很小的運(yùn)動(dòng)，也可以設(shè)置為檢測很強(qiáng)烈的撞擊，可以根據(jù)應(yīng)用的需求進(jìn)行相應(yīng)的設(shè)置。

 

no motion detection（靜止檢測）的設(shè)置與Anymotion detection的設(shè)置類似，需要使能檢測軸，設(shè)置閾值以及檢測時(shí)間，任何一個(gè)軸滿足條件后，都會(huì)有no motion的中斷。

 

圖6. QMA7981在不同模式下和ODR下的功耗

 

Signification Motion Detection（大幅度有效運(yùn)動(dòng)檢測）是Anymotion detection的加強(qiáng)版，主要應(yīng)用于持續(xù)的震動(dòng)檢測場景，以排除偶爾的震動(dòng)導(dǎo)致的系統(tǒng)喚醒。取決于應(yīng)用類型，這個(gè)大幅度有效運(yùn)動(dòng)檢測可以直接使用加速度計(jì)內(nèi)置的Signification Motion Detection亦或計(jì)步器數(shù)據(jù)。

 

圖7. Signification Motion Detection時(shí)序圖

 

圖7為Signification Motion Detection（大幅度有效運(yùn)動(dòng)檢測）的時(shí)序圖，檢測到Anymotion 后，間隔T-skip時(shí)間后，如果在一個(gè)設(shè)定的檢測時(shí)間內(nèi)又有Anymotion信號(hào)，則認(rèn)為是Significant Motion。

       

利用加速度計(jì)響應(yīng)敲擊動(dòng)作來做人機(jī)界面控制或者系統(tǒng)功耗管理也是一種常用的方式，考慮到系統(tǒng)的容錯(cuò)性和易使用性，雙擊和三擊是較常用的操作。

 

圖8. TAP時(shí)序圖

 

TAP有幾個(gè)重要的參數(shù)：

 

● ShockTime：在該時(shí)間內(nèi)，加速度計(jì)的斜率必須超過閾值Shock Threshold。

● QuietTime：在該時(shí)間內(nèi)，加速度計(jì)的斜率必須小于閾值Quiet Threshold。

 

對(duì)于雙擊，還需要保證后面的一擊出現(xiàn)的時(shí)間必須在Duration time之內(nèi)。由于加速度計(jì)對(duì)于敲擊的響應(yīng)，與設(shè)備的外型和敲擊動(dòng)作有關(guān)，因此不同的設(shè)備，有些參數(shù)需要做細(xì)微的調(diào)整（比如TWS耳機(jī)的敲擊的加速計(jì)輸出值要遠(yuǎn)大于手機(jī)敲擊時(shí)加速度計(jì)的輸出值）。常用的設(shè)置如下：

 

 

姿態(tài)與位移檢測

 

利用加速度計(jì)可以得到準(zhǔn)確的靜態(tài)姿態(tài)信息，利用去除重力加速度后的線性加速度分量，可以粗略的計(jì)算位移信息。在僅依靠加速度計(jì)的情況下，動(dòng)態(tài)的姿態(tài)和位移的檢測的精度都是比較有限的，難點(diǎn)在于動(dòng)態(tài)特別是快速情況下如何有效的獲取準(zhǔn)確的重力加速度，利用多傳感器數(shù)據(jù)融合可以較好的解決這個(gè)問題，要求高的應(yīng)用，可以考慮上海矽?？萍嫉膽T性單元IMU QMI8610。

       

加速度計(jì)用于測量物體的姿態(tài)，主要是包括俯仰角（Pitch ,按照安卓的定義是繞X軸旋轉(zhuǎn)的角度）和橫滾角（Roll，按照安卓的定義是繞Y軸旋轉(zhuǎn)的角度），用于水平檢測或者傾斜檢測，有要求精度很高的應(yīng)用如傾角儀，設(shè)備的水平檢測等，也有簡單的應(yīng)用比如電子價(jià)簽需要根據(jù)擺放的方向自動(dòng)旋轉(zhuǎn)屏幕，攝像頭的圖像圓轉(zhuǎn)，比如車輛的傾倒檢測，上坡檢測，設(shè)備的姿態(tài)變化的識(shí)別也可以用于無按鍵模式下的輸入，用于取代低功耗磁傳感器的開關(guān)作用。

 

圖9. 安卓Pitch/Roll定義

 

需要準(zhǔn)確的Pitch/Roll的角度可以按照下面的方法計(jì)算av=sqrtf(acc_data[x]*acc_data[x]+acc_data[y]*acc_data[y]+acc_data[z]*acc_data[z]);

 

計(jì)算 pitch 俯仰角度、roll 翻滾角度：

 

#define R2D        57.2957795131f

pitch = asinf(-acc_data[1]/av)*R2D;

roll = asinf(acc_data[0]/av)*R2D;

 

運(yùn)動(dòng)狀態(tài)下的姿態(tài)角的計(jì)算，需要將線性加速度去除后再進(jìn)行計(jì)算，常用的方法是對(duì)加速度計(jì)數(shù)據(jù)進(jìn)行低通濾波（例如gravity[x] = alpha * gravity[x] + (1 - alpha) * acc_data[x];），從而獲取與重力加速度相關(guān)的Gravity的值，然后再計(jì)算Pitch/Roll角度。在復(fù)雜運(yùn)動(dòng)狀態(tài)下，僅僅依靠加速度計(jì)估算線性加速度從而獲得真實(shí)的重力值，目前尚無性能特別好的辦法，要求高的可以采用IMU慣性單元做數(shù)據(jù)融合，依靠陀螺儀數(shù)據(jù)確認(rèn)夾角。（詳細(xì)軟件算法包：請(qǐng)找QST FAE申請(qǐng)）

        

利用加速度計(jì)傳感器，測量物體沿著某個(gè)平面的移動(dòng)距離，可以采用低通濾波器去除重力加速度后獲得線性加速度，然后通過對(duì)線性加速度進(jìn)行二次積分獲取設(shè)備的移動(dòng)位置，從而判斷設(shè)備是否被移動(dòng)，在車輛的防盜應(yīng)用中有應(yīng)用需求，在該種應(yīng)用中，考慮到加速度計(jì)的采樣速率，震動(dòng)噪聲以及加速度計(jì)二次積分的誤差，需要增加一個(gè)啟動(dòng)閾值判斷和終值零速判斷，從而提高精度減小誤差。

 

結(jié)束語

 

電池供電設(shè)備通過加速度計(jì)進(jìn)行姿態(tài)與運(yùn)動(dòng)檢測，充分利用加速度傳感器內(nèi)部集成的硬件算法，能更好的平衡性能與耗電這個(gè)電池供電設(shè)備的重要需求，在直接使用內(nèi)部的硬件集成的算法無法實(shí)現(xiàn)的需求，可以通過采用硬件觸發(fā)檢測配合軟件獲取加速度傳感器的原始數(shù)據(jù)進(jìn)行附加計(jì)算，通過減少微控制器喚醒的時(shí)間和頻率的方式，可以降低功耗，延長電池使用壽命。

 

 

推薦閱讀：