慣性測量裝置 (IMU) 可廣泛用于從加速計(jì)、陀螺儀及其他傳感器持續(xù)穩(wěn)定地提供多軸位置信息。鑒于多自由度 (DOF) 特性，所有生成數(shù)據(jù)（即來自這些設(shè)備的合并數(shù)據(jù)流）會使系統(tǒng)處理器一直處于喚醒模式，并且由于要篩選原始 IMU 數(shù)據(jù)來提取有用的手勢和系統(tǒng)位置信息，因此使它們不堪重負(fù)。設(shè)計(jì)人員需要設(shè)法為主處理器減負(fù)，讓其不再承擔(dān)此類篩選功能。而機(jī)器學(xué)習(xí)則可能解決這一問題。

本文將首先簡要介紹 IMU 的用途，接著介紹STMicroelectronics的LSM6DSO。然后，借此器件闡釋在 IMU 中添加和集成機(jī)器學(xué)習(xí)與決策樹處理功能后，為何能為主機(jī)應(yīng)用處理器分擔(dān)實(shí)時位置和運(yùn)動處理，以及如何在實(shí)際應(yīng)用中使用這些功能。

IMU 簡介

IMU 將各種運(yùn)動傳感器集成到一個器件中，可提供高精度定位信息。IMU 可用于各種應(yīng)用，包括消費(fèi)（手機(jī)）、醫(yī)療（成像）、工業(yè)（機(jī)器人）和軍工（航向跟蹤）。該裝置對傳感器的運(yùn)動作出響應(yīng)，包含以下一種或多種運(yùn)動傳感器類型：

• 陀螺儀傳感器測量角度位置變化，通常以每秒度數(shù)表示。隨時間進(jìn)行角速度積分可測得行程角度，用于追蹤方向變化。陀螺儀追蹤與重力無關(guān)的相對運(yùn)動，因此來自傳感器偏置或積分的誤差會造成稱為“漂移”的位置誤差，但可以通過軟件進(jìn)行補(bǔ)償。
• 加速計(jì)測量線性加速度，包括設(shè)備運(yùn)動造成的加速度分量和重力造成的加速度。加速度的測量單位為 g，1 g = 地球重力 = 9.8 米/秒2。加速計(jì)分為單軸、雙軸和三軸，分別定義為 X、Y、Z 坐標(biāo)系。
• 磁傳感器測量磁場強(qiáng)度，通常以微特斯拉 (μT) 或高斯（100 μT = 1 高斯）為單位。移動電子設(shè)備中最常用的磁傳感器是三軸霍爾效應(yīng)磁力儀。通過計(jì)算檢測到的地球磁場角度，并將此測量的角度與加速計(jì)測量的重力進(jìn)行比較，即可非常精確地測量出設(shè)備相對于地磁北極的航向。

使用 IMU 的運(yùn)動追蹤功能采用了傳感器融合技術(shù)，根據(jù)已知的起點(diǎn)和方向，推導(dǎo)單一、高精度的相對設(shè)備方向和位置的估計(jì)值。傳感器融合多通過軟件，使用 IMU 制造商或應(yīng)用開發(fā)人員開發(fā)的復(fù)雜數(shù)學(xué)算法來組合 IMU 的各種運(yùn)動傳感器輸出。

使用傳感器融合進(jìn)行位置計(jì)算可得到以下測量結(jié)果：

• 重力– 具體而言地球重力，不含設(shè)備感應(yīng)到的由運(yùn)動造成的加速度。當(dāng) IMU 靜止時，加速計(jì)測量重力矢量。當(dāng) IMU 運(yùn)動時，重力測量需要融合加速計(jì)和陀螺儀的數(shù)據(jù)，并減去運(yùn)動造成的加速度。
• 線性加速度– 等于加速計(jì)測得的設(shè)備加速度，但要通過軟件減去重力矢量。IMU 線性加速度可用于測量三維空間中的運(yùn)動。
• 方向（海拔）– 歐拉角集合，包括偏航角、俯仰角和翻滾角，測量單位為度。
• 旋轉(zhuǎn)矢量– 由加速計(jì)、陀螺儀和磁力儀傳感器的數(shù)據(jù)組合得出。旋轉(zhuǎn)矢量表示圍繞特定軸的旋轉(zhuǎn)角度。

