趙富強，吳紅慶，杜鵬陽，牛志剛

（1.太原科技大學重型機械教育部工程研究中心，山西 太原 030024；2.太原理工大學極地工程與裝備研究院，山西 太原 030024）

1 引言

肢腿機構是移動機器人運動和承載的關鍵部件，因其結構和運動方式不同，具有較強的環(huán)境適應性，現有的肢腿機構常采用關節(jié)電機驅動，但其承受的外力矩較小，無法適用于重載場合[1]。雙推桿肢腿機構作為南極科考機器人[2]構型中連接履帶足和中心平臺的承載構件組，既對極端地形具有良好的適應性又兼?zhèn)淞己玫某休d能力。因此，有必要對雙推桿肢腿機構開展運動學分析研究。

目前針對移動機器人的運動學已開展了大量研究，文獻[3]對一種三自由度六足腿式機器人并聯驅動機械腿機構進行了運動學靜力學性能評價及幾何參數優(yōu)選。文獻[4]提出了一種基于3-UPS機構的六自由度并聯機械腿，并進行了運動學分析與運動靈活性評價。文獻[5]提出了一種液壓驅動六足跳躍機器人模型，對該機器人側面雙腿和正面雙腿豎直跳躍進行了運動學分析。文獻[6]提出了一種通過輪式與足式相互切換實現多種操作模式的新型輪腿復合機器人，給出了機器人支鏈末端的可達工作空間與移動過程中的運動軌跡。文獻[7]針對同時具有被動關節(jié)和柔性桿的欠驅動平面機械臂，分析了系統的動力學耦合特性。文獻[8]研制開發(fā)了一種多運動模式的小型輪履腿復合式移動機器人，對其運動特性、越障性能、自動復位功能進行了詳細的分析。文獻[9]提出一種新型輪腿式移動機器人，將攀爬樓梯作為越障任務和設計目標，進行了力學分析和參數設計，研究了輪腿結構參數對機器人抗沖擊能力和續(xù)航能力的影響規(guī)律。

文獻[10]分析了鏈驅動噴涂機器人的優(yōu)缺點和末端軌跡精度的影響狀況，并結合機器人本體的運動學參數，建立了基于隨機變量的噴涂機器人運動誤差模型。文獻[11]提出一種基于運動學分析的工業(yè)機器人軌跡精度補償方法，并建立了曲線運動軌跡偏差與運動學模型參數誤差映射的機器人運動軌跡誤差數學模型。文獻[12]以三自由度Delta并聯機械手為研究對象，對高速搬運作業(yè)下的操作空間和關節(jié)空間的軌跡規(guī)劃策略進行了研究。文獻[13]基于機械臂關節(jié)空間和操作空間的速度映射關系，建立了機械臂末端運動學方程。上述研究主要集中在關節(jié)電機驅動下對開環(huán)機構運動學特性的研究，對推桿驅動研究較少，因此研究雙推桿肢腿機構可提高其承載能力，拓展其應用領域。

以南極科考機器人雙推桿肢腿機構為研究對象，對其在一級推桿獨立驅動、二級推桿獨立驅動、雙推桿同步驅動三種典型運動工況下，進行運動學分析和試驗研究，揭示各肢腿角度變化，下肢腿末端運動軌跡、速度和加速度運動特性變化規(guī)律。

2 雙推桿肢腿機構

2.1 構型分析

雙推桿肢腿機構是南極科考機器人構型中連接履帶足和中心平臺的承載構件組。南極科考機器人主要由中心平臺和均布在中心平臺端角位置上的6條肢腿和履帶足組成，南極科考機器人通過各個雙推桿肢腿機構這一運動單位協同運動實現抬腿、越壑和避障等功能，如圖1所示。

圖1 南極科考機器人Fig.1 Antarctic Research Robot

雙推桿肢腿機構主要由支架、上肢腿、下肢腿、一級推桿和二級推桿組成，如圖2所示。其中，上肢腿上端與支架相連，下端與下肢腿上端相連，一級推桿安裝在支架與上肢腿之間，二級推桿安裝在上肢腿與下肢腿之間。雙推桿分別驅動上肢腿和下肢腿，使肢腿實現往復轉動，整個過程中雙推桿肢腿機構始終保持在同一平面內運動。

圖2 雙推桿肢腿機構模型圖Fig.2 Double Push Rod Leg Mechanism Model

2.2 運動分析

