一種解耦型六自由度工業機器人的運動控制方法

其它領域

本發明公開了一種解耦型六自由度工業機器人的運動控制方法，該方法包括：（a）根據機器人所需實現的位姿，通過 D-H 模型法獲得末端執行機構相對于基坐標系的位姿矩陣；（b）將機器人避開奇異形位時所能實現的正常位姿定義為不同的關節特性屬性，并設定機器人實現所需的位姿時的關節特征屬性組合；（c）根據位姿矩陣以及設定的關節特征屬性組合及其取值條件，通過反變換法分別求得關于機器人各個關節變量的唯一解；（d）根據所求得的解，執行對六自由度工業機器人的關節運動，相應完成整體運動控制過程。通過本發明，具備可預知過奇異點路徑、算法簡單、反解速度快以及能較好地確定唯一解等優點，并能很好地應用于實際的工業機器人運動控制。

未應用