一種行星輪式越障機器人轉(zhuǎn)向控制方法
本發(fā)明公開了一種行星輪式越障機器人轉(zhuǎn)向控制方法,包括如 下步驟:1)根據(jù)預(yù)設(shè)轉(zhuǎn)彎半徑 R 計算前、中、后梁角理論值;2)計算 前、中、后梁角,測得機器人行星輪組當(dāng)前轉(zhuǎn)速和修正量,計算前、 中、后梁角差值;3)確定行星輪組各電機理論轉(zhuǎn)速;4)對各行星輪速度 進行調(diào)節(jié),測出電機當(dāng)前轉(zhuǎn)速;5)判斷當(dāng)前轉(zhuǎn)速與理論轉(zhuǎn)速的差值是否滿足條件:若是,則繼續(xù),若否,則返回步驟 4);6)判斷連續(xù)三次 當(dāng)前Δθ1,Δθ2,Δθ3 是否滿足條件:若是,則繼續(xù),若否,則返回 步驟&n
華中科技大學(xué)
2021-04-14