專利名稱：人機外骨骼系統(tǒng)及其力控制方法
技術(shù)領(lǐng)域：
本發(fā)明涉及計算機人工智能技術(shù)領(lǐng)域，更具體地，本發(fā)明涉及一種人機外 骨骼系統(tǒng)及其力控制方法。
背景技術(shù)：
人機外骨骼系統(tǒng)是一種結(jié)合人的智能與機械裝置的機械能量的特殊機械系 統(tǒng)，其中的機械裝置一般類似人形，穿戴在人身上，能夠承擔(dān)人體承受的大部 分負(fù)荷，因此稱為外骨骼，而外骨骼的動作受人控制，形成人機結(jié)合系統(tǒng)。
外骨骼控制中的一個關(guān)鍵問題是讓控制器知道操作者的意圖，在控制外骨 骼跟隨操作者的同時，保持人和外骨骼之間的作用力較小，達(dá)到外骨骼承擔(dān)負(fù) 荷，降低人體能量消耗的功能。
目前外骨骼的控制有采用預(yù)編程技術(shù)實現(xiàn)外骨骼運動，有采用肌電傳感器 測量人的意識，控制驅(qū)動器產(chǎn)生輔助力矩，也有采用角度傳感器測量人體運動，
從而控制外骨骼運動?，F(xiàn)有的系統(tǒng)和控制方法不同程度存在缺陷采用預(yù)編程 技術(shù)實現(xiàn)的運動方式有限，而人的運動方式是隨時發(fā)生改變的；采用肌電傳感 器需要在人體皮膚表面粘貼肌電傳感器，使用不便，并且在劇烈運動中，容易 脫落、易位，長時間運動后，人體出汗會影響傳感器的測量，肌電傳感器隨人 的個體不同，存在一定的差異等缺點；采用角度傳感器則需要將這些傳感器安 裝在人體上，使用不便。

