一種可穿越腕部奇異點的機器人路徑規(guī)劃方法
本發(fā)明公開了一種可穿越腕部奇異點的機器人路徑規(guī)劃方法, 包括以下步驟:操作拖拽示教機器人的末端完成一次完整的作業(yè),采 集路徑點進行工業(yè)機器人的坐標轉(zhuǎn)換和運動學反解,當所述工業(yè)機器 人當前位姿對應(yīng)的關(guān)節(jié)變量值處于腕部奇異區(qū)域邊界,且原始目標位 姿對應(yīng)的關(guān)節(jié)變量值在腕關(guān)節(jié)奇異區(qū)域以內(nèi)時,將機器人 5,6 軸進行 固連,分別根據(jù)第三連桿坐標系相對于基坐標系的連桿變換矩陣和工具坐標系相對于連桿坐標系以及工具坐標系相對于基坐標系的連桿變 換矩陣之積,計算第三連桿坐標系相對于基坐標系的位置矢量,并據(jù) 此建立方程
華中科技大學
2021-04-14