雙推桿肢腿機構以推桿收縮狀態(tài)為初始位置，主要分析三種典型運動工況下的運動，如圖3所示。

圖3 運動工況圖Fig.3 Motion Condition

（1）一級推桿獨立驅動：一級推桿從收縮狀態(tài)開始伸長，到達最頂端處停止，經過換向后開始收縮，最后收縮到初始位置處停止，其中二級推桿在整個過程中保持收縮狀態(tài)不動，上肢腿先順時針轉動后逆時針轉動到初始位置，下肢腿與上肢腿之間的夾角保持不變。

（2）二級推桿獨立驅動：二級推桿從收縮狀態(tài)開始伸長，到達最頂端處停止，經過換向后開始收縮，最后收縮到初始位置處停止，其中一級推桿在整個過程中保持收縮狀態(tài)不動，上肢腿與支架之間的夾角保持不變，下肢腿先順時針轉動后逆時針轉動到初始位置。

（3）雙推桿同步驅動：雙推桿同時從收縮狀態(tài)開始伸長，二級推桿先到達最頂端處停止，隨后一級推桿到達最頂端處停止，經過換向后雙推桿同時開始收縮，二級推桿先收縮到初始位置處停止，最后一級推桿收縮到初始位置處停止，整個過程中上肢腿和下肢腿都是先順時針轉動后逆時針轉動到初始位置。

3 雙推桿肢腿機構運動學數值分析

3.1 運動學方程

為揭示各肢腿角度，下肢腿末端運動軌跡、速度和加速度的變化規(guī)律，對雙推桿肢腿機構進行運動學分析，推導下肢腿末端軌跡、速度和加速度方程。以O為原點建立全局坐標系OXY，如圖4所示。圖中：l1和l2—上、下肢腿的長度；θ1—上肢腿相對于X軸方向的角度；θ2—下肢腿相對于X軸方向的角度，其中肢腿角度在X軸上方為正，在X軸下方為負；l3、l4—雙推桿長度；lA—A、I之間距離；lK—A、J之間距離；lE—E、I之間距離；lF—F、J之間距離；lG—G、B之間距離；β—下肢腿∠GBC的夾角；hy—D、A之間距離。

圖4 雙推桿肢腿機構尺寸參數Fig.4 Dimension Parameters of Double Push Rod Leg Mechanism

根據圖4得到上、下肢腿質心和下肢腿末端在X、Y軸方向的位置坐標分別為：

對式（1）～式（3）求導得到上、下肢腿質心和下肢腿末端在X、Y軸方向的速度分別為：

對式（1）～式（3）二次求導得到上、下肢腿質心和下肢腿末端在X、Y軸方向的加速度分別為：

3.2 數值模擬

為得到雙推桿肢腿機構在一級推桿獨立驅動、二級推桿獨立驅動、雙推桿同步驅動三種典型運動工況時上肢腿和下肢腿相對于X軸方向的角度，下肢腿末端運動軌跡、速度和加速度等動態(tài)特性曲線，對雙推桿肢腿機構進行運動學數值模擬，如圖5所示。參數，如表1所示?？紤]測試過程中出現偏差和延遲，將試驗測得的三種典型運動工況下推桿驅動時間分別設置到仿真中得到其仿真結果，如表2所示。在初始時刻，雙推桿都處于初始位置。

表2 運動工況參數Tab.2 Parameters of Motion Condition

圖5 雙推桿肢腿機構仿真模型Fig.5 Simulation Model of Double Push Rod Leg Mechanism

表1 雙推桿肢腿機構仿真參數Tab.1 Simulation Parameters of Double Push Rod Leg Mechanism

雙推桿驅動主要由伸長、換向和收縮三個階段組成，具體如下。

（1）伸長階段：推桿從收縮狀態(tài)開始出發(fā)，伸長50mm后到達推桿最頂端處停止；

（2）換向階段：推桿在到達最頂端后開始換向為下一階段做準備；

（3）收縮階段：推桿從最頂端處開始收縮，收縮50mm后回到初始位置。

4 試驗研究

為驗證雙推桿肢腿機構的運動學方程，對上述三種典型運動工況開展上肢腿和下肢腿相對于X軸方向的角度，下肢腿末端運動軌跡、速度和加速度試驗測試，如圖6所示。

圖6 雙推桿肢腿機構試驗臺Fig.6 Double Push Rod Leg Mechanism Test-Bed

