趙小磊，林木松，李　齊，史小華，趙朝盛，王洪波*

（1.河南省食品藥品審評查驗中心，鄭州450004；2.燕山大學河北省并聯(lián)機器人與機電系統(tǒng)實驗室，河北秦皇島066004）

基于加速度傳感器的下肢康復(fù)機器人示教訓練*

趙小磊1，林木松2，李齊2，史小華2，趙朝盛2，王洪波2*

（1.河南省食品藥品審評查驗中心，鄭州450004；2.燕山大學河北省并聯(lián)機器人與機電系統(tǒng)實驗室，河北秦皇島066004）

將康復(fù)治療人員的臨床治療經(jīng)驗與康復(fù)機器人的訓練結(jié)合，能夠有效提高已有下肢康復(fù)機器人的訓練性能，為此提出一種基于加速度傳感器的示教訓練方法及無線數(shù)據(jù)采集系統(tǒng)。通過已有的外骨骼式下肢康復(fù)機器人，分析并推導出關(guān)節(jié)角度與末端軌跡的關(guān)系及關(guān)節(jié)加速度與關(guān)節(jié)角度的關(guān)系。通過加速度信息分析出軌跡信息從而控制訓練軌跡。研發(fā)的無線數(shù)據(jù)采集系統(tǒng)提取康復(fù)師訓練時患者下肢加速度信息并轉(zhuǎn)化成軌跡信息，進而被用于康復(fù)機器人示教訓練控制。實驗結(jié)果證明，該系統(tǒng)能夠滿足康復(fù)機器人的示教訓練要求。

機械電子工程；加速度傳感器；機器人的示教與訓練；下肢康復(fù)機器人；無線數(shù)據(jù)采集系統(tǒng)

EEACC：6140M doi：10.3969/j.issn.1004-1699.2016.10.021

最新的統(tǒng)計數(shù)據(jù)顯示，全國肢體殘疾者約2 407萬人。2015年我國60歲以上老年人數(shù)量已超過2億，日趨嚴重的高齡化社會將會增加大量肢體殘障者。如何運用現(xiàn)代先進康復(fù)治療技術(shù)，改善患者肢體運動功能，使患者在最短時間內(nèi)達到最滿意的治療效果并最終擺脫病殘的折磨，是我國面臨的一個日趨嚴重的難題，同樣一直是康復(fù)工作者研究和實踐的重點［1-2］。然而，我國康復(fù)事業(yè)的現(xiàn)狀是：肢體殘障患者人數(shù)眾多，康復(fù)醫(yī)師缺口較大［3］，高端康復(fù)醫(yī)療設(shè)備嚴重短缺，特別是技術(shù)含量較高的智能康復(fù)設(shè)備［4-5］。傳統(tǒng)的人工康復(fù)治療方法效率低、重復(fù)性差，但仍是有效的訓練方法。康復(fù)機器人作為一種自動化的康復(fù)治療設(shè)備，可以幫助患者進行科學有效的康復(fù)訓練，使患者的運動功能得到更好的恢復(fù)［6］?，F(xiàn)行康復(fù)機器人雖然在穩(wěn)定性和重復(fù)性方面具有明顯的優(yōu)勢［7］，但提供的訓練方法比較單一，訓練方法多為內(nèi)置預(yù)定的運動軌跡，醫(yī)師無法很好的融入到機器的治療過程中，不能針對不同病情進行相應(yīng)的訓練方案的改進。