發(fā)明內(nèi)容
為克服現(xiàn)有人機外骨駱系統(tǒng)及控制方法的實現(xiàn)運動方式有限、使用不便的 缺陷，本發(fā)明提供一種人機外骨骼系統(tǒng)及其力控制方法。
根據(jù)本發(fā)明的一個方面，提供了一種人機外骨骼系統(tǒng)，包括足底傳感器以 及外骨骼各關(guān)節(jié)角度傳感器、角速度傳感器和角加速度傳感器的其中一個或者
多個，分別安裝在所劃分的軀體控制模塊上，其特征在于
所述系統(tǒng)還包括外骨骼多維力傳感器，配置在外骨骼的軀干重心和上肢末 端，用于測量人機之間的交互力。
其中，所述足底傳感器包括各種形式的壓力開關(guān)、壓力傳感器和壓力鞋墊 的一個或者多個，用于獲取人體運動模態(tài)。
其中，所述壓力開關(guān)和壓力傳感器在鞋底的安裝方式包括每個鞋底可以 安裝一個或者多個，并且可以安裝在腳跟或者腳尖。
其中，所述多維力傳感器的安裝位置還可以在外骨骼下肢體末端，人體通 過所述末端和外骨骼進行交互，以使所述外骨骼獲取人體運動模態(tài)。
其中，在外骨骼的肢體環(huán)節(jié)上安裝所述多維力傳感器用于冗余控制。
其中，使用所述外骨骼各關(guān)節(jié)角度、角速度和角加速度傳感器的其中一個 或者多個間接測量所需信號，并變換為所需量值；或者采用直接測量，獲得所 需量值；所述控制模塊包括左臂控制模塊、右臂控制模、支撐腿控制模塊和擺 動腿控制模塊，并且可視為三鏈串行機械臂或者四鏈串行機械臂
根據(jù)本發(fā)明的另一方面，提供了使用上面所述任一人機外骨骼系統(tǒng)的力控 制方法，包括
步驟IO)、根據(jù)外骨骼關(guān)節(jié)角度信號、外骨骼自身質(zhì)量屬性和外骨骼幾何
屬性，獲取雅可比矩陣和重力補償力矩；
步驟20)、根據(jù)測得的多維力傳感器信號，獲取外力補償力矩； 步驟30)、才艮據(jù)所述雅可比矩陣和所述外力補償力矩，獲取關(guān)節(jié)補償力矩； 步驟40)、才艮據(jù)所述重力補償力矩和所述關(guān)節(jié)補償力矩，獲取驅(qū)動器補償
力矩，控制驅(qū)動器輸出控制力矩，實現(xiàn)外骨骼運動的力控制。
其中，步驟10)還包括
根據(jù)所需控制的自由度，選定所述關(guān)節(jié)角度信號；所述外骨骼幾何屬性包
括其各個環(huán)節(jié)的長度、環(huán)節(jié)重心到環(huán)節(jié)一端點的長度、環(huán)節(jié)重心到環(huán)節(jié)中軸線 的垂直高度，并通過對外骨骼軀干在操作空間的位置的表達(dá)進行微分處理，獲
取雅可比矩陣；根據(jù)外骨骼動力學(xué)方程，得到靜態(tài)力矩平衡方程，通過外骨骼 幾何屬性和質(zhì)量屬性，得到重力補償力矩。
其中，步驟30)還包括所述關(guān)節(jié)補償力矩可以包括關(guān)節(jié)阻尼力矩-K^，
用于改善動態(tài)響應(yīng)過程，其中^是相應(yīng)的可調(diào)阻尼矩陣參數(shù)，4為關(guān)節(jié)角速度 信號。
其中，步驟40)還包括根據(jù)所述重力補償力矩和所述關(guān)節(jié)補償力矩，應(yīng) 用力控制率方程，獲取驅(qū)動器補償力矩，所述力控制率方程為
其中，r。為驅(qū)動器補償力矩，r表示廣義空間的力和力矩，Z(《)r為外力補 償力矩；G(《)為重力補償力矩；-/^4為阻尼力矩，可作為外力補償力矩的一部 分。
本發(fā)明提出的人機系統(tǒng)外骨骼系統(tǒng)及其力控制方法不需直接在人體上安 裝任何傳感器，也不需要外骨骼復(fù)雜的動態(tài)模型，通過在人機之間的多維力傳 感器使得外骨骼了解人的意圖，同時與外骨骼本身的狀態(tài)信號相配合，實現(xiàn)外 骨骼對人體運動的跟蹤，并保持較小的人機作用力，達(dá)到省力的目的，控制簡
單方便。