IMU 誤差源

陀螺儀通過角速度變化檢測方向，但隨著時間推移，陀螺儀往往會漂移，因?yàn)樗鼉H檢測變化而沒有固定的參照系。若將加速計(jì)數(shù)據(jù)添加到陀螺儀數(shù)據(jù)中，軟件可以最大限度地減小陀螺儀偏置，從而得到更準(zhǔn)確的位置估計(jì)。加速計(jì)檢測相對于重力的方向變化，該數(shù)據(jù)可用于給陀螺儀定向。

加速計(jì)對于靜態(tài)（與動態(tài)相反）計(jì)算更準(zhǔn)確。當(dāng)系統(tǒng)已處于運(yùn)動狀態(tài)時，利用陀螺儀檢測方向要更好。加速計(jì)反應(yīng)迅速，若只使用該數(shù)據(jù)，加速計(jì)抖動和噪聲會產(chǎn)生累積誤差。此外，由于重力之類的外力，加速計(jì)往往會使加速度失真，這也會作為噪聲在系統(tǒng)中累積。對此數(shù)據(jù)進(jìn)行濾波可提高精度。

若將陀螺儀的短期精度與加速計(jì)的長期精度相結(jié)合，依靠每種傳感器的優(yōu)勢來抵消或至少減輕另一種傳感器的劣勢，可以獲得更精確的方向讀數(shù)。兩種傳感器類型的互補(bǔ)有助于減少誤差，但還有其他方法可用來減少誤差。

融合濾波可用來減少誤差

IMU 軟件使用濾波來最大限度地減小 IMU 數(shù)據(jù)的定位誤差。有多種濾波方法可融合傳感器數(shù)據(jù)，每種方法都有不同程度的復(fù)雜性。互補(bǔ)濾波結(jié)合了高通陀螺儀濾波和低通加速計(jì)濾波。因此，加速計(jì)數(shù)據(jù)中的高頻噪聲會在短期內(nèi)濾除，并且采用陀螺儀數(shù)據(jù)進(jìn)行平滑處理。

執(zhí)行所有這種傳感器處理、濾波和融合所需的計(jì)算能力耗能較大；對于電池供電型系統(tǒng)，尤其是不需要 IMU 信息連續(xù)傳輸時，這可能是個問題。對于許多嵌入式應(yīng)用，如果 IMU 可以生成中斷，將主機(jī)處理器從休眠模式喚醒，從而啟動處理或采取某些中斷結(jié)果操作，即可明顯降低功耗。為了實(shí)現(xiàn)此功能，一些 IMU 供應(yīng)商開始在 IMU 中加入處理和決策功能。

讓 IMU 進(jìn)行思考

STMicroelectronics 的 6DOF LSM6DSO 就是一款這樣的 IMU。6DOF LSM6DSO 包含三個微機(jī)電系統(tǒng) (MEMS) 陀螺儀和三個 MEMS 加速計(jì)，可以檢測方向變化和手勢，無需主機(jī)處理器的監(jiān)管或輔助，所有這些功能都在板上處理。在最高性能模式下運(yùn)行時，該 IMU 的功耗為 0.55 毫安 (mA)。

在此模式下，LSM6DSO 可以持續(xù)監(jiān)測自身在空間中的海拔高度和運(yùn)動，并且可以在預(yù)定條件下生成中斷，喚醒主機(jī)處理器來執(zhí)行傳感器流的額外處理。使用始終保持運(yùn)轉(zhuǎn)的低功耗 IMU 很有效，因?yàn)樗屩鳈C(jī)處理器休眠，僅在必要時喚醒。這種節(jié)能方法在電池供電型系統(tǒng)中是值得嘗試和信賴的。

