雙足跳躍機(jī)器人的適應(yīng)性CPG運動控制

，， ，，

(哈爾濱工業(yè)大學(xué)機(jī)器人技術(shù)與系統(tǒng)國家重點實驗室，黑龍江 哈爾濱 150001)

雙足跳躍機(jī)器人的適應(yīng)性CPG運動控制

王婷婷，査富生，郭偉，李滿天，孫立寧

(哈爾濱工業(yè)大學(xué)機(jī)器人技術(shù)與系統(tǒng)國家重點實驗室，黑龍江 哈爾濱 150001)

0 引言

生物學(xué)實驗表明，生物體跑、跳等節(jié)律運動是由位于脊髓中的CPG產(chǎn)生的[1]。CPG是一種由多個神經(jīng)元構(gòu)成的神經(jīng)網(wǎng)絡(luò)，可生成一系列節(jié)律性輸出用于生物行走運動的控制[2]。而當(dāng)神經(jīng)網(wǎng)絡(luò)或生物肢體受到損傷時，CPG可通過網(wǎng)絡(luò)參數(shù)與神經(jīng)元連接的調(diào)整，生成新的運動模式以維持軀體的運動[3]。

針對機(jī)器人在環(huán)境中的適應(yīng)性問題，研究者們做出了不同的研究[4-6]。雙足機(jī)器人在運動過程中，可能由于故障和損傷等情況，使其中一足的運動受到限制，無法繼續(xù)跳躍。針對這種情況，在建立可變結(jié)構(gòu)CPG運動控制機(jī)制的基礎(chǔ)上，通過時間延遲響應(yīng)環(huán)節(jié)的添加使控制系統(tǒng)能夠響應(yīng)機(jī)器人自身狀態(tài)的改變，從而在突發(fā)狀況下及時地改變系統(tǒng)的運動模式輸出，以維持機(jī)器人的運動。

1 雙足機(jī)器人模型及其運動方式

雙足跳躍機(jī)器人結(jié)構(gòu)模型如圖1所示。機(jī)器人由2個相同的肢體腿A與腿B構(gòu)成，每個肢體具有1個與軀體相連的轉(zhuǎn)動關(guān)節(jié)，及腿部上的1個直線彈簧關(guān)節(jié)。轉(zhuǎn)動關(guān)節(jié)由其上的力矩驅(qū)動器控制，而直線彈簧關(guān)節(jié)可由其上的直線驅(qū)動器壓縮。

雙足跳躍機(jī)器人通過兩腿交替著地完成跳躍運動。當(dāng)機(jī)器人正常運動時，每一肢體均接收其對側(cè)肢體的實時狀態(tài)以生成跳躍運動，即腿A著地與將要著地時，腿B隨之收縮以避免與地面碰撞，而腿A結(jié)束1個著地周期后，腿B隨之伸長，以準(zhǔn)備下次著地。由于機(jī)器人雙腿為對稱結(jié)構(gòu)，以機(jī)器人的1條腿為例，其幾何參數(shù)如圖2所示。

圖1 雙足跳躍機(jī)器人結(jié)構(gòu)

圖2 機(jī)器人的幾何參數(shù)

機(jī)器人單足的跳躍運動過程分為著地相與擺動相。在著地過程中，機(jī)器人通過轉(zhuǎn)動關(guān)節(jié)處的驅(qū)動器輸出扭矩,維持機(jī)器人軀體與腿部的夾角τ以及器人軀體的平衡，并通過腿部彈簧處的直線驅(qū)動器動作，通過直線彈簧長度l的改變補充系統(tǒng)在跳躍過程中損耗的能量；在飛行相中通過機(jī)器人著地角θ的調(diào)節(jié),來控制機(jī)器人的前進(jìn)速度?？刂葡到y(tǒng)通過控制轉(zhuǎn)動關(guān)節(jié)與腿部彈簧處的驅(qū)動器輸出，維持機(jī)器人的穩(wěn)定跳躍。

2 可變結(jié)構(gòu)的CPG控制結(jié)構(gòu)