圖1為人機外骨骼系統(tǒng)示意圖2為處于支撐相的人機外骨骼系統(tǒng)示意圖3為人機外骨骼系統(tǒng)的力控制方法原理圖及流程圖4為根據(jù)實施例的關(guān)節(jié)角度跟蹤仿真曲線示意圖，其中a、 b和c分別示 出踝關(guān)節(jié)、膝關(guān)節(jié)和髖關(guān)節(jié)的角度跟蹤仿真曲線；
圖5為才艮據(jù)實施例的在操作空間的人機作用力曲線示意圖，其中a、 b和c 分別示出X方向和Y方向的人機廣義力以及繞Z軸人^/L廣義力矩；
圖6為才艮據(jù)實施例的在關(guān)節(jié)空間的人才幾作用力曲線示意圖，其中a、 b和c 分別示出踝關(guān)節(jié)、膝關(guān)節(jié)和髖關(guān)節(jié)的人機關(guān)節(jié)力矩。
具體實施例方式
下面結(jié)合附圖和具體實施例對本發(fā)明提供的一種人機外骨骼系統(tǒng)及其力控 制方法進4于詳細(xì)描述。
本發(fā)明提出的人機外骨骼系統(tǒng)及其力控制方法，用于控制外骨骼跟隨人體 運動，且保持人機作用力較小。這里所說的力是一個廣義的力，包括力和力矩， 力是指人機之間的作用力。所述系統(tǒng)包括傳感器、控制器和驅(qū)動器。所述控制 器根據(jù)所述傳感器測量得到的信息，實時生成驅(qū)動器的控制信號，控制驅(qū)動器 輸出控制力矩，實現(xiàn)外骨骼對人機運動的跟蹤，并保持人機作用力較小。
劃分控制模塊
將上肢、下肢、軀干劃分為不同的控制模塊。以軀干和上肢左臂組成左臂 控制模塊；以軀干和上肢右臂組成右臂控制模；以軀干和支撐腿組成支撐腿控 制模塊；以軀干和擺動腿組成擺動腿控制模塊。其中左臂控制模塊、右臂控制 模塊和擺動腿控制模塊均以軀干作為基點，以手和腳作為末端；而支撐腿則以 腳部作為基點，以軀干中心作為末端。同時，每個模塊可視為三鏈串行機械臂 或者四鏈串行機械臂，如圖1所示。 確定運動模態(tài)
對于左臂控制模塊和右臂控制模塊，其運動模態(tài)僅有一種，即自由擺動模 態(tài)。而對每條腿來說，其腳部觸地時處于支撐模態(tài)，腳部離地時處于擺動模態(tài)。 圖1中，外骨骼一條腿處于支撐模態(tài)，另一條腿處于擺動模態(tài)，而上肢則可始
終視為處于擺動模態(tài)，圖中黑色部分為多維力傳感器。圖2為另一實施例，外 骨骼的兩條腿均處于支撐模態(tài)。
根據(jù)拉格朗日動力學(xué)方程，可以得到外骨骼動力學(xué)方程的一般表達(dá)式為
+ C(《， +財+ = ra + rte (1)
其中，《表示關(guān)節(jié)角度，々表示關(guān)節(jié)角度的微分，即關(guān)節(jié)角速度，々表示關(guān) 節(jié)角度的兩次微分，即關(guān)節(jié)角速度，//(《)是慣性矩陣，C(《,W是Coriolis項和 離心項，A為運動摩擦系數(shù)，G(《)是重力引起的力矩，在系統(tǒng)及其應(yīng)用方法的設(shè) 計中，首先要補償?shù)暨@一部分力矩；r。表示驅(qū)動器施加的力矩，4表示人機力 矩，是人施加給外骨骼的力/力矩。從公式(1)可以看出，若驅(qū)動器不工作， 即t;-O,則外骨骼運動所需的力矩均需要由人來施加，即4,而設(shè)計系統(tǒng)控制
的目的就是使得驅(qū)動器輸出大部分控制力矩，從而大大減小人機力矩^ 。
根據(jù)圖3a所示的外骨骼力控制原理圖，圖中G。表示外骨骼的動態(tài)模型，// 表示人機之間相互作用的動態(tài)，其具體形式未知，C表示所設(shè)計的力控制器，& 表示人的關(guān)節(jié)角度，是不可測量的。
力控制率為
3Wr(9)"D",) (2) 其中，r表示驅(qū)動器施加的廣義力和力矩，且r為/的函數(shù)，即7 = ,(/),其 形式不唯一，并稱Z(《)r為外力補償力矩，其中，/為多維力傳感器的輸出信號， 表示人機之間在操作空間的作用力/力矩，同時，在關(guān)節(jié)空間的人機作用力矩 ^-^(g)/; G(《)用于補償重力力矩；i^是一個正定增益矩陣，-尺j為關(guān)節(jié)提 供一個額外的阻尼力矩來改善系統(tǒng)的動態(tài)響應(yīng)過程。該控制率在本發(fā)明的一個 實施例中，形式并不唯一，其中的-K^也可以是其它與系統(tǒng)狀態(tài)有關(guān)的量，而 G(^可以是自適應(yīng)的、模糊的、魯棒的等其它形式的補償方法。
在根據(jù)本發(fā)明的實施例中，基于圖2所示的系統(tǒng)結(jié)構(gòu)，詳述本發(fā)明所提出的系統(tǒng)和方法。
配置人機外骨骼系統(tǒng)的足底傳感器，安裝于外骨骼的鞋(靴)中，用于獲
得足底壓力信號，從而判斷系統(tǒng)運動模態(tài)；傳感器包括各種形式的壓力開關(guān)、 壓力傳感器、壓力鞋墊等。壓力開關(guān)和壓力傳感器在鞋底的安裝方式有多種 每個鞋底可以安裝一個或者多個，可以安裝在腳跟或者腳尖；壓力鞋墊則只有 陣列多少之分。
配置外骨骼多維力傳感器，安裝于外骨骼的軀干重心、鞋(靴)上，上肢 末端，用于測量人機之間的交互力；多維力傳感器的安裝位置在外骨骼肢體末 端，人體通過這些末端和外骨骼進行交互，使得外骨骼了解人的意圖；在外骨 骼的軀干上也需要安裝多維力傳感器；如果采用冗余控制，則在外骨骼的肢體 環(huán)節(jié)上也可以安裝多維力傳感器。
配置外骨骼各關(guān)節(jié)角度、角速度、角加速度傳感器，安裝于外骨骼的關(guān)節(jié) 或者環(huán)節(jié)(大腿就是一個環(huán)節(jié)、小腿也是一個環(huán)節(jié)，其它類似)上，用于測量 外骨骼的關(guān)節(jié)角度、關(guān)節(jié)角速度和關(guān)節(jié)角加速度信號；所述傳感器可以采用一 個或者多個；所述傳感器可以是單一功能的多個傳感器，亦可是多功能傳感器； 所述信號可以采用間接測量，即用其它傳感器測量其它量，經(jīng)過轉(zhuǎn)換變換為所 需量，也可以采用部分直接測量，部分經(jīng)數(shù)學(xué)計算獲得。
通過獲得的足底壓力信號，根據(jù)人體運動規(guī)律，判斷當(dāng)前運動模態(tài)；所述 運動模態(tài)指人體下肢是處于支撐模態(tài)，還是處于擺動模態(tài)。
根據(jù)運動模態(tài)以及所獲得的傳感器信號，實施力控制，減小人機作用力。 對于某一條腿來說，當(dāng)壓力傳感器輸出壓力信號大于某一閾值(閾值可以是0N、 1N......ION等，由設(shè)計者確定，比如在支撐狀態(tài)時，人體的重量壓在上面，壓力
輸出值比較大，而人想抬腿時，這個壓力減小，抬起時，變?yōu)閿[動模態(tài)，壓力 變?yōu)?附近，因此，可以取一個較小的值)時，判斷該腿處于支撐模態(tài)，小于 這一閾值時，判斷該腿處于擺動模態(tài)。
在此實施例中，外骨骼軀干和支撐腿組成支撐腿模塊，該模塊中以腳為基 點，以軀干重心為末端，在X-Y平面內(nèi)可以看作一個三鏈串行機械臂。其運動 模態(tài)為支撐模態(tài)，擺動模態(tài)的控制方法與之類似，不再贅述。以下參見圖3b所 示的力控制流程圖。
1.計算雅可比矩陣。
根據(jù)圖2，由幾何關(guān)系，可得
<formula>formula see original document page 10</formula>(3)
— m —
其中;c、 y和P表示外骨骼軀干在操作空間的位置，A和A分別表示外骨骼 小腿和大腿的長度，Z^表示外骨骼軀干重心至髖關(guān)節(jié)的長度。
對公式(3 )右側(cè)進行偏微分，并令《=[仏《2 "f，得到雅可比矩陣
其中，
<formula>formula see original document page 10</formula>(4)
(5)
(6)
(7)
所屬技術(shù)領(lǐng)域的普通技術(shù)人員應(yīng)當(dāng)清楚，根據(jù)控制模塊的不同，所述雅可 比矩陣有所不同。
2.由(1)式，令4 =《=0，得到靜態(tài)時的力矩平衡方程
<formula>formula see original document page 10</formula>(8)
根據(jù)圖2所示的幾何關(guān)系，得到重力力矩
<formula>formula see original document page 10</formula> (9)
其中
<formula>formula see original document page 11</formula>
G3 =si, +《2 + ^ )g (12) 其中，m,和化分別為外骨骼軀干、大腿、小腿的質(zhì)量，g為重力加速度， 此重力力矩即為(2)式中的重力補償力矩。本領(lǐng)域的普通技術(shù)人員應(yīng)當(dāng)清楚， 根據(jù)不同的配置，或者根據(jù)不同的關(guān)節(jié)角度定義，該重力力矩矩陣可以有所不 同。
3.在此實施例中，設(shè)定
+ (13)
其中尺,和^為可設(shè)計的參數(shù)，/表示人在廣義空間(操作空間)施加于外
骨骼軀干的廣義力，即人機作用力，由六維力傳感器測量得到，在此實施例中， 僅考慮在X-Y平面內(nèi)的運動，因此，只取其中的三個量，即
(14)
其中，y;和y;表示操作者施加與外骨骼軀干的二維平面力，7;表示操作者施
加與外骨骼軀干繞z軸的旋轉(zhuǎn)力矩。
將j(《)轉(zhuǎn)置后和r相乘，得到外力補償力矩。
4. 該實施例中，設(shè)計關(guān)節(jié)阻尼力矩-A:^改善系統(tǒng)的動態(tài)響應(yīng)過程，其中^ 是可設(shè)計的參數(shù)，42 W為測量得到的關(guān)節(jié)角速度信號。
5. 根據(jù)上述補償力矩及阻尼力矩，并根據(jù)(2)式，計算得到最終的補償
總力矩:
6.將上述補償總力矩作為控制信號，控制輸出力矩信號，從而控制外骨骼 運動。
為了說明本發(fā)明提出方法的有效性，針對該實施例，進行仿真分析。以磚
起動作為例，仿真說明及結(jié)果分析如下
外骨骼跟隨人體的運動情況如圖4所示，可以看出外骨骼很好的跟蹤了人 體的運動，兩條曲線幾乎重合，其中，實線表示人的三個關(guān)節(jié)角度曲線，點劃 線表示外骨骼的三個關(guān)節(jié)角度曲線。圖5所示為在操作空間中的人機作用力(力 矩)曲線，圖6所示為在關(guān)節(jié)空間中的人才幾作用力矩曲線。其中實線為控制器 不工作，外骨骼的所有控制力矩由操作者施加時的人機作用力(力矩)曲線， 點劃線為控制器工作時，驅(qū)動器施加大部分控制力矩時的人機作用力(力矩) 曲線，可以看出在控制器工作時，人4幾作用力(力矩)大大減小，這說明外骨 骼及其負(fù)荷主要由外骨骼來承擔(dān)，而操作者只需施加較小的控制力即可。
最后應(yīng)說明的是，以上實施例僅用以說明本發(fā)明的技術(shù)方案并且不限于此， 而是在應(yīng)用上可以延伸到其他的修改、變化、應(yīng)用和實施例，并且因此認(rèn)為所 有這樣的修改、變化、應(yīng)用、實施例都在本發(fā)明的精神和范圍內(nèi)。
權(quán)利要求
1、一種人機外骨骼系統(tǒng)，包括足底傳感器以及外骨骼各關(guān)節(jié)角度傳感器、角速度傳感器和角加速度傳感器的其中一個或者多個，分別安裝在所劃分的軀體控制模塊上，其特征在于所述系統(tǒng)還包括外骨骼多維力傳感器，配置在外骨骼的軀干重心和上肢末端，用于測量人機之間的交互力。
2、 權(quán)利要求l的系統(tǒng)，其中，所述足底傳感器包括各種形式的壓力開關(guān)、 壓力傳感器和壓力鞋墊的一個或者多個，用于獲取人體運動^f莫態(tài)。
3、 權(quán)利要求2的系統(tǒng)，其中，所述壓力開關(guān)和壓力傳感器在鞋底的安裝方 式包括每個鞋底可以安裝一個或者多個，并且可以安裝在腳跟或者腳尖。
4、 權(quán)利要求l的系統(tǒng)，其中，所述多維力傳感器的安裝位置還可以在外骨 骼下肢體末端，人體通過所述末端和外骨骼進行交互，以使所述外骨骼獲取人 體運動意圖。
5、 權(quán)利要求l的系統(tǒng)，其中，可以在外骨骼的肢體環(huán)節(jié)上安裝所述多維力 傳感器用于冗余控制。
6、 權(quán)利要求l的系統(tǒng)，其中，使用所述外骨骼各關(guān)節(jié)角度、角速度和角加 速度傳感器的其中一個或者多個間接測量所需信號，并變換為所需量值；或者 采用直接測量，獲得所需量值；所述控制模塊包括左臂控制模塊、右臂控制模、 支撐腿控制模塊和擺動腿控制模塊，并且可視為三鏈串行機械臂或者四鏈串行 機械臂
7、 使用權(quán)利要求l-6任一項所述的人機外骨骼系統(tǒng)的力控制方法，包括 步驟IO)、根據(jù)足底傳感器獲得的信號、外骨骼關(guān)節(jié)角度、角速度和角加速度信號的一個或者多個以及外骨骼自身質(zhì)量屬性和外骨骼幾何屬性，獲取雅 可比矩陣和重力補償力矩；步驟20)、才艮據(jù)多維力傳感器測得的信號，獲取外力補償力矩；步驟30)、才艮據(jù)所述雅可比矩陣和所述外力補償力矩，獲取關(guān)節(jié)補償力矩； 步驟40) 、 4艮據(jù)所述重力補償力矩和所述關(guān)節(jié)補償力矩，獲取驅(qū)動器補償 力矩，控制驅(qū)動器輸出控制力矩，實現(xiàn)外骨骼運動的力控制。
8、 權(quán)利要求7的方法，其中，步驟10)還包括根據(jù)所需控制的自由度，選定所述關(guān)節(jié)角度信號；所述外骨骼幾何屬性包 括其各個環(huán)節(jié)的長度、環(huán)節(jié)重心到環(huán)節(jié)一端點的長度、環(huán)節(jié)重心到環(huán)節(jié)中軸線的垂直高度，并通過對外骨骼軀干在操作空間的位置的表達(dá)進行微分處理，獲 取雅可比矩陣；根據(jù)外骨骼動力學(xué)方程，得到靜態(tài)力矩平衡方程，通過外骨骼 幾何屬性,得到重力補償力矩。
9、 權(quán)利要求7的方法，其中、步驟30)還包括所迷關(guān)節(jié)補償力矩可以包 括關(guān)節(jié)阻尼力矩-《j,用于改善動態(tài)響應(yīng)過程，其中A^是相應(yīng)的可調(diào)阻尼矩陣參數(shù)，4為關(guān)節(jié)角速度信號。
10、 權(quán)利要求7的方法，其中，步驟40)還包括根據(jù)所述重力補償力矩 和所述關(guān)節(jié)補償力矩，應(yīng)用力控制率方程，獲取驅(qū)動器補償力矩，所述力控制 率方程為U(^f)r-g+G。) 其中，r表示力和力矩，Z(^"為外力補償力矩；G(g)為重力補償力矩；^ 是正定增益矩陣，-Kj為關(guān)節(jié)提供阻尼力矩。
全文摘要
本發(fā)明提出一種人機外骨骼系統(tǒng)及其力控制方法，根據(jù)所需控制模態(tài)的要求，配置足底傳感器和外骨骼本身的狀態(tài)傳感器；通過在人機之間安裝的多維力傳感器，使得外骨骼了解人的意圖；通過所述傳感器獲取的信息，計算外骨骼各個關(guān)節(jié)驅(qū)動器的控制力矩；然后控制外骨骼關(guān)節(jié)旋轉(zhuǎn)，實現(xiàn)外骨骼對人體運動跟蹤的同時，保持人機之間的作用力處于較低的水平，達(dá)到省力的目的，無需在人體上安裝復(fù)雜的傳感器，簡單實用。
文檔編號A61F2/70GK101336848SQ200810214409
公開日2009年1月7日 申請日期2008年8月22日 優(yōu)先權(quán)日2008年8月22日
發(fā)明者張遠(yuǎn)山, 朱宇光, 侃 楊, 楊智勇, 楊秀霞, 穆國巖, 顧文錦 申請人:中國人民解放軍海軍航空工程學(xué)院