一種解耦型六自由度工業(yè)機器人的運動控制方法
本發(fā)明公開了一種解耦型六自由度工業(yè)機器人的運動控制方法,該方法包括:(a)根據(jù)機器人所需實現(xiàn)的位姿,通過 D-H 模型法獲得末端執(zhí)行機構(gòu)相對于基坐標系的位姿矩陣;(b)將機器人避開奇異形位時所能實現(xiàn)的正常位姿定義為不同的關節(jié)特性屬性,并設定機器人實現(xiàn)所需的位姿時的關節(jié)特征屬性組合;(c)根據(jù)位姿矩陣以及設定的關節(jié)特征屬性組合及其取值條件,通過反變換法分別求得關于機器人各個關節(jié)變量的唯一解;(d)根據(jù)所求得的解,執(zhí)行對六自由度工業(yè)機器人的關節(jié)運動,相應完成整體運動控制過程。通過本發(fā)明,具備可預知過奇異點路徑、算法簡單、反解速度快以及能較好地確定唯一解等優(yōu)點,并能很好地應用于實際的工業(yè)機器人運動控制。
華中科技大學
2021-04-11