當(dāng)雙足跳躍機(jī)器人正常運動時，機(jī)器人的每一肢體均同時感知并接收自身與對側(cè)肢體的運動狀態(tài)，以此決定關(guān)節(jié)的運動輸出。而當(dāng)一側(cè)肢體發(fā)生故障或受到限制，無法參與運動時，需要CPG控制系統(tǒng)改變自身的連接與結(jié)構(gòu)方式，從兩足的跳躍控制結(jié)構(gòu)轉(zhuǎn)換為單足的跳躍控制結(jié)構(gòu)，且要求此時機(jī)器人單足能夠在缺乏對側(cè)肢體運動狀態(tài)反饋的情況下，獨立地控制單肢體繼續(xù)維持跳躍運動。

基于此運動控制要求，建立了可變結(jié)構(gòu)的CPG控制結(jié)構(gòu)，如圖3所示?？勺兘Y(jié)構(gòu)的雙足CPG控制結(jié)構(gòu)由2個對稱的控制單元組成，分別負(fù)責(zé)機(jī)器人腿A與腿B的運動控制。每個控制單元由4個神經(jīng)元構(gòu)成，分別接收來自自身運動狀態(tài)的刺激性輸入、來自對側(cè)肢體的刺激與抑制性輸入。當(dāng)一側(cè)的控制單元出現(xiàn)故障時，另一側(cè)的控制單元可獨立控制其所對應(yīng)的機(jī)器人肢體，維持穩(wěn)定的跳躍運動。

當(dāng)機(jī)器人一側(cè)肢體損壞或故障時，控制機(jī)制面臨的第2個問題是傳感信息的缺失。傳感信息對機(jī)器人的穩(wěn)定運動具有重要的意義，通過對傳感信息的接收與處理，機(jī)器人可響應(yīng)自身運動狀態(tài)及與環(huán)境交互狀態(tài)的變化，生成穩(wěn)定的運動。當(dāng)雙足機(jī)器人正常跳躍時，機(jī)器人雙足交替著地，其與環(huán)境的交互狀態(tài)呈周期性變化，控制系統(tǒng)在周期性傳感信息的激勵下，生成兩足交替的節(jié)律性運動；而當(dāng)機(jī)器人一足損壞或受到限制時，周期性的傳感信息反饋受到破壞，為維持機(jī)器人的穩(wěn)定跳躍運動，需對維持運動的控制單元所接收的傳感信息進(jìn)行調(diào)整與補償。

圖3 可變結(jié)構(gòu)CPG控制機(jī)制

在可變結(jié)構(gòu)的CPG運動控制機(jī)制中增加了時間延遲響應(yīng)環(huán)節(jié)T,以補償突發(fā)情況對機(jī)器人傳感信息反饋的影響。此時間延遲響應(yīng)環(huán)節(jié)分別通過刺激性連接與其所對應(yīng)的機(jī)器人肢體相連，同時受到對側(cè)肢體的抑制。當(dāng)機(jī)器人穩(wěn)定跳躍時，此環(huán)節(jié)由于受到對側(cè)肢體的抑制作用并不參與運動的控制，因此,其對機(jī)器人控制機(jī)制的刺激性作用以虛線表示。而當(dāng)對側(cè)肢體無法正常發(fā)送反饋信息時，此環(huán)節(jié)被激活，并代替對側(cè)肢體發(fā)放刺激性脈沖以維持機(jī)器人的穩(wěn)定跳躍運動。

3 CPG神經(jīng)元網(wǎng)絡(luò)模型

跳躍機(jī)器人在運動過程中，較難提前預(yù)知地面的高度與地形環(huán)境，而需要根據(jù)傳感信息實時地感知地面狀態(tài)，并根據(jù)傳感信息迅速產(chǎn)生響應(yīng)，調(diào)整機(jī)器人的運動以適應(yīng)環(huán)境。根據(jù)此控制需求，選擇Hopfield模型[7]構(gòu)建CPG神經(jīng)元網(wǎng)絡(luò)。此神經(jīng)元模型可快速響應(yīng)超過其閾值的傳感信息，迅速上升并達(dá)到峰值，其數(shù)學(xué)模型為：

(1)

yi為神經(jīng)元膜電壓;τi為時間常數(shù);Ri為神經(jīng)元傳導(dǎo)的阻尼系數(shù);xj為神經(jīng)元接收的第j個反饋信息;σ(xj)為外界激勵對神經(jīng)元的作用強(qiáng)度;ωji為第j個反饋信息對第i個神經(jīng)元的作用系數(shù)，為常數(shù);Θj為反饋信息xj作用的閾值。此神經(jīng)元模型可快速對超出神經(jīng)元閾值的反饋信號作出響應(yīng)并達(dá)到峰值，從而輸出運動控制指令。

