首先,本文分析了雙足機(jī)器人動(dòng)態(tài)步行過(guò)程的運(yùn)動(dòng)學(xué)特征。即分析雙足步行機(jī)器人連桿的位置和姿態(tài)與各個(gè)關(guān)節(jié)角之間的關(guān)系。包含雙足機(jī)器人動(dòng)態(tài)步行的正運(yùn)動(dòng)學(xué)與逆運(yùn)動(dòng)學(xué)特性。其中,針對(duì)雙足步行機(jī)器人的逆運(yùn)動(dòng)學(xué)問(wèn)題,使用了解析法與數(shù)值法進(jìn)行求解,并對(duì)上述兩種方法進(jìn)行了對(duì)比。
其次,在針對(duì)雙足機(jī)器人動(dòng)態(tài)步行過(guò)程運(yùn)動(dòng)學(xué)特性的分析基礎(chǔ)上,推導(dǎo)出雙足步行機(jī)器人零力矩點(diǎn)(ZMP)的計(jì)算公式,該公式稱(chēng)為ZMP基本方程。ZMP基本方程描述了機(jī)器人ZMP與機(jī)器人質(zhì)心之間的關(guān)系。在此基礎(chǔ)上,使用拉格朗日方法建立了雙足步行機(jī)器人的動(dòng)力學(xué)模型,其中包括單腳支撐階段與雙腳支撐階段的動(dòng)力學(xué)模型。為了方便得到雙足步行機(jī)器人的步行模式,使用桌子——小車(chē)模型模擬機(jī)器人動(dòng)態(tài)步行。使用該等效模型與2MP基本方程,本文設(shè)計(jì)了基于ZMP的雙足機(jī)器人動(dòng)態(tài)步行模式生成算法。生成步行模式之后,將機(jī)器人關(guān)節(jié)角時(shí)間序列帶入機(jī)器人動(dòng)力學(xué)模型計(jì)算,可以得到關(guān)節(jié)力矩時(shí)間序列。關(guān)節(jié)驅(qū)動(dòng)器按照力矩時(shí)間序列控制關(guān)節(jié)運(yùn)動(dòng)即可實(shí)現(xiàn)動(dòng)態(tài)步行。但是,考慮到數(shù)值計(jì)算等因素導(dǎo)致的誤差累計(jì),本文同時(shí)基于桌子—一小車(chē)模型設(shè)計(jì)了動(dòng)態(tài)步行穩(wěn)定控制器,該控制器的作用是通過(guò)修正期望ZMP軌跡調(diào)節(jié)機(jī)器人軀干的傾斜角度。
最后,基于本文所設(shè)計(jì)的雙足步行機(jī)器人逆運(yùn)動(dòng)學(xué)問(wèn)題求解算法、動(dòng)態(tài)步行模式生成算法與步行穩(wěn)定控制器所組成的控制系統(tǒng),采用開(kāi)放源代碼動(dòng)力學(xué)引擎0pen Dynamic Engine 進(jìn)行仿真驗(yàn)證。首先在三維虛擬環(huán)境中建立了雙足步行機(jī)器人虛擬樣機(jī)模型,其次設(shè)計(jì)了零重力環(huán)境下剛體運(yùn)動(dòng)實(shí)驗(yàn)與雙足動(dòng)態(tài)步行實(shí)驗(yàn)。驗(yàn)證了本文針對(duì)雙足步行機(jī)器人動(dòng)態(tài)步行所設(shè)計(jì)的控制方法的有效性。