機器人示教訓練技術(shù)，即機器人示教再現(xiàn)技術(shù)，它是一種特殊的程序編制及功能實現(xiàn)過程。其實現(xiàn)過程一般可以分為示教和再現(xiàn)兩部分，首先采用一定方法讓機器人達到規(guī)定的位姿，并記錄各關(guān)節(jié)運動信息，然后結(jié)合這些信息通過某種控制算法控制機器人運動，重現(xiàn)記錄的運動過程［8］。在機器人領(lǐng)域不乏示教技術(shù)的應(yīng)用，諸如Dana Kulic和Kieu等人在人體動作捕捉技術(shù)示教方面的研究［9-10］。而將示教訓練應(yīng)用于康復(fù)機器人的訓練，能夠?qū)⒖祻?fù)醫(yī)師的臨床經(jīng)驗與康復(fù)機器人的康復(fù)訓練相結(jié)合，針對不同病人提供相應(yīng)的科學、最優(yōu)的康復(fù)訓練計劃，可以顯著改善康復(fù)機器人的治療效果。日本的Yoshifumi等人在近些年研發(fā)了一系列帶有示教功能的上肢康復(fù)機器人，其功能基于阻抗控制、數(shù)據(jù)預(yù)處理等原理，可以制定適合不同病患個體的運動軌跡及訓練方案，有效地提高了治療效果［11-13］。河北工業(yè)大學的孫建廣等人研發(fā)了一款三自由度的踝關(guān)節(jié)康復(fù)并聯(lián)機器人，其通過位置記憶可以實現(xiàn)踝關(guān)節(jié)康復(fù)訓練的示教與再現(xiàn)［14］。河南科技大學的陳天聰?shù)热藢oystick作為示教工具與下肢康復(fù)機器人技術(shù)結(jié)合，治療醫(yī)師可根據(jù)患者的具體病情，通過搖桿對機器人進行示教，操作簡單方便［15］。

專家醫(yī)師的徒手治療信息是作為康復(fù)機器人示教信息的最優(yōu)選擇，然而上述示教方法在示教信息采集時需要借助機器人本身，無法脫離機械直接的采集醫(yī)師的治療信息，故此產(chǎn)生了研發(fā)一種結(jié)合傳感技術(shù)的外置采集設(shè)備的設(shè)想。傳感技術(shù)與機器人技術(shù)的結(jié)合，不乏先例。其中西北工業(yè)大學的劉歌群等人曾將磁航向傳感器應(yīng)用在機器人定位上，該方案具有很高的性價比［16］。鄭州大學的陳輝等人將傳感技術(shù)應(yīng)用在輪式機器人控制方面，該系統(tǒng)運動控制性能穩(wěn)定，能夠在測試環(huán)境下實現(xiàn)運動路徑的準確控制［17］。經(jīng)過討論與學習，最終提出一種基于加速度傳感器的下肢康復(fù)機器人的示教訓練方法。其基本原理是：將外置加速度傳感器固定在患者下肢各關(guān)節(jié)的特定位置，康復(fù)醫(yī)師對患者進行治療的過程中，數(shù)據(jù)采集系統(tǒng)提取患者下肢的運動加速度數(shù)據(jù)并生成運動軌跡，然后轉(zhuǎn)換成相應(yīng)的控制信息，控制下肢康復(fù)機器人按照上述康復(fù)治療過程對患者進行重復(fù)訓練。

1　機械平臺

本研究是基于課題組現(xiàn)有的外骨骼式下肢康復(fù)機器人系統(tǒng)平臺，如圖1所示。

該外骨骼式下肢康復(fù)機器人的由左機械腿、右機械腿、可移動座椅、控制箱和觸摸顯示屏五部分組成。機械腿左右對稱，設(shè)計采用了擬人化的三自由度關(guān)節(jié)型結(jié)構(gòu)，由踝關(guān)節(jié)、膝關(guān)節(jié)和髖關(guān)節(jié)三部分組成，各關(guān)節(jié)均為一個自由度。機械腿內(nèi)置的長度調(diào)節(jié)機構(gòu)可實現(xiàn)大小腿長度調(diào)節(jié)，且整機兩腿之間的寬度可調(diào)，可以適應(yīng)不同身高體型的患者。各關(guān)節(jié)由直流電機與傳動驅(qū)動鏈驅(qū)動。各關(guān)節(jié)的回轉(zhuǎn)運動組合實現(xiàn)各連桿的運動，最后使機械腿的末端完成特定的運動軌跡。可移動座椅可以和機器人主體分離，方便病患的搬移。該康復(fù)機器人擁有主動訓練模態(tài)、被動訓練模態(tài)等多種訓練模態(tài)［18］。