根據(jù)可變結(jié)構(gòu)的CPG控制結(jié)構(gòu)對神經(jīng)元模型的需求，在Hopfield模型中對外界反饋項進(jìn)行了調(diào)整，添加了神經(jīng)元之間的網(wǎng)絡(luò)抑制參數(shù)，并引入了時間延遲響應(yīng)環(huán)節(jié)。以腿A為例，建立神經(jīng)元網(wǎng)絡(luò)模型為：

(2)

yBi為相對應(yīng)于腿A第i個神經(jīng)元的腿B的第i神經(jīng)元輸出;ωji為腿A所對應(yīng)的神經(jīng)網(wǎng)絡(luò)中，第j個神經(jīng)元對第i個神經(jīng)元的作用系數(shù);Ii為反饋項;xn為外界反饋項;Θn為xn所對應(yīng)的閾值；T(A)為腿A神經(jīng)元所接收的時延響應(yīng)環(huán)節(jié)激勵，由時間延遲環(huán)節(jié)fA與對側(cè)抑制環(huán)節(jié)組成。fA的表達(dá)式為：

(3)

tA為常數(shù)，可由實驗標(biāo)定。在系統(tǒng)所建立的控制結(jié)構(gòu)中，機(jī)器人每一足所對應(yīng)的神經(jīng)元網(wǎng)絡(luò)由4個神經(jīng)元構(gòu)成，故i,j=1,2,3,4。通過李雅普諾夫穩(wěn)定性方法，考察此神經(jīng)網(wǎng)絡(luò)連接系數(shù)的取值范圍，并在此基礎(chǔ)上根據(jù)可變結(jié)構(gòu)控制機(jī)制對神經(jīng)網(wǎng)絡(luò)連接系數(shù)取值的要求，得到四神經(jīng)元之間的連接矩陣為：

(4)

通過神經(jīng)元之間連接矩陣，對側(cè)足傳感信息以及時延響應(yīng)環(huán)節(jié)的添加，此神經(jīng)元網(wǎng)絡(luò)能夠在對側(cè)肢體正常運動時與對側(cè)肢體交互抑制，生成穩(wěn)定的節(jié)律性交替運動；而在對側(cè)肢體受到限制或發(fā)生故障時，能夠在時間延遲響應(yīng)環(huán)節(jié)與自身網(wǎng)絡(luò)的刺激、抑制作用連接下，控制機(jī)器人單足維持穩(wěn)定的跳躍運動。

在此神經(jīng)元網(wǎng)絡(luò)中，神經(jīng)元1與神經(jīng)元2接收機(jī)器人足與地面的接觸力信息，當(dāng)接觸力超過閾值時，產(chǎn)生響應(yīng)并激活神經(jīng)元3與神經(jīng)元4的運動。神經(jīng)元3，4接收機(jī)器人腿部彈簧的力信息，并與神經(jīng)元1,2的信息調(diào)控輸出節(jié)律性的動作信號，神經(jīng)元3,4的輸出為神經(jīng)元網(wǎng)絡(luò)的最終輸出。

此神經(jīng)元網(wǎng)絡(luò)可模擬生物CPG生成節(jié)律性輸出信號，用于控制機(jī)器人的動作時序，而機(jī)器人關(guān)節(jié)驅(qū)動器對這些運動命令的執(zhí)行，則通過簡單的運動神經(jīng)元的構(gòu)建來實現(xiàn)。其中，機(jī)器人軀體與肢體相連接部分的轉(zhuǎn)動關(guān)節(jié)，其輸出為力矩。以腿A為例，轉(zhuǎn)動關(guān)節(jié)運動神經(jīng)元的模型為：

(5)

φ為機(jī)器人腿與軀體的夾角;α為機(jī)器人軀體傾角;φd為轉(zhuǎn)動關(guān)節(jié)運動的目標(biāo)角，y3=1時，φd=0，而y4=1時，φd的值可根據(jù)機(jī)器人的目標(biāo)速度由實驗標(biāo)定；k1，k2為反饋信息的作用系數(shù)，為大于零的常數(shù)，其值可由實驗標(biāo)定。腿A直線彈簧所對應(yīng)的驅(qū)動器，其運動輸出為：

(6)