試驗測試平臺采用低通濾波算法對試驗數據進行噪聲處理，上肢腿和下肢腿分別由XTL100電動推桿驅動，其角度變化由HWT905-232角度傳感器實時測量，數據由USB3104A數據采集儀采集，如表3所示。通過式（3）、式（6）和式（9）得到雙推桿肢腿機構末端運動軌跡、速度和加速度曲線。本試驗測試平臺在25dB、20℃干摩擦下進行，其中銷軸與軸套之間的動摩擦系數為0.25，靜摩擦系數為0.3。銷軸和軸套粗糙度為6.3，可通過加工滿足其精度要求。

表3 設備參數Tab.3 The Equipment Parameters

5 雙推桿肢腿機構動態(tài)響應分析

5.1 評價指標

對雙推桿肢腿機構進行運動學仿真與測試，得到上肢腿和下肢腿相對于X軸方向的角度，下肢腿末端運動軌跡、速度和加速度等動態(tài)特性理論與試驗曲線，并對仿真與試驗結果進行一致性對比分析。受到機械結構本體試驗條件限制，試驗與仿真結果誤差不可避免，采用相關系數(R)指標和平均相對誤差(AARE)指標評價理論與試驗中運動特征參數的一致性程度。其中，R用以反映變量之間相關關系密切程度的統計指標，R越高則試驗值與仿真值之間的擬合程度越好；AARE指的是所有測量點測量所造成的絕對誤差與被測量真值之比的平均值，AARE越小則測量數值越接近測量真值，其表達如下：

式中：XEi—試驗得到的實際測量值；XSi—仿真得到的數值模擬值；XE和XS—XEi和XSi的平均值；N—試驗數據的個數。

5.2 一級推桿獨立驅動運動特性

雙推桿肢腿機構在一級推桿獨立驅動時，上肢腿和下肢腿相對于X軸方向的角度呈先減小后增大的變化規(guī)律，如圖7、圖8所示。在（0～5.7）s伸長階段和（6.8～15）s收縮階段，各肢腿角度呈線性減小和線性增大趨勢，此時下肢腿末端速度在一級推桿獨立驅動下做勻速運動。在（5.7～6.8）s換向階段，各肢腿角度保持不變，此時雙推桿肢腿機構靜止。由表4可知，θ1的相關系數和平均相對誤差分別為0.9988和16.69%，θ2的相關系數和平均相對誤差分別為0.9954和5.68%。

圖7 上肢腿θ1角度Fig.7 Upper Limb Leg θ1 Angle

圖8 下肢腿θ2角度Fig.8 Lower Limb Leg θ2 Angle

雙推桿肢腿機構在一級推桿獨立驅動時，下肢腿末端運動軌跡是平滑連續(xù)的二次函數曲線，如圖9所示。下肢腿末端運動軌跡從（720，100）開始出發(fā)，隨一級推桿伸長逐漸移動到（590，-425），經過換向后在一級推桿收縮下回到初始位置。由于機械結構限制的影響推桿未能到達最頂端，導致下肢腿末端不能在（590，-425）與（600，-410）之間運行，因此在這區(qū)域中只存在仿真值。由表4可知，下肢腿末端運動軌跡曲線試驗值與仿真值在X軸方向上的相關系數和平均相對誤差分別為0.9995和0.77%，在Y軸方向上的相關系數和平均相對誤差分別為0.9989和14.18%，表明雙推桿肢腿機構在Y軸方向更易受到干擾。由于機構在Y軸方向受到重力作用，當推桿伸長時重力做正功，收縮時重力做負功，因此重力對雙推桿肢腿機構具有較大影響。

圖9 下肢腿末端運動軌跡Fig.9 The Movement Track of End of Lower Limb

雙推桿肢腿機構在一級推桿獨立驅動時，下肢腿末端速度、加速度變化曲線，如圖10、圖11所示。

圖10 下肢腿末端速度Fig.10 Velocity at the End of Lower Limb

圖11 下肢腿末端加速度Fig.11 Acceleration at the End of Lower Limb