圖1　外骨骼式下肢康復(fù)機器人

2　無線數(shù)據(jù)采集系統(tǒng)設(shè)計

基于三軸加速度傳感器設(shè)計了人體下肢加速度信息采集系統(tǒng)。該系統(tǒng)由上位機、數(shù)據(jù)采集主系統(tǒng)和數(shù)據(jù)采集分系統(tǒng)組成。采用星狀點對多點通信系統(tǒng)結(jié)構(gòu)模式，數(shù)據(jù)采集主系統(tǒng)與每一臺數(shù)據(jù)采集分系統(tǒng)都通過無線數(shù)據(jù)傳輸模塊以雙向通信的方式進行數(shù)據(jù)傳送。無線數(shù)據(jù)采集系統(tǒng)結(jié)構(gòu)框圖如圖2所示。

圖2　無線數(shù)據(jù)采集系統(tǒng)結(jié)構(gòu)框圖

2.1無線數(shù)據(jù)采集系統(tǒng)硬件設(shè)計

數(shù)據(jù)采集主系統(tǒng)包括控制單元、NRF24L01無線數(shù)據(jù)傳輸模塊、串口通信模塊和電源模塊4部分，如圖3所示。其功能主要是接收并解析上位機發(fā)送的串口控制指令，與接收無線數(shù)據(jù)分系統(tǒng)通信獲取加速度數(shù)據(jù)并發(fā)送給上位機。

圖3　數(shù)據(jù)采集主系統(tǒng)實物圖

數(shù)據(jù)采集分系統(tǒng)包括控制單元、NRF24L01無線數(shù)據(jù)傳輸模塊、ADXL345加速度計模塊和電源模塊四部分，如圖4所示。選用的加速度傳感器是ADI公司采用MEMS技術(shù)開發(fā)的數(shù)字式三軸加速度計ADXL345，其功能主要是通過ADXL345加速度計模塊采集當前加速度值，并發(fā)送給采集主系統(tǒng)。

圖4　數(shù)據(jù)采集分系統(tǒng)實物圖

使用時加速度傳感器固定在使用者下肢的大腿和小腿的特定位置，如圖5所示。ADXL345芯片以O(shè)-xy平面豎直進行布置，其中，x軸沿大腿、小腿軸線方向。

圖5　測量裝置使用方法

2.2上位機軟件設(shè)計

無線數(shù)據(jù)采集系統(tǒng)上位機軟件是基于NI（National Instrument）公司的 LabVIEW軟件編寫的。主要由加速度信號分時采集、數(shù)據(jù)處理、軌跡生成以及其他附加功能等幾部分組成。軟件流程圖如圖6所示。

圖6　無線數(shù)據(jù)采集系統(tǒng)上位機軟件流程圖

上位機軟件的用戶界面包括參數(shù)設(shè)置、控制按鈕、角度顯示、姿態(tài)顯示和末端軌跡顯示等五部分內(nèi)容。如圖7所示，為調(diào)試時的數(shù)據(jù)參數(shù)，可以清楚直觀的顯示出運動的姿態(tài)、軌跡圖及角度等信息。

圖7　上位機軟件用戶界面

3　示教軌跡算法

基于加速度傳感器獲取人體下肢運動軌跡，需要通過一定方法建立人體下肢運動的加速度與運動軌跡的對應(yīng)關(guān)系。通過確定各關(guān)節(jié)的尺寸參數(shù)和角度信息，即可得到肢體的位姿，而運動軌跡就是下肢位姿序列，只需再確定關(guān)節(jié)角度與加速度之間的關(guān)系即可推導出加速度與運動軌跡的關(guān)系。所以示教軌跡算法的基本內(nèi)容是確定關(guān)節(jié)角度與末端運動軌跡的關(guān)系和關(guān)節(jié)加速度與角度的關(guān)系。

3.1關(guān)節(jié)角度與末端運動軌跡的關(guān)系

末端軌跡主要是大腿和小腿部分運動的結(jié)果，因此將下肢模型簡化為二連桿機構(gòu)。建立其簡化模型如圖8所示。