Δl為機(jī)器人運動過程中腿部彈簧的最大壓縮量;Δld為壓縮量的目標(biāo)值;k3，k4為大于零的常數(shù)，k4為反饋信息的作用系數(shù)，其值可由實驗標(biāo)定。

4 仿真實驗

為驗證控制方法的有效性，在ADAMS中建立雙足機(jī)器人的虛擬樣機(jī)，并利用Matlab/Simulink建立了相對應(yīng)的控制機(jī)制，通過聯(lián)合仿真對此控制方法進(jìn)行驗證。相平面軌跡如圖4所示。

圖4 相平面軌跡

由圖4可以看出，機(jī)器人在2種運動狀態(tài)下，其在相平面上的軌跡均收斂于一個穩(wěn)定的極限環(huán)。實驗結(jié)果表明，控制機(jī)制能夠在2種狀態(tài)下控制機(jī)器人實現(xiàn)穩(wěn)定的跳躍運動。在受限運動狀態(tài)下，機(jī)器人軀體傾角與角速度振蕩的范圍均大于在正常運動狀態(tài)下的振蕩范圍。這是由于機(jī)器人運動受限的一側(cè)肢體對機(jī)器人的運動存在影響，機(jī)器人單足需要同時克服機(jī)器人軀體與對側(cè)足的轉(zhuǎn)動慣性影響以維持機(jī)器人軀體的穩(wěn)定跳躍。

考察突發(fā)狀況對機(jī)器人運動的影響，首先考察機(jī)器人的運動節(jié)律能否在突發(fā)狀態(tài)下維持穩(wěn)定，通過機(jī)器人與地面的接觸狀態(tài)考察其運動節(jié)律的變化，實驗結(jié)果如圖5所示。圖5中，實線與虛線分別為機(jī)器人腿A與腿B與地面的接觸力，令機(jī)器人腿B在t=6 s時刻自由度受到限制。由圖5可以看出，在6 s之前，機(jī)器人雙腿交替接觸地面，且兩足與地面的支持力相等，而在6 s之后，腿B無法參與運動，而此時腿A仍可維持機(jī)器人的穩(wěn)定跳躍運動，且其節(jié)律、接觸力峰值保持不變。實驗結(jié)果表明，系統(tǒng)提出的控制機(jī)制可在機(jī)器人一足無法參與運動的情況下，繼續(xù)維持穩(wěn)定的跳躍運動節(jié)律。

圖5 機(jī)器人與地面的接觸狀態(tài)

進(jìn)一步考察在此運動機(jī)制的控制下，突發(fā)狀態(tài)對機(jī)器人其他運動參數(shù)的影響。由于機(jī)器人被限制在XY平面內(nèi)運動，共有沿X軸、沿Y軸、繞Z軸3個方向的自由度。因此,分別對機(jī)器人在3個自由度上的運動進(jìn)行考察，實驗結(jié)果如圖6所示。

圖6 機(jī)器人3個自由度上的運動

觀察t=6 s以后機(jī)器人的運動，可以看出，機(jī)器人的跳躍高度基本維持不變，而前進(jìn)速度在機(jī)器人切換至單足跳躍后，有一個較小的下降，其幅度值約為0.003 m/s。機(jī)器人的軀體傾角在切換至單足運動后，其振蕩范圍加大，由0.005 rad上升至0.01 rad左右，但仍可維持穩(wěn)定振蕩。實驗結(jié)果表明，所提出的控制機(jī)制可在突發(fā)狀況下，控制機(jī)器人在3個自由度方向上生成穩(wěn)定運動，從而維持機(jī)器人的穩(wěn)定跳躍。

5 結(jié)束語

模擬生物神經(jīng)網(wǎng)絡(luò)原理建立了一種新的適應(yīng)性CPG運動控制機(jī)制。利用Hopfield神經(jīng)元數(shù)學(xué)模型構(gòu)建CPG神經(jīng)網(wǎng)絡(luò)模型，建立了能夠快速響應(yīng)傳感信息變化，實時調(diào)整機(jī)器人運動節(jié)律的運動控制結(jié)構(gòu)；模擬生物神經(jīng)元響應(yīng)機(jī)制，通過時間延遲響應(yīng)環(huán)節(jié)的建立，實現(xiàn)了CPG神經(jīng)網(wǎng)絡(luò)對機(jī)械結(jié)構(gòu)故障等突發(fā)情況的感知；在此基礎(chǔ)上，進(jìn)一步通過對生物神經(jīng)元受到損傷時自恢復(fù)特性的模擬，利用時間延遲響應(yīng)環(huán)節(jié)對神經(jīng)元連接系數(shù)矩陣的調(diào)整，實現(xiàn)了機(jī)器人在損壞和自由度受限等情況下的穩(wěn)定運動。為進(jìn)一步提高機(jī)器人的適應(yīng)能力，需要進(jìn)一步完善的工作有：根據(jù)神經(jīng)網(wǎng)絡(luò)對突發(fā)狀態(tài)的感知，在調(diào)節(jié)機(jī)器人連接系數(shù)矩陣的基礎(chǔ)上進(jìn)一步實現(xiàn)關(guān)節(jié)運動軌跡的調(diào)節(jié)，增加運動的柔順性與適應(yīng)能力。