下肢腿末端速度在0s、5.7s、6.8s 和14.9s 處出現階躍響應，對應其加速度出現峰值，這是因為推桿開始伸長和結束收縮時剛性沖擊造成的。在其他時間段內下肢腿末端速度趨于穩(wěn)定狀態(tài)而加速度趨向于0值，表明下肢腿末端速度在一級推桿驅動下做勻速運動，這與圖7、圖8中得到的結論一致。另外下肢腿末端速度在伸長階段比在收縮階段高，對應加速度數值也較高，這是推桿在運動過程中受重力影響導致的。由表4可知，下肢腿末端速度曲線試驗值與仿真值的相關系數和平均相對誤差分別為0.9294和11.42%，下肢腿末端加速度曲線試驗值與仿真值的相關系數和平均相對誤差分別為0.0912和89.88%。

表4 一級推桿獨立驅動下各參數相關系數和平均相對誤差Tab.4 Correlation Coefficient and Average Absolute Relative Error of Each Parameter Under the First Push Rod Independent Drive

5.3 二級推桿獨立驅動運動特性

雙推桿肢腿機構在二級推桿獨立驅動時，下肢腿相對于X軸方向的角度變化與一級推桿獨立驅動時趨勢相同，如圖12所示。在（0～5.1）s伸長階段和（5.6～11）s收縮階段，各肢腿角度呈逐漸減小和逐漸增大趨勢，此時下肢腿末端速度在二級推桿獨立驅動下做變速運動。在（5.1～5.6）s換向階段，各肢腿角度保持不變，此時雙推桿肢腿機構靜止。由表5可知，θ2的相關系數和平均相對誤差分別為0.9599和11.09%。雙推桿肢腿機構在二級推桿獨立驅動時，下肢腿末端運動軌跡是平滑連續(xù)的二次函數曲線，如圖13所示。

表5 二級推桿獨立驅動下各參數相關系數和平均相對誤差Tab.5 The Correlation Coefficient and Average Absolute Relative Error of Each Parameter Under the Secondary Push Rod Independent Drive

圖12 下肢腿θ2角度Fig.12 Lower Limb Leg θ2Angle

圖13 下肢腿末端運動軌跡Fig.13 The Movement Track of End of Lower Limb

下肢腿末端運動軌跡從（720，100）開始出發(fā)，隨二級推桿伸長逐漸移動到（560，-144），經過換向后在二級推桿收縮下回到初始位置。由表4可知，下肢腿末端運動軌跡曲線試驗值與仿真值在X軸方向上的相關系數和平均相對誤差分別在0.9997 和1.71%，在Y軸方向上的相關系數和平均相對誤差分別在0.9992和28.16%，表明肢腿機構在Y軸方向更易受到干擾，這與一級推桿獨立驅動時原因相同。

雙推桿肢腿機構在二級推桿獨立驅動時，下肢腿末端速度、加速度變化曲線，如圖14、圖15所示。

圖14 下肢腿末端速度Fig.14 Velocity at the end of lower limb

圖15 下肢腿末端加速度Fig.15 Acceleration at the End of Lower Limb

發(fā)現下肢腿末端速度運行時間比一級推桿獨立驅動時短，這是因為一級推桿需要承受上、下肢腿共同重力的影響，而二級推桿只需要承受下肢腿重力的影響，導致其運行時間有所不同。下肢腿末端速度曲線在0s、5.1s、5.6s和11s處出現階躍響應，對應其加速度出現峰值，這與一級推桿獨立驅動時原因相同。

由圖14可知，下肢腿末端速度在二級推桿獨立驅動時做變速運動，這與圖12中得到的結論一致。由表5可知，下肢腿末端速度曲線試驗值與仿真值的相關系數和平均相對誤差分別為0.9065和19.35%，下肢腿末端加速度曲線試驗值與仿真值的相關系數和平均相對誤差分別為0.1322和76.46%。

5.4 雙推桿同步驅動運動特性

雙推桿肢腿機構在雙推桿同步驅動時，上肢腿和下肢腿相對于X軸方向的角度變化與前兩種運動工況趨勢相同，如圖16、圖17 所示。一級推桿在（0～6.4）s 伸長階段和（7.2～15）s 收縮階段，上肢腿角度呈線性減小和線性增大趨勢，此時上肢腿做勻速運動。在（6.4～7.2）s換向階段，上肢腿角度保持不變，此時上肢腿靜止。二級推桿在（0～5.6）s伸長階段和（7.2～13.5）s收縮階段，下肢腿角度呈逐漸減小和逐漸增大趨勢，此時下肢腿做變速運動。在（5.6～7.2）s換向階段，下肢腿角度保持不變，此時下肢腿靜止。由于雙推桿運行時間不同，因此下肢腿末端速度在雙推桿同步驅動下做變速運動。由表6可知，θ1的相關系數和平均相對誤差分別為0.9988 和6.94%，θ2的相關系數和平均相對誤差分別為0.9866和8.03%。

