基于滾動優(yōu)化的雙足機器人動態(tài)步態(tài)規(guī)劃研究.pdf

1、雙足行走機器人能夠在人類的生活和工作環(huán)境中與人類協(xié)同工作，而不需要專門為其對環(huán)境進行大規(guī)模改造，所以雙足行走機器人具有廣闊的應用前景。隨著月球探測、火星探測等太空探索活動的不斷發(fā)展，步行機器人以其靈活性的優(yōu)點可以在登陸部分扮演重要角色，此外，做為動力型假肢，可以為下肢行動不便人群在室內、室外提供行走工具。
　　雙足機器人作為研究熱點已經(jīng)存在了幾十年，各方面的理論研究都通過大量仿真和實際系統(tǒng)進行了驗證，從最簡單的平面機械模型到最先進

2、的HONDA和SONY仿生機器人，研究人員做了大量的工作。研究課題包括對步行機器人的設計、建模、動力學分析和步態(tài)綜合，但距離實際應用階段還有很大差距。傳統(tǒng)雙足機器人控制多采用離線規(guī)劃、在線跟蹤的控制策略。然而實際步行路面狀況復雜，為了使雙足機器人能夠在多種條件下穩(wěn)定步行，需要對實時步態(tài)規(guī)劃進行研究，另外計算機技術的高速發(fā)展也使得在線步態(tài)規(guī)劃成為可能。本文主要研究二維平面內步行雙足機器人的實時步態(tài)規(guī)劃問題。
　　首先，建立了平面七連

3、桿雙足機器人的運動學和動力學數(shù)學模型。運動學方面用二叉樹的數(shù)據(jù)結構描述機器人各桿件屬性和相互間連接關系，建立了基于MATLAB的運動學仿真工具箱。動力學方面建立了統(tǒng)一的單腿支撐相（SSP）和雙腿支撐相（DSP）連續(xù)非線性動力學模型和擺腳落地引起的離散動力學模型，腳跟觸地和腳尖觸地僅在拉各朗日項對應的碰撞約束條件有所不同。建立了包括3個連續(xù)運動相和3個離散運動相的混雜系統(tǒng)模型，并在此基礎上通過部分反饋線性化得到了降維后維數(shù)統(tǒng)一的混雜零動力

4、學模型。
　　其次，針對雙足機器人實時步態(tài)規(guī)劃問題，基于滾動優(yōu)化的思想提出了一種改進的非線性預測控制（NMPC）實時步態(tài)規(guī)劃方法。通過對SSP和DSP三個階段分別設定運動學和動力學虛擬約束，將復雜實時步態(tài)規(guī)劃問題轉化為四個以預測時域內廣義驅動力二次型為代價函數(shù)的的NMPC問題。仿真結果表明應用該方法對BIP機器人模型進行實時步態(tài)規(guī)劃，實現(xiàn)了包含足部轉動的動態(tài)步行，且機器人滿足穩(wěn)定性條件，不發(fā)生滑動，從而證明了該方法的有效性和可實現(xiàn)

5、性。
　　第三，保證雙足機器人步行的穩(wěn)定性是所有控制任務的重中之重，本文針對用滾動優(yōu)化實時步態(tài)規(guī)劃方法得到的擬人步行雙足機器人步態(tài)軌跡，分析了模型失配和地面環(huán)境變化條件下穩(wěn)態(tài)多步步行的魯棒周期穩(wěn)定性問題，證明了多步與單步周期穩(wěn)定性的一致性。通過對時間軸的離線積分，仿真分析了模型誤差和速度躍變誤差對極限環(huán)存在性和收斂速度的影響。
　　第四，基于滾動優(yōu)化的雙足機器人實時步態(tài)規(guī)劃可以歸納為含分段狀態(tài)約束的非線性預測控制問題。考慮到

6、實際機器人控制時有些約束條件必須嚴格滿足，同時為了提高計算效率，本文在狀態(tài)約束隱式法的基礎上提出了一種改進的快速數(shù)值算法（約束變換法）?？紤]到狀態(tài)約束有效作用域在預測時域內的分段特點，通過狀態(tài)約束的取模和平滑處理，將分段狀態(tài)約束轉化為與目標函數(shù)相同的正則形式，轉化后的狀態(tài)約束連續(xù)可微，從而可以由相同Hamiltonian方法計算目標函數(shù)和狀態(tài)約束函數(shù)對控制參數(shù)的一階導數(shù)。
　　最后，單純基于滾動優(yōu)化的雙足機器人實時步態(tài)規(guī)劃方法需要

7、在每一采樣時刻在線求解含狀態(tài)約束的動態(tài)優(yōu)化問題，求解過程復雜，計算量大。此外，基于滾動優(yōu)化的實時步態(tài)規(guī)劃方法預測時域長度固定，沒有覆蓋整個步態(tài)周期，需要設置大量虛擬運動學約束和動力學約束來保證雙足機器人步態(tài)軌跡的擬人性和穩(wěn)定性。因此本文提出了將滾動優(yōu)化與虛擬被動步行相結合的實時控制策略，分析了虛擬重力條件下七連桿機器人機械能的變化特點，設計并確定了滿足該變化特點的各關節(jié)輸入轉矩。通過優(yōu)化調整各連桿虛擬傾角、期望速度和步態(tài)周期終點系統(tǒng)狀態(tài)