林卓藩,鄭浩宇,馬志偉,黃海燕,賴曉杰
近幾年來(lái),相對(duì)其他智能設(shè)備來(lái)說(shuō),可穿戴智能設(shè)備絕對(duì)是相當(dāng)熱門了,現(xiàn)如今的各類條件都為可穿戴智能設(shè)備提供了更好的發(fā)展環(huán)境。在這樣的環(huán)境下,可以將可穿戴式智能設(shè)備發(fā)展至各個(gè)領(lǐng)域,如田徑運(yùn)動(dòng),籃球比賽。
運(yùn)動(dòng)員進(jìn)行體育運(yùn)動(dòng)時(shí),實(shí)時(shí)對(duì)人體姿態(tài)進(jìn)行檢測(cè),假設(shè)穿戴者的運(yùn)動(dòng)姿勢(shì)不正確,本設(shè)計(jì)可及時(shí)反饋運(yùn)動(dòng)員存在的問題,防止運(yùn)動(dòng)員運(yùn)動(dòng)受傷和長(zhǎng)期的不規(guī)范動(dòng)作引起的關(guān)節(jié)磨損。教練也可及時(shí)分析運(yùn)動(dòng)數(shù)據(jù),指導(dǎo)運(yùn)動(dòng)員做到更標(biāo)準(zhǔn)的動(dòng)作。除了姿態(tài)檢測(cè),我們還加入了人體健康檢測(cè)的傳感器,如心率檢測(cè),防止運(yùn)動(dòng)過(guò)于激烈導(dǎo)致呼吸不順暢,MPU6050 傳感器可用來(lái)讀取當(dāng)前模塊姿態(tài)角度,由于人體特征的變化性和多樣性,大大增加了穿戴設(shè)備的姿態(tài)傳感器數(shù)目與穿戴者舒適度之間的矛盾,也需要更多的姿態(tài)傳感器才能更好的捕捉人體多個(gè)部位的角度,從而實(shí)現(xiàn)整個(gè)人體的姿態(tài)捕捉。
為了讓運(yùn)動(dòng)員做出規(guī)范動(dòng)作,減少傷病,我們采用一主機(jī)多從機(jī)的組合,主機(jī)與其中一從機(jī)放置在腰部,剩余多個(gè)從機(jī)分別放置在頭、頸、肩、大小手臂、胸、腰、大小腿幾大部位。因此從機(jī)就能捕獲到各個(gè)肢體的姿態(tài),每臺(tái)機(jī)器的芯片還會(huì)通過(guò)自帶的Wi-Fi 功能傳送至主機(jī),并由主機(jī)統(tǒng)一處理,當(dāng)動(dòng)作出現(xiàn)不符合標(biāo)準(zhǔn)的情況時(shí),上位機(jī)實(shí)時(shí)記錄,腰部的從機(jī)除了獲取肢體姿態(tài)還有人體的空間位移量,最后再將全部從機(jī)的數(shù)據(jù)共同發(fā)至主機(jī)中進(jìn)行數(shù)據(jù)結(jié)合、處理,便可在上位機(jī)實(shí)時(shí)得到人體姿態(tài)。
我們的下位機(jī)使用的是ESP32,ESP32 將天線開關(guān)、RF balun、功率放大器、接收低噪聲放大器、濾波器、電源管理模塊等功能集于一體。ESP32 只需極少的外圍器件,即可實(shí)現(xiàn)強(qiáng)大的處理性能、可靠的安全性能,和Wi-Fi&藍(lán)牙功能。利用ESP32讀取MPU6050 的原始數(shù)據(jù),經(jīng)過(guò)濾波算法得到歐拉角,再通過(guò)已經(jīng)Wi-Fi 連接的STA 模式的ESP32 發(fā)送數(shù)據(jù)給AP 端的ESP32。
MPU6050 模塊,是市面上比較成熟的一款陀螺儀模塊,將其放置于肢體上,主要用于采集姿態(tài)角度,便能讀取到相對(duì)應(yīng)的參數(shù)信息,再通過(guò)算法,將其四元素轉(zhuǎn)換成較準(zhǔn)確的歐拉角。該康復(fù)治療可穿戴設(shè)備包含多個(gè)帶有MPU6050 的從機(jī)模塊,使用者可以將這些模塊穿戴在各個(gè)部位上。該設(shè)備可以將各個(gè)部位的歐拉角信息發(fā)送至主機(jī),主機(jī)可以處理分析當(dāng)前的姿態(tài)角,并判斷使用者的動(dòng)作是否規(guī)范,若不規(guī)范則發(fā)出震動(dòng)提示,還會(huì)在上位機(jī)里會(huì)顯示完整的人體圖像,實(shí)時(shí)顯示出人體的動(dòng)作。
Unity3D 是一個(gè)能夠?qū)崿F(xiàn)輕松創(chuàng)作的多平臺(tái)的游戲開發(fā)工具,是一個(gè)全面整合的專業(yè)游戲引擎。采用該軟件作為開發(fā)平臺(tái)正是看中了其可擴(kuò)展性高的特點(diǎn)。雖然這個(gè)項(xiàng)目?jī)H僅是實(shí)現(xiàn)了運(yùn)動(dòng)捕捉和姿態(tài)重現(xiàn)的功能,但顯然這只是基礎(chǔ)性準(zhǔn)備。后期可以利用Unity3D 進(jìn)行游戲、VR、AR 等應(yīng)用程序開發(fā),而且也可以利用其跨平臺(tái)性開發(fā)移動(dòng)端軟件。我們采取Unity3D 中的人物模型來(lái)模擬人體姿態(tài),將ESP32 得到的數(shù)據(jù)通過(guò)串口發(fā)送給Unity3D 的人物模型,前提要給人物模型添加接收數(shù)據(jù)的腳本。通過(guò)這個(gè)人物模型,我們可以實(shí)時(shí)看見人體姿態(tài),還可以設(shè)定一些人體動(dòng)作的尺度范圍,模擬運(yùn)動(dòng)員運(yùn)動(dòng)過(guò)程中的分解動(dòng)作,
基于人體運(yùn)動(dòng)捕捉系統(tǒng)主要多個(gè)ESP32 協(xié)同工作構(gòu)成的人體姿態(tài)捕捉網(wǎng)絡(luò),主要由MPU6050 去捕獲當(dāng)前姿態(tài)的原始數(shù)據(jù),并用這些原始數(shù)據(jù)通過(guò)卡爾曼濾波算法優(yōu)化并消除波動(dòng),最終算出當(dāng)前姿態(tài)的角度,再將數(shù)據(jù)傳送到上位機(jī)Unity3D 以人物模型顯示出來(lái)。
卡爾曼濾波是對(duì)隨機(jī)信號(hào)作估計(jì)的算法之一。與最小二乘、維納濾波等諸多估計(jì)算法相比,卡爾曼濾波具有顯著的有點(diǎn):采用狀態(tài)空間法在時(shí)域內(nèi)設(shè)計(jì)濾波器,用狀態(tài)方程描述任何復(fù)雜多維信號(hào)的動(dòng)力特性,避開了在頻域內(nèi)對(duì)信號(hào)功率譜作分解帶來(lái)的麻煩,濾波器設(shè)計(jì)簡(jiǎn)單易行;采用遞推算法,實(shí)時(shí)量測(cè)信息經(jīng)提煉被濃縮在估計(jì)值仲,而不必存儲(chǔ)時(shí)間過(guò)程中的量測(cè)量。卡爾曼濾波能適用于白噪聲激勵(lì)的任何平穩(wěn)或非平穩(wěn)隨機(jī)向量過(guò)程的估計(jì),所得估計(jì)在線性估計(jì)中精度最佳。當(dāng)姿態(tài)解算使用了卡爾曼濾波算法之后,在使用者變換動(dòng)作時(shí),姿態(tài)的讀取也能夠更加平緩、穩(wěn)定且精準(zhǔn)。
卡爾曼濾波方程:


