一種行星輪式越障機(jī)器人轉(zhuǎn)向控制方法
本發(fā)明公開了一種行星輪式越障機(jī)器人轉(zhuǎn)向控制方法,包括如 下步驟:1)根據(jù)預(yù)設(shè)轉(zhuǎn)彎半徑 R 計(jì)算前、中、后梁角理論值;2)計(jì)算 前、中、后梁角,測得機(jī)器人行星輪組當(dāng)前轉(zhuǎn)速和修正量,計(jì)算前、 中、后梁角差值;3)確定行星輪組各電機(jī)理論轉(zhuǎn)速;4)對各行星輪速度 進(jìn)行調(diào)節(jié),測出電機(jī)當(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