孫玲玲，趙俊卿，王　亭

（山東建筑大學(xué)理學(xué)院，山東濟(jì)南250101）

三連桿雙足步行機(jī)器人結(jié)構(gòu)建模與運動分析

孫玲玲，趙俊卿*，王亭

（山東建筑大學(xué)理學(xué)院，山東濟(jì)南250101）

雙足機(jī)器人具有與人類相似的步行運動方式，對環(huán)境具有較好的適應(yīng)能力，在機(jī)器人研究與應(yīng)用中具有重要的地位。文章基于三連桿結(jié)構(gòu)雙足步行機(jī)器人模型，運用三次函數(shù)模擬其直線運動步態(tài)，運用拉格朗日方程描述其關(guān)節(jié)力矩，建立了機(jī)器人的運動學(xué)和動力學(xué)模型，闡明了機(jī)器人運動過程狀態(tài)與關(guān)節(jié)力矩的變化規(guī)律及特點。結(jié)果表明：機(jī)器人支撐腿力矩為-350～350 N·m遠(yuǎn)大于擺動腿力矩；軀干傾角對各關(guān)節(jié)驅(qū)動力矩的影響比較復(fù)雜，即使軀干保持豎直，其驅(qū)動力矩也會在-130～130 N·m之間變化；增大步行速度，各關(guān)節(jié)力矩都會相應(yīng)增大；軀干傾角對各關(guān)節(jié)驅(qū)動力矩的影響比較復(fù)雜，在實際應(yīng)用中需要借助合理的驅(qū)動方法穩(wěn)定驅(qū)動力矩，實現(xiàn)機(jī)器人整體的平穩(wěn)運動。

分析力學(xué)；三連桿步行機(jī)器人；結(jié)構(gòu)建模；步態(tài)規(guī)劃；關(guān)節(jié)力矩

0　引言

在高危與復(fù)雜環(huán)境下，機(jī)器人以其獨特的優(yōu)勢，成為代替人類作業(yè)的重要工具。與輪式或者履帶式機(jī)器人相比，雙足步行機(jī)器人具有更好的適應(yīng)地面環(huán)境的能力，成為近年來研究的熱點。雙足步行機(jī)器人的研究涉及力學(xué)、仿生學(xué)、機(jī)械控制理論與控制工程、傳感器信息融合、計算機(jī)圖形學(xué)等多門學(xué)科，具有十分重要的學(xué)術(shù)意義和應(yīng)用價值［1-4］。

隨著機(jī)械設(shè)計與傳感技術(shù)的不斷發(fā)展，機(jī)器人研究的瓶頸問題已經(jīng)不在于樣機(jī)的研制，而是步行基礎(chǔ)理論的突破。為此，國內(nèi)外學(xué)者開展了大量的研究工作。宋憲璽建立了雙足機(jī)器人的混雜動力學(xué)模型，并對三連桿平面雙足機(jī)器人的運動進(jìn)行了仿真［1］；槐創(chuàng)鋒等建立了雙足步行機(jī)器人腿的可參數(shù)化仿真模型，并分析了影響機(jī)器人穩(wěn)定性能的參數(shù)［2］；烏海東等分析和配置了雙足機(jī)器人的腿部自由度，以通用性的原則設(shè)置驅(qū)動器，生成了運動動畫［3］；史耀強(qiáng)搭建了雙足機(jī)器人的實驗平臺，并進(jìn)行了多關(guān)節(jié)規(guī)劃動作調(diào)試與分析［4］；曾鶴基于預(yù)觀控制的仿人機(jī)器人的線性步態(tài)規(guī)劃，通過倒立擺模型建立雙臂擺動產(chǎn)生力矩與擺動角度之間的數(shù)學(xué)關(guān)系，控制生成的擺動角軌跡［5］；王健美等基于Matlab對雙足機(jī)器人進(jìn)行動力學(xué)仿真與仿生控制，實現(xiàn)了雙足機(jī)器人低能耗的穩(wěn)定行走［6］；贠今天等采用三次樣條插值方法規(guī)劃機(jī)器人的前向運動，得到各關(guān)節(jié)的平滑運動軌跡［7］；Farshimi等提出了一種被動雙足機(jī)器人模型，并進(jìn)行運動方程的推導(dǎo)與模擬參數(shù)的分析［8］；Liu等使用最優(yōu)控制律并結(jié)合彈道參數(shù)的優(yōu)化方法和微分動態(tài)規(guī)劃，對五連桿雙足機(jī)器人進(jìn)行了行走控制仿真與評估［9］?？梢钥闯?，盡管研究人員對不同的機(jī)器人結(jié)構(gòu)，采用不同的基礎(chǔ)理論和研究方法，從不同的角度進(jìn)行了探索，但系統(tǒng)、精確的數(shù)學(xué)模型還比較缺乏。