圖8　人體下肢簡化的二連桿模型

圖8中OA表示大腿部分，即連桿1，AB表示小腿部分，即連桿2。L1、L2分別是人體下肢大腿、小腿的長度，O、A、B表示髖關(guān)節(jié)、膝關(guān)節(jié)和踝關(guān)節(jié)，C、D為傳感器安裝位置。O-x0y0為基坐標系，O-x1y1、A-x2y2分別與連桿1、連桿2固連，B-x3y3固定在連桿2的末端。θi為Li-1繞zi軸轉(zhuǎn)到Li的轉(zhuǎn)角，規(guī)定逆時針為正、順時針為負。

B點相對基坐標系的位置坐標（xB，yB）為：

末端運動軌跡即為B點相對基坐標系的位置坐標序列。

3.2關(guān)節(jié)加速度與角度的關(guān)系

將人體下肢在矢狀面內(nèi)等效成平面2R串聯(lián)機構(gòu)，采用遞推的牛頓-歐拉遞推動力學方程對各連桿的速度和加速度進行推導。該方法的特點是在連桿坐標系中描述自身的運動，而連桿運動一般是用連桿坐標系原點的速度和加速度，以及連桿坐標系的角速度和角加速度來描述的［19］。

用vi和ωi分別表示連桿坐標系｛i｝相對于基坐標系｛0｝的線速度和角速度，ivi和iωi表示vi和ωi在坐標系｛i｝中的線速度和角速度，i+1vi+1和i+1ωi+1是在坐標系｛i+1｝中的線速度和角速度，是在坐標系｛i｝中的線加速度和角加速度，和是在坐標系｛i+1｝中的線加速度和角加速度。

角速度和線速度傳遞公式可以表示為：

角加速度和線加速度傳遞公式可以表示為：

3.2.1單關(guān)節(jié)單桿模型

首先對大腿傳感器位置進行速度和加速度推導，以髖關(guān)節(jié)作為支點，運動可以看成是剛體圍繞支點轉(zhuǎn)動的平面運動。

通過上述式（2）、式（3）求出加速器安裝位置點C相對于基坐標系｛0｝表示的線加速度

由加速度傳感器采集到的加速度信號可知：

代入式（4）中，得到關(guān)于θ1的二階微分方程組

式中ax為加速度計自身x軸的測量值，ay為加速度計自身y軸的測量值，g為重力加速度，l1對應(yīng)于連桿1上加速度傳感器安裝的位置。

3.2.2雙關(guān)節(jié)二連桿模型

采用相同的方法求出小腿傳感器安裝位置D相對于基坐標系｛0｝表示的線加速度

由加速度傳感器采集到的加速度信號可知：

代入式（7）中，得到關(guān)于θ2二階微分方程組方程組

式中ax為加速度計自身x軸的測量值，ay為加速度計自身y軸的測量值，g為重力加速度；L1是連桿1長度，l2對應(yīng)于連桿2上加速度傳感器安裝的位置，θ1為連桿1關(guān)節(jié)角度。

這樣便確定了加速度與關(guān)節(jié)角度的關(guān)系，進而即可求解人體下肢運動軌跡。

4　試驗及其結(jié)果分析

實驗者大腿長度400 mm，小腿長度420 mm，即為所述L1與L2；加速度安裝位置分別為200 mm和210 mm，即為所述l1與l2。圖9為下肢康復(fù)機器人示教訓練實驗流程圖。

圖9　下肢康復(fù)機器人示教訓練實驗流程圖

具體下肢康復(fù)機器人示教訓練的實驗過程如下。

①實驗者下肢佩戴無線數(shù)據(jù)采集模塊，在他人幫助下完成一定的運動。無線數(shù)據(jù)采集系統(tǒng)采集人體大腿和小腿的運動角度信息。如圖10所示，獲得圖10（a）和圖10（b）所示的實驗者下肢運動角度曲線，運動數(shù)據(jù)經(jīng)過平滑處理后用于機器人示教。