[1] Delcomyn F.Neural basis of rhythmic behavior in animals[J].Science,1980,210:492-498.

[2] Brembs B.Operant conditioning in invertebrates[J].Current Opinion in Neurobiology,2003,13(6):710-717.

[3] Rossignol S.Locomotion and its recovery after spinal injury[J].Current Opinion in Neurobiology,2000,10(6):708-716.

[4] Kimura H,Fukuoka Y,Cohen A H.Adaptive dynamic walking of a quadruped robot on natural ground based on biological concepts[J].International Journal of Robotics Research,2007,26(5):475-490.

[5] Taga G,Yamaguchi Y,Shimizu H.Self organized control of bipedal locomotion by neural oscillators in unpredictable environment[J].Biological Cybernetics,1991,65(3):147-159.

[6] Zhang X,E M,Zeng X,et al.Adaptive walking of a quadrupedal robot based on layered biological reflexes[J].Chinese Journal of Mechanical Engineering,2012,25(4):654-664.

[7] Gallagher J C,Beer R D,Espenschied K S,et al.Application of evolved locomotion controllers to a hexapod robot[J].Robotics and Autonomous Systems,1996,19(1):95-103.

Adaptive Motion Control of a Biped Jumping Robot Based on CPG

WANGTingting,ZHAFusheng,GUOWei,LIMantian,SUNLining

(State Key Laboratory of Robotics and System,Harbin Institute of Technology,Harbin 150001,China)

為解決雙足跳躍機(jī)器人在突發(fā)狀況下的適應(yīng)性控制問題，依據(jù)生物中樞模式發(fā)生器(CPG)運動控制原理，建立了可變結(jié)構(gòu)的CPG運動控制機(jī)制；模擬生物神經(jīng)網(wǎng)絡(luò)的自重構(gòu)特性，在運動控制機(jī)制中添加了時間延遲響應(yīng)環(huán)節(jié)，用于突發(fā)狀況的判斷與調(diào)節(jié)。在機(jī)器人肢體突發(fā)故障或運動受到限制時，此機(jī)制可通過對自身狀態(tài)的感知自發(fā)地調(diào)整神經(jīng)網(wǎng)絡(luò)結(jié)構(gòu)，以繼續(xù)維持穩(wěn)定的運動。最后,在仿真平臺上驗證了此控制機(jī)制在正常行走與肢體自由度突然受到限制2種情況下的控制效果。

雙足機(jī)器人；適應(yīng)性控制；CPG；跳躍運動控制

For solving the adapt control problem of biped hopping robot in unexpected situations,we build a CPG control mechanism which is able to change its control structure according to robot motion status simulating the CPG control mechanism in animals.Imitating the self-reconfigurable feature of animal control mechanism,a time-delayed response link is added to this control mechanism,for judging and adjusting the robot motion under unexpected situations.When the limbs of robot suddenly fails or the motion of robot limb is restricted,this control mechanism can spontaneously adjust the structure of neural network according to perception of the robot motion status,and maintain stable hopping motion.Finally,this control mechanism is studied on a simulation platform under two situations:normal hopping and hopping when one robot limb suddenly fails.

biped robot;adaptive motion control;CPG;control of jumping motion

2014-01-15

國家自然科學(xué)基金資助項目(61175107，60901074)；機(jī)器人技術(shù)與系統(tǒng)國家重點實驗室自主課題(SKLRS200801B，SKLRS201204B)

TP242.6

A

1001-2257(2014)07-0056-04

王婷婷(1984-)，女，黑龍江克東人，博士研究生，研究方向為仿生機(jī)器人。