3)計(jì)算卡爾曼增益:

4)進(jìn)行校正更新:

如圖1 所示,這是MPU6050 角度(Yaw/Picth)變化的曲線數(shù)據(jù),黑線是實(shí)際值,藍(lán)線是mpu6050的測(cè)量值,紅線是mpu6050 的測(cè)量值經(jīng)過(guò)卡爾曼濾波得到的估計(jì)值,可見卡爾曼濾波更偏向于實(shí)際值。

圖1 卡爾曼濾波處理效果圖
當(dāng)今,本設(shè)計(jì)的系統(tǒng)通過(guò)對(duì)穿戴者日常運(yùn)動(dòng)、姿態(tài)的捕捉,采用信息融合的算法,結(jié)合心率模塊采集的心率數(shù)據(jù)可以分析出穿戴者的運(yùn)動(dòng)姿態(tài)和身體狀況,對(duì)于運(yùn)動(dòng)員和運(yùn)動(dòng)愛好者,本系統(tǒng)可提供全身、半身以及個(gè)別部位的測(cè)量及報(bào)告,教練員可對(duì)傳感器傳輸?shù)臄?shù)據(jù)加以分析,可以為運(yùn)動(dòng)員提出更好的訓(xùn)練方案,改良運(yùn)動(dòng)員一些不規(guī)范動(dòng)作。例如,全民健身已成為熱潮,但不少參與者缺乏專業(yè)性的動(dòng)作指導(dǎo),運(yùn)動(dòng)質(zhì)量不高,動(dòng)作不規(guī)范,導(dǎo)致意外受傷概率更大。
日常生活中,跑步作為常見的一種運(yùn)動(dòng),將跑步的每個(gè)動(dòng)作分解,穿著此設(shè)備者可以在上位機(jī)檢查自身動(dòng)作是否達(dá)到標(biāo)準(zhǔn)跑步動(dòng)作,達(dá)到更高的運(yùn)動(dòng)效果。可穿戴設(shè)備在未來(lái)的前景有著不可預(yù)估的潛力,智能設(shè)備的改進(jìn)與完善,為人民的生活帶來(lái)的極大的便利。
實(shí)驗(yàn)結(jié)果顯示,該系統(tǒng)結(jié)構(gòu)設(shè)計(jì)合理,功能劃分充分考慮到穿戴者的實(shí)際需求,系統(tǒng)硬件依賴度低,對(duì)網(wǎng)絡(luò)、內(nèi)存等硬件資源占用較少,且運(yùn)行穩(wěn)定。在實(shí)際運(yùn)動(dòng)中,可以有效矯正不規(guī)范的運(yùn)動(dòng)姿勢(shì),達(dá)到運(yùn)動(dòng)的最佳效果。