步行基礎(chǔ)理論的突破需要建立在系統(tǒng)、完善的基礎(chǔ)理論之上?；谌祟愲p足運動的內(nèi)在特點，建立精確的數(shù)學(xué)模型描述機(jī)器人的運動，是深入研究機(jī)器人步行理論、進(jìn)行穩(wěn)定性分析與控制的基礎(chǔ)［10-16］。雙足機(jī)器人的結(jié)構(gòu)可以采用三、五、七、九連桿等多連桿模型［1-5，9］。文中采用三連桿結(jié)構(gòu)，基于拉格朗日方程建立其動力學(xué)方程，用三次函數(shù)擬合其腿部運動，得到描述雙足步行機(jī)器人運動的精確數(shù)學(xué)模型，并分析了其運動狀態(tài)。對于更復(fù)雜結(jié)構(gòu)機(jī)器人的運動描述，該理論具有重要的推廣應(yīng)用價值。

1　結(jié)構(gòu)模型及建模

三連桿機(jī)器人結(jié)構(gòu)模型如圖1所示，AC和BC分別為機(jī)器人的支撐腿和擺動腿，長度分別為l1和l2，質(zhì)量分別為m1和m2則l1=l2，m1=m2；機(jī)器人的上身用軀干CD表示，其長度為l3，質(zhì)量為m3。為簡便起見，假定腿部和軀干均為質(zhì)量均勻分布的剛性連桿，因而AC、BC和CD的質(zhì)心C1、C2、和C3分別位于相應(yīng)連桿的中點。

圖1　三連桿機(jī)器人結(jié)構(gòu)模型圖

根據(jù)人體運動學(xué)資料，以中國中年男子為例，在豎直站立時，其重心在豎直方向的高度約為身體高度的55%～65%，并且重心位置隨著運動狀態(tài)發(fā)生變化［17］。假定三連桿機(jī)器人豎直站立時的重心位于髖關(guān)節(jié)C點以上、軀干CD的重心以下某處，即由式（1）表示為

式中：z為重心，m；l1、l3分別為支撐腿長度與軀干長度，m；k為比例系數(shù)。

由質(zhì)心的定義得到支撐腿與軀干質(zhì)量分別由式（2）、（3）表示為

式中：ms為機(jī)器人的總質(zhì)量，kg。

在計算中k為0.2，l1為0.55 m，l3為0.45 m，則m1為0.18 ms，m3為0.64 ms，重心位于身體高度的59.5%處，與管志光的研究結(jié)果相吻合［17］。

假定機(jī)器人在水平地面上沿x軸方向做步行運動，步行周期為T，步長為S。在任意時刻t，支撐腿AC、擺動腿BC和軀干CD的取向分別用角度q1、q2和q3表示，方向以y軸方向為正，如圖1所示。支撐腿最大取向角用q0表示，在擺動腳著地的瞬間，設(shè)q1=-q2=q0，此時A、B的間距即為步長S。

在每個步長范圍內(nèi)，支撐腿的取向角q1用三次函數(shù)式（5）表示為

式中：t為時間，s；a、b、c、d為比例系數(shù)。

若q1（t）=-q2（t），且q1（0）=q0，q1（T/2）=0，q1（T）=-q0，則q1由式（6）表示為

考慮某個步行周期，設(shè)在任意時刻t，支撐腿AC位于角位置q1（t），角速度為，則支撐腿的動能由式（7）表示為

式中：Ek1為支撐腿動能，J；為支撐腿角速度，rad/ s。

以水平地面作為零勢面，支撐腿的勢能由式（8）表示為

式中：Ep1為支撐腿勢能，J；g為重力加速度，m/s2。對于擺動腿BC，其質(zhì)心速度由式（9）表示為

擺動腿的動能由式（10）表示為

式中：Ek2為擺動腿動能，J。

擺動腿的勢能由式（11）表示為

式中：Ep2為擺動腿勢能，J。

對軀干CD，其質(zhì)心速度由式（12）表示為

軀干的動能由式（13）表示為

式中：Ek3為軀干動能，J。

軀干的勢能由式（14）表示為

式中：Ep3為軀干動能，J。

式中：Ek為系統(tǒng)總動能，J；Ep為系統(tǒng)總勢能，J。

將拉格朗日函數(shù)分別對其自變量求導(dǎo)，得到式（16）～（21）為

代入拉格朗日方程，各關(guān)節(jié)力矩由式（22）表示為

式中：Qi為各關(guān)節(jié)力矩，N·m；qi為各關(guān)節(jié)的角位置，°；為各關(guān)節(jié)的角速度，rad/s。

取i=1，得到支撐腿力矩Q1由式（23）表示為