除了陀螺儀和加速計(jì)傳感器之外，LSM6DSO IMU 還包含一個信號調(diào)節(jié)和濾波器模塊、一個最多可運(yùn)行 16 個程序的有限狀態(tài)機(jī) (FSM)（所有程序共享可配置的通用輸出數(shù)據(jù)速率）以及一個機(jī)器學(xué)習(xí)內(nèi)核。結(jié)合使用這些資源，可以在以下情況下生成事件檢測中斷：

• 自由落體
• 喚醒
• 6DOF 方向
• 單擊和雙擊檢測
• 活動/非活動識別
• 靜止/運(yùn)動檢測

信號調(diào)節(jié)塊應(yīng)用存儲在靈敏度寄存器中的轉(zhuǎn)換系數(shù)，換算原始傳感器數(shù)據(jù)。然后，將原始 IMU 傳感器數(shù)據(jù)流轉(zhuǎn)換為 16 位半精度浮點(diǎn) (HFP) 格式，以便 FSM 可以理解。IMU 的 MEMS 傳感器（加速計(jì)和陀螺儀）以及兩個模數(shù)轉(zhuǎn)換器 (ADC) 和四個濾波器塊如圖 1 所示。濾波器塊用于將 MEMS 傳感器的模擬信號轉(zhuǎn)換為濾波后的數(shù)字?jǐn)?shù)據(jù)流。

圖 1：LSM6DSO IMU 使用兩個 ADC 將內(nèi)部 MEMS 加速計(jì)和陀螺儀的模擬信號轉(zhuǎn)換為數(shù)字流。ADC 之后是四個數(shù)字濾波器，用于調(diào)節(jié)信號，以便內(nèi)部 FSM 和機(jī)器學(xué)習(xí)內(nèi)核以及主機(jī)處理器作出決策。（圖片來源：STMicroelectronics）

可編程 FSM 由一個配置塊和 16 個程序塊組成。FSM 配置塊對整個 FSM 進(jìn)行配置和控制。對于 16 個 FSM 程序塊，每個塊都由輸入選擇器塊和代碼塊組成（圖 2）。這兩個塊都由寫入 IMU 內(nèi)部寄存器的數(shù)值來控制。

圖 2：LSM6DSO IMU 中包含 16 個 FSM 程序塊，每個塊都是由輸入選擇器塊和代碼塊組成。（圖片來源：STMicroelectronics）

輸入選擇器塊將選定的輸入數(shù)據(jù)從一個 IMU 內(nèi)部傳感器或連接到 IMU 傳感器中樞的外部傳感器發(fā)送到代碼塊。IMU 傳感器中樞可以容納多達(dá)四個額外的外部傳感器，如磁力儀，這些外部傳感器可通過 I2C 端口連接到 IMU。

FSM 代碼塊包含一個狀態(tài)機(jī)程序。程序塊數(shù)據(jù)段的固定部分由六個字節(jié)組成，這些字節(jié)用于定義程序的閾值數(shù)、滯后、掩碼和定時器設(shè)置。程序塊的可變數(shù)據(jù)段保存了每個程序的實(shí)際閾值、滯后、掩碼和定時器設(shè)置，如數(shù)據(jù)段固定部分中存儲的數(shù)值所定義。

數(shù)據(jù)段的固定部分還定義了代碼塊存儲器占用空間中可變部分的大小、可編程復(fù)位向量和程序計(jì)數(shù)器。由于這些數(shù)值都是 8 位，因此每個 FSM 程序最大字節(jié)數(shù)為 256。

程序塊的指令段包含了實(shí)際的 FSM 程序。程序指令包括各種操作碼，用于對照閾值檢查傳感器輸入、檢查過零以及檢查定時器值以判斷是否超時。操作碼還指定了由當(dāng)前 FSM 狀態(tài)轉(zhuǎn)移到下一個 FSM 狀態(tài)所需的條件。此外，有些指令操作碼用于以下操作：選擇存儲在程序塊可變數(shù)據(jù)段中的閾值和掩碼；設(shè)置 IMU 傳感器中樞多路選擇器，以連接到四個可能的外部傳感器之一；以及對中斷進(jìn)行斷言。