圖16 上肢腿θ1角度Fig.16 Upper Limb Leg θ1 Angle

圖17 下肢腿θ2角度Fig.17 Lower Limb Leg θ2 Angle

雙推桿肢腿機構在雙推桿同步驅動時，下肢腿末端運動軌跡是由多段二次函數曲線組成，如圖18所示。下肢腿末端運動軌跡從（720，100）開始出發(fā)，隨雙推桿伸長逐漸移動到（320，-480），經過換向后在雙推桿收縮下回到初始位置，因雙推桿運行時間不同，下肢腿末端運動軌跡是一條封閉的曲線。由于機械結構限制的影響推桿未能到達最頂端，使下肢腿末端運動軌跡的試驗值與仿真值存在誤差。由表6可知，下肢腿末端運動軌跡曲線試驗值與仿真值在X軸方向上的相關系數和誤差分別在0.9997和5.10%，在Y軸方向上的相關系數和誤差分別在0.9993 和14.20%，表明肢腿機構在Y軸方向更易受到干擾，這與前兩種運動工況時的原因相同。

圖18 下肢腿末端運動軌跡Fig.18 The Movement Track of End of Lower Limb

雙推桿肢腿機構在雙推桿同步驅動時，下肢腿末端速度、加速度變化曲線，如圖19、圖20所示。

圖19 下肢腿末端速度Fig.19 Velocity at the End of Lower Limb

圖20 下肢腿末端加速度Fig.20 Acceleration at the End of Lower Limb

下肢腿末端速度在0s、0.4s、5.6s、6.4s、7.2s、13.5s和15s處出現階躍響應，對應其加速度出現峰值，其中0.4s處的峰值是由于試驗過程中一級推桿出現延遲造成的，而5.6s和13.5s處的峰值是由于二級推桿到達最頂端和回到收縮狀態(tài)造成的，其他峰值出現原因與前兩種運動工況相同。另外從圖20可知，下肢腿末端加速度試驗值與仿真值差異較大，這是因為下肢腿末端加速度是由式（3）經過二次求導得到，在實際測量中雙推桿肢腿機構在運行過程中出現振動，導致上、下肢腿相對于X軸方向的角度不斷在仿真值上下波動，這種波動經過二次求導后會使下肢腿末端加速度值不同于仿真值。由圖19可知，雙推桿肢腿機構在雙推桿同步驅動下做變速運動，這與圖16、圖17中得到的結論一致。由表6可知，下肢腿末端速度曲線試驗值與仿真值的相關系數和平均相對誤差分別為0.9540和13.72%，下肢腿末端加速度曲線試驗值與仿真值的相關系數和平均相對誤差分別為0.1654 和82.67%。

表6 雙推桿同步驅動下各參數相關系數和平均相對誤差Tab.6 Correlation Coefficient and Average Absolute Relative Error of Each Parameter Under Double Push Rod Synchronous Drive

6 結論

針對雙推桿肢腿機構一級推桿獨立驅動、二級推桿獨立驅動、雙推桿同步驅動三種典型運動工況，建立了南極科考機器人雙推桿肢腿機構運動學方程，分析了上肢腿和下肢腿相對于X軸方向角度變化規(guī)律，下肢腿末端運動軌跡、速度和加速度運動特性曲線，并進行了仿真模擬和試驗研究，結論如下：

（1）上肢腿和下肢腿相對于X軸方向角度在三種典型運動工況下呈先減小后增大的變化規(guī)律，下肢腿末端運動軌跡是連續(xù)二次函數曲線，下肢腿在一級推桿驅動時末端速度為勻速運動，在二級推桿驅動時為變速運動，下肢腿末端加速度在推桿開始伸長和結束收縮時出現峰值，在其他時間段內趨于0值。

（2）對比三種典型運動工況下的仿真值和試驗值，可得上肢腿和下肢腿相對于X軸方向角度相關系數在0.95以上，而平均相對誤差在16.69%以內；下肢腿末端運動軌跡在X軸方向最大平均相對誤差遠小于Y軸方向，表明雙推桿肢腿機構易受重力影響；下肢腿末端速度的相關系數在0.90 以上，平均相對誤差在19.35%以內。