②將采集的人體下肢運動信息用于康復(fù)機器人的示教，控制康復(fù)機器人進行康復(fù)訓練，并利用康復(fù)機器人自身的絕對位置編碼器，獲取機械腿運動過程中大腿和小腿的角度信息。如圖11所示，獲得的機器人訓練運動角度曲線如圖11（a）和圖11（b）。可以發(fā)現(xiàn)，機器人訓練角度曲線與實驗者下肢運動角度曲線基本相符，且平滑度高。

圖10　人體下肢運動角度采集結(jié)果

圖11　康復(fù)機器人運動角度采集結(jié)果

③根據(jù)人體下肢和康復(fù)機器人的運動角度信息生成各自的運動軌跡，并進行比較，分析該無線數(shù)據(jù)采集系統(tǒng)用于下肢康復(fù)機器人示教訓練的可行性。最后生成的人體下肢與康復(fù)機器人運動軌跡如圖12所示。

圖12　人體下肢與康復(fù)機器人運動軌跡比較

由圖12可知，人體下肢運動軌跡與康復(fù)機器人訓練軌跡在部分采樣點處，存在較大的位置誤差，但是總體運動趨勢相符，整體重合度較高。所以，在一定誤差允許范圍內(nèi)，使用該無線數(shù)據(jù)采集系統(tǒng)進行下肢康復(fù)機器人示教訓練是可行的。

5　結(jié)論

傳統(tǒng)的人工康復(fù)與機器人康復(fù)訓練各有利弊，只有將康復(fù)治療人員的臨床經(jīng)驗與康復(fù)機器人的康復(fù)訓練相結(jié)合，才能提供高效、穩(wěn)定、重復(fù)性好的訓練方法。提出了一種基于加速度傳感器的人體下肢運動信息采集方法以及相關(guān)的無線數(shù)據(jù)采集系統(tǒng)。確定了關(guān)節(jié)角度與末端軌跡的關(guān)系及關(guān)節(jié)加速度與關(guān)節(jié)角度的關(guān)系。設(shè)計一套無線數(shù)據(jù)采集系統(tǒng)，主要包括硬件搭建及其上位機相關(guān)軟件的設(shè)計。經(jīng)過測試，該系統(tǒng)能夠用于下肢康復(fù)機器人的示教訓練。

［1］Colombo G，Matthias J，Reinhard S，et al.Treadmill Training of Paraplegic Patients Using a Robotic Orthosis［J］.Rehabilitation Res Develop，2000，37（6）：693-700.

［2］Veneman J F，Kruidhof R，Hekman E E G，et al.Design and Evaluation of the LOPES Exoskeleton Robot for Interactive Gait Rehabilitation［J］.IEEE Trans Neural Syst Rehabil Engng，2007，15（3）：379-386.

［3］黃海靈，吳洪濤，陳柏.基于柔索驅(qū)動的踝關(guān)節(jié)康復(fù)機器人的研究［J］.中國制造業(yè)信息化，2012，41（3）：27-29.

［4］Zhu Y，Zhen R，Liu H，et al.The Research of Rehabilitation Robots BCI Technology Based on EEG［M］.Wuhan：People’s Republic of China，12-14 December，2008：1107-1110.

［5］Krebs H，Dipietro L，Levy-Tzedek S，et al.A Paradigm Shift for Rehabilitation Robotics［J］.Engineering in Medicine and Biology Magazine，2008，27（4）：61-70.

［6］Tejima N.Rehabilitation Robotics：A Review Advanced Robotics［J］.，2000，14（7）：551-564.

［7］Hillman M.Rehabilitation Robotics from Past to Present：A Historical Perspective［J］.Advances in Rehabilitation Robotics，2004，306：25-44.

［8］龔建偉，高峻堯，熊光明.基于航向示教再現(xiàn)的履帶式移動機器人路徑跟蹤［J］.兵工學報，2003，24（1）：102-105.

［9］Dana K，Christian O，Dongheui L，et al.Incremental Learning of Full Body Motion Primitives and Their Sequencing Through Human Motion Observation［J］.The International Journal of Robotics Research，2011，31（3）：330-345.