每個 FSM 程序都可以生成中斷，并根據(jù)所選擇的輸入信號，修改相應(yīng)的寄存器值。這些寄存器值用于將數(shù)據(jù)從 IMU 傳送到主機(jī)處理器。

FSM 可視為缺少算術(shù)邏輯單元的微處理器。FSM 可以作出選擇、執(zhí)行比較，并根據(jù)比較結(jié)果決定下一個狀態(tài)。但 FSM 只能根據(jù)比較結(jié)果計(jì)算布爾值。

FSM 并不是微處理器。它可以進(jìn)行比較，并根據(jù)比較結(jié)果對程序流程進(jìn)行簡單的更改。FSM 是很簡單的機(jī)器，因而可直接用 FSM 操作碼進(jìn)行編程。FSM 沒有高級語言編譯器，但程序通常很簡單，不需要編譯器。

使用 FSM

LSM6DSO IMU 的 FSM 可以經(jīng)過編程，生成由預(yù)定義運(yùn)動模式激活的中斷信號。FSM 可同時運(yùn)行多達(dá) 16 個獨(dú)立程序以檢測運(yùn)動。每個 FSM 程序由一系列 "if-then-else" 步驟組成，以 LSM6DSO 的加速計(jì)和陀螺儀的傳感器數(shù)據(jù)流作為輸入。如果任何 FSM 程序檢測到與預(yù)編程模式相匹配的狀態(tài)，F(xiàn)SM 就會向主機(jī)處理器生成中斷。

在 16 個可用的 FSM 程序中，每個都包含三個存儲器段，分別用于固定數(shù)據(jù)、可變數(shù)據(jù)和指令。單個 FSM 程序框圖如圖 3 所示。

圖 3：STMicroelectronics 的 LSM6DSO IMU 中的 FSM 包含 16 個代碼塊，每個代碼塊包含三個存儲器段，分別用于固定數(shù)據(jù)、可變數(shù)據(jù)和指令。（圖片來源：STMicroelectronics）

代碼塊中單個程序的結(jié)構(gòu)由存儲器塊中的三個區(qū)段組成：

• 固定數(shù)據(jù)段，在所有 FSM 程序中，這部分大小均相同
• 可變數(shù)據(jù)段，這部分大小可變
• 指令段，包含條件和命令

對每個 FSM 代碼塊進(jìn)行編程時，需要將決定 FSM 行為的編程值加載到這三個存儲器段中。STMicroelectronics 在可下載的Unico 評估開發(fā)軟件與開發(fā)環(huán)境中，提供了 FSM 編程工具。STMicroelectronics 還在 Unico 開發(fā)工具中隨附了幾個 FSM 樣例程序，以幫助用戶學(xué)習(xí) FSM 編程。這些樣例程序演示了幾種基于 IMU 的中斷場景，包括：

• 基本計(jì)步器
• 自由落體的系統(tǒng)
• 簡單的運(yùn)動檢測
• 被拿起的系統(tǒng)
• 搖擺的系統(tǒng)
• 停止運(yùn)動（靜止）的系統(tǒng)
• 手腕傾斜

FSM 樣例程序演示了各種 FSM 功能的使用。任何這些樣例程序都可以安裝到STEVAL-MKI109V3eMotion STM32 評估板等 IMU 演示平臺中，這個平臺帶有一個 28 針的插座，可插入 LSM6DSOSTEVAL-MKI197V1IMU 適配器板。若要使用其中一個樣例程序?qū)?STEVAL-MKI109V2 板進(jìn)行編程，只需在 Unico 開發(fā)環(huán)境中點(diǎn)擊數(shù)下即可完成。

然而，LSM6DSO 卻遠(yuǎn)不止這么簡單。

機(jī)器學(xué)習(xí)核心

LSM6DSO IMU 還包含了一個更復(fù)雜的可編程模式匹配引擎，稱作機(jī)器學(xué)習(xí)核心。這樣可以使用來自內(nèi)部 IMU 傳感器和任何所連接外部傳感器的多個傳感器數(shù)據(jù)流，來識別各類運(yùn)動。可識別的活動類別包括靜止（無運(yùn)動）、步行、慢跑、騎行和駕駛。活動分類則采用機(jī)器學(xué)習(xí)核心的決策樹形式。