取i=2，得到擺動腿力矩Q2由式（24）表示為

取i=3，得到軀干力矩Q3由式（25）表示為

最終可將驅(qū)動力矩寫成矩陣形式，由式（26）表示為

式中：

將式（26）簡記為式（27）為

式中：M（q）是3×3的對稱矩陣，稱為系統(tǒng)的慣性矩陣；C（q）是3×3的反對稱矩陣，與離心力和科氏力有關(guān)；G（q）是3×1的矩陣，為重力項。式（27）反映了關(guān)節(jié)力矩與關(guān)節(jié)變量、速度、加速度之間的關(guān)系。

2　模擬運動分析

取機(jī)器人總質(zhì)量ms=50 kg，軀干取向角q3= 0°，步行周期T=3 s，支撐腿最大取向角q0=15°進(jìn)行計算，計算結(jié)果如圖2、3所示。由圖2可知，在一個步長周期內(nèi)，隨著時間的延續(xù)，支撐腿取向角由q0變?yōu)?，即向步行前方擺動30°。擺動角速度與y軸方向相反因而為負(fù)值，如圖3所示，角速度大小在起、停時刻為0，t=T/2時最大，接近步長中心時角速度變化趨緩。

圖2　支撐腿的角位置圖

圖3　支撐腿的角速度圖

機(jī)器人的各關(guān)節(jié)力矩如圖4所示。當(dāng)T=3 s時，由圖4（a）可以看出，支撐腿力矩范圍為-350～ 350 N·m，擺動腿力矩為-85～85 N·m，支撐腿力矩遠(yuǎn)大于擺動腿力矩；豎直軀干的驅(qū)動力矩為-130～130 N·m之間，即使軀干保持豎直，隨著腿部的擺動，作用于軀干的力矩也會隨著時間發(fā)生變化。改變步行周期，取T=2 s，得到各關(guān)節(jié)的驅(qū)動力矩如圖4（b）所示，可以看出，步行周期縮短為2 s，三個驅(qū)動力矩都相應(yīng)增大，說明加快步行速度，需要增大各關(guān)節(jié)驅(qū)動力矩。

圖4　支撐腿、擺動腿與軀干的關(guān)節(jié)力矩圖

改變軀干的姿態(tài)，取軀干向步行前方傾斜的角度q3為0、3、6、9°，周期T=3 s，計算結(jié)果如圖5所示?？梢钥闯觯|干傾角對驅(qū)動力矩的影響是比較復(fù)雜的。在t1=0.25 s和t2=2.73 s附近，曲線相交于一點，在相交點前后不同的時間段，驅(qū)動力矩隨軀干傾角的變化呈現(xiàn)出不同的趨勢，隨著軀干傾斜角度的增大，驅(qū)動力矩也相應(yīng)增大，達(dá)到最小值與最大值的時間也相應(yīng)提前。

圖5　軀干前傾角度對驅(qū)動力矩的影響圖

3　結(jié)論

通過上述研究可知：

（1）三連桿雙足步行機(jī)器人模型結(jié)構(gòu)簡單，圖像清晰，能夠較好地反映三次函數(shù)和拉格朗日方程在機(jī)器人運動學(xué)和動力學(xué)狀態(tài)描述中的應(yīng)用；通過改變機(jī)器人的質(zhì)量、行走周期、軀干傾角、腿部擺動幅度等參量，可以實現(xiàn)對不同要求的機(jī)器人的控制，對于更復(fù)雜結(jié)構(gòu)機(jī)器人的結(jié)構(gòu)設(shè)計與運動控制具有一定的參考價值。

（2）當(dāng)機(jī)器人總質(zhì)量ms為50 kg，軀干取向角q3為0°，步行周期T為3 s，支撐腿最大取向角q0為15°時，支撐腿角速度在0～15°/s范圍內(nèi)平緩變化；支撐腿力矩在-350～350 N·m范圍內(nèi)變化，遠(yuǎn)大于擺動腿力矩變化范圍-85～85 N·m；盡管軀干保持豎直，但其驅(qū)動力矩隨著腿部的擺動在-130～130 N·m之間變化。通過縮短步行周期加快步行速度，各關(guān)節(jié)驅(qū)動力矩都相應(yīng)增大。軀干傾角對各關(guān)節(jié)驅(qū)動力矩的影響比較復(fù)雜，在實際應(yīng)用中需要借助合理的驅(qū)動方法穩(wěn)定驅(qū)動力矩，輔之以軀干的靈活變化，實現(xiàn)機(jī)器人整體的平穩(wěn)運動。

［1］ 宋憲璽.雙足機(jī)器人的建模與穩(wěn)定性分析［D］.合肥：中國科學(xué)技術(shù)大學(xué)，2010.

