一種行星輪式越障機器人爬樓梯控制方法
本發(fā)明公開了一種行星輪式越障機器人爬樓梯控制方法,包括 如下步驟:1)保持越障機器人勻速直線前進,測量其同一驅(qū)動組中兩 行星輪組與前方臺階的距離及行星輪組的轉(zhuǎn)速,并計算偏轉(zhuǎn)角;2)計算各行星輪組的理論轉(zhuǎn)速,并使行星輪組以計算得出的轉(zhuǎn)速進行運動; 3)檢測當前的 L1 和 L2,并計算當前的偏轉(zhuǎn)角θ;4)判斷當前偏轉(zhuǎn)角θ 是否超過預(yù)設(shè)值:若是,則轉(zhuǎn)入步驟 2),若否,則控制機器人繼續(xù)等 速直線前進;5)判斷兩行星輪組是否到達階梯:若否,則繼續(xù)等速直 線
華中科技大學
2021-04-14