［10］Kieu T C，Yamazaki K，Hanai R，et al.Grasp Observation and Reproduction by Humanoid Robots Using Color Camera and 3D Sensor［J］.2011 IEEE/SICE International Symposium on System Integration（SII），2011：808-813.

［11］Yoshifumi M，Masaya N，Hiroyuki U，et al.Development of Rehabilitation Training Support System of Upper Limb Motor Function for Personalized Rehabilitation［C］//International Coference on Robotics and Biomimetics，2008：300-305.

［12］Yoshifumi M，Akinori H，Takashi U，et al.Development of Rehabilitation Training Support System Using 3D Force Display Robot［M］.Robot Motion Control，2007：303-310.

［13］Yuichi F，Masaya N，Toshimasa A，et al.Development of Rehabilitation Support Robot for Personalized Rehabilitation of Upper Limbs［C］//International Conference on Rehabilitation Robotics，2009：787-792.

［14］Sun J G，Gao J Y，Zhang J H，et al.Teaching and Playback Control System for Parallel Robot for Ankle Joint Rehabilitation［C］//International Conference on Industrial Engineering and Engineering Management，2007：871-875.

［15］陳天聰，韓建海，王會良.基于Joystick的臥式下肢康復(fù)訓練機器人示教再現(xiàn)功能分析［J］.技術(shù)應(yīng)用，2014，2：22-25.

［15］劉歌群，劉衛(wèi)國，馬動濤.磁航向傳感器在機器人定向中的應(yīng)用［J］.傳感技術(shù)學報，2004，17（2）：224-227.

［15］陳輝，鄧記才，吳曉輝.多傳感器信息融合在輪式機器人運動控制中的應(yīng)用［J］.傳感技術(shù)學報，2011，24（6）：951-918.

［18］Deng Fuhai.Design and Research of the Mechanical System for A Multi-Joint Lower Limb Rehabilitation Robot［D］.Qinhuangdao：Master’s dissertation in Mechanical and Electronic Engineering Yanshan University，2014：39-41.

［19］Xiong Youlun.Robot Technology Foundation［M］.Wuhan：Huazhong University of Science and Technology，2010：72-77.

趙小磊（1965-），女，河南鄭州人，河南省食品藥品審評查驗中心高級工程師，主要研究方向為醫(yī)療器械技術(shù)，18638775977@126.com；

王洪波（1956-），男，河北邢臺人，國家千人計劃特聘專家，燕山大學機械工程學院教授，博士生導師，主要研究方向為機器人學與康復(fù)醫(yī)療機器人，hongbo_w@ ysu.edu.cn。

Teaching and Training of the Lower Limb Rehabilitation Robot Based on Accelerometer*

ZHAO Xiaolei1，LIN Musong2，LI Qi2，SHI Xiaohua2，ZHAO Chaosheng2，WANG Hongbo2*
（1.Center for Food and Drug Evaluation and Certification of Henan Province，Zhengzhou 450004，China；2.Parallel Robot and Mechatronic System Laboratory of Hebei Province，Yanshan University，Qinhuangdao Hebei 066004，China）

It can effectively improve the training performance of rehabilitation robot by combining the clinical experience of rehabilitation physician with rehabilitation robot training，and thus a teaching and training method based on the accelerometer and a wireless data acquisition system are proposed.Using the existing exoskeleton lower limb rehabilitation robot，the relationship between the joint angle and the end trajectory，and the relationship between the link acceleration and the joint angle are analyzed.The trajectory data is analyzed from the acceleration information，so the robot training trajectory can be controlled.Wireless data acquisition system developed collects the acceleration data when patient is trained by rehabilitation physician and transforms it into trajectory data，which can be used for the control of teaching and training.The experimental results demonstrate that the system can satisfy the teaching and training requirements of rehabilitation robot.

mechatronic engineering；accelerometer；robot teaching and training；lower limb rehabilitation robot；wireless data acquisition system

TH113

A

1004-1699（2016）10-1596-06

項目來源：教育部高等學校博士學科點專項科研基金項目（20131333110006）

2016-03-30修改日期：2016-05-16