［2］ 槐創(chuàng)鋒.方躍法.5連桿雙足機(jī)器人建模和控制系統(tǒng)仿真［J］.系統(tǒng)仿真學(xué)報，2008，20（20）：5682-5686.

［3］ 烏海東，孔慶忠.雙足機(jī)器人運動學(xué)分析與仿真［J］.機(jī)械制造與自動化，2014，43（1）：171-173，186.

［4］ 史耀強(qiáng).雙足機(jī)器人步行仿真與實驗研究［D］.上海：上海交通大學(xué)，2008.

［5］ 曾鶴.仿人機(jī)器人的步態(tài)規(guī)劃和步行控制研究［D］.廣州：廣東工業(yè)大學(xué)，2014.

［6］ 王健美，付成龍，黃元林，等.基于Matlab的雙足機(jī)器人動力學(xué)仿真及仿生控制平臺［J］.系統(tǒng)仿真學(xué)報，2011，23（5）：977-983.

［7］ 贠今天，杜萌萌，桑宏強(qiáng)，等.雙足機(jī)器人結(jié)構(gòu)設(shè)計與步態(tài)規(guī)劃［J］.天津工業(yè)大學(xué)學(xué)報，2014，33（5）：80-83.

［8］ Farshimi F.，Naraghi M..A passive-biped model with multiple routes to chaos［J］.Acta Mechanica Sinica，2011，27（2）：277-284.

［9］ Liu C.G.，Atkeson C.G.，Su J.B..Neighboring optimal control for periodic tasks for systems with discontinuous dynamics［J］. Science China-Information Sciences，2011，54（3）：653-663.

［10］周雪峰.六自由度雙足機(jī)器人步行研究［D］.廣州：華南理工大學(xué)，2011.

［11］張世龍.雙足機(jī)器人的步態(tài)規(guī)劃及穩(wěn)定性研究［D］.無錫：江南大學(xué)，2014.

［12］彭勝軍，稅海濤，楊慶，等.雙足步行機(jī)器人轉(zhuǎn)彎步態(tài)規(guī)劃及其實現(xiàn)［J］.信息與控制，2010，39（6）：783-788，800.

［13］趙瑞林，孟彥京，王聰慧.教學(xué)型雙足步行機(jī)器人直線行走步態(tài)穩(wěn)定規(guī)劃方法［J］.工業(yè)儀表與自動化裝置，2014（5）：63-66.

［14］薛方正，陳強(qiáng)，厚之成.基于CPG的雙足機(jī)器人多層步行控制器設(shè)計［J］.控制與決策，2015，30（3）：467-472.

［15］柯文德.基于人體運動相似性的仿人機(jī)器人運動規(guī)劃關(guān)鍵技術(shù)研究［D］.哈爾濱：哈爾濱工業(yè)大學(xué)，2013.

［16］Jo H.S.，Mir-Nasiri N..Development of minimalist bipedal walking robot with flexible ankle and split-mass balancing systems［J］.International Journal of Automation and Computing，2013，10（5）：425-437.

［17］管志光.人體重心動態(tài)測試系統(tǒng)的研究［D］.青島：山東科技大學(xué)，2005.

Modeling and motion analysis of a three-rigid-rod biped walking robot

Sun Lingling，Zhao Junqing*，Wang Ting

（School of Science，Shandong Jianzhu University，Jinan 250101，China）

Biped robot has a similar walking motion pattern with human beings，so it has better adaptability to the environment，and plays an important role in the research and application of the robot.This paper based on the model of biped walking robot with three link structures，according to the description of the linear motion gait and the design of joint moment，through cubic functions and Lagrange equation，establishes the model of kinematics and dynamics，and mainly explored the changing rules and characteristics of the state and joint torque of the robot motion process.The results show thatthe scope of joint torque driving the supporting leg is-350 to 350 N·m，and greater than the swinging leg torque.The trunk angle effecting on the driving torque of each joint is more complex，and its scope of driving torque is-130 to 130 N·m.ncreasthe walking speed，each joint torque will increase accordingly.The research methods and results have a certain reference value for the design and motion control of a robot with a more complex structure.

analytical mechanics；three-rigid-rod walking robot；structure modeling；gait planning；joint torque

O313.7

A

1673-7644（2016）04-0366-06

2016-05-20

國家自然科學(xué)基金項目（11204161）

孫玲玲（1991-），女，在讀碩士，主要從事理論力學(xué)應(yīng)用和有機(jī)半導(dǎo)體材料與器件等方面的研究.E-mail：834285178@qq.com

*：趙俊卿（1964-），女，教授，博士，主要從事有機(jī)半導(dǎo)體材料與器件和理論力學(xué)應(yīng)用等方面的研究.E-mail：zjq@sdjzu.edu.cn