機(jī)器學(xué)習(xí)核心由三個塊組成：傳感器數(shù)據(jù)塊、計(jì)算塊和決策樹（圖 4）。機(jī)器學(xué)習(xí)核心的傳感器數(shù)據(jù)塊匯集了來自 IMU 內(nèi)部加速計(jì)和陀螺儀以及通過 I2C 接口連接到 IMU 的任何外部傳感器的數(shù)據(jù)流。計(jì)算塊可使用預(yù)定義的濾波參數(shù)對傳感器數(shù)據(jù)進(jìn)行濾波，并且計(jì)算窗口統(tǒng)計(jì)數(shù)據(jù)，包括傳感器數(shù)據(jù)的均值、方差、峰峰幅度、最小值、最大值和過零。決策樹將傳感器數(shù)據(jù)統(tǒng)計(jì)值與閾值進(jìn)行比較，對輸入數(shù)據(jù)進(jìn)行分類。

圖 4：STMicroelectronics 的 LSM6DSO IMU 的機(jī)器學(xué)習(xí)核心由三個塊組成：傳感器數(shù)據(jù)塊，用于匯集來自內(nèi)部和外部傳感器的數(shù)據(jù)流；計(jì)算塊，用于對傳感器數(shù)據(jù)進(jìn)行濾波和統(tǒng)計(jì)計(jì)算；以及決策樹，根據(jù)計(jì)算的統(tǒng)計(jì)信息對活動進(jìn)行分類。（圖片來源：STMicroelectronics）

與 LSM6DSO 的 FSM 一樣，Unico 開發(fā)環(huán)境中的專用工具可對 IMU 的機(jī)器學(xué)習(xí)核心進(jìn)行編程。

有限狀態(tài)機(jī)和機(jī)器學(xué)習(xí)核心也可與主機(jī)處理器結(jié)合使用，實(shí)現(xiàn)更為復(fù)雜的位置跟蹤算法。STMicroelectronics 可下載的X-CUBE-MEMS1軟件包可用于該公司的STM32Cube 開發(fā)系統(tǒng)，并且包括以下樣例軟件例程：

• 活動識別– 提供有關(guān)用戶正在執(zhí)行的活動類型信息，包括保持靜止、步行、健走、慢跑、騎行或駕駛。該算法常用于手機(jī)或某些可穿戴設(shè)備。
• 運(yùn)動持續(xù)時間檢測– 與計(jì)步器數(shù)據(jù)結(jié)合使用時，運(yùn)動持續(xù)時間檢測可用于確定用戶活動的秒數(shù)。該算法常用于可穿戴健身或健康跟蹤設(shè)備。
• 振動或運(yùn)動強(qiáng)度檢測– 提供有關(guān)用戶運(yùn)動強(qiáng)度的信息，可識別的運(yùn)動強(qiáng)度范圍為 0（靜止）到 10（全速跑）。該算法常用于手機(jī)或某些可穿戴健身設(shè)備。
• 攜帶位置識別– 提供有關(guān)用戶如何攜帶設(shè)備的信息，可區(qū)分以下位置：靜置桌面、手持、貼近頭部、襯衣口袋中、褲子口袋中、夾克口袋中以及戴在擺動手臂上。該算法常用于手機(jī)或其他可攜帶設(shè)備以檢測活動相關(guān)情境。

總結(jié)

為了維持定位和使用 IMU 數(shù)據(jù)檢測運(yùn)動和手勢，需要保持主機(jī)處理器持續(xù)運(yùn)行，對于由電池供電的嵌入式設(shè)計(jì)來說，這一目標(biāo)可能難以實(shí)現(xiàn)，因?yàn)橹鳈C(jī)處理器的功耗相當(dāng)高。然而，新一代低功耗 IMU 的板上處理能力足以執(zhí)行機(jī)器學(xué)習(xí)，允許主機(jī)處理器以低電流模式休眠，在必要時才喚醒，從而解決了這一問題。