本發(fā)明公開了一種六自由度串聯(lián)機器人運動學(xué)反解的求解方法, 該方法包括:讀入連桿參數(shù)建立機器人連桿坐標(biāo)系模型;已知連桿末 端關(guān)節(jié)位置,建立關(guān)節(jié)位置約束方程;根據(jù)各關(guān)節(jié)位置約束方程,確 定各關(guān)節(jié)位置;建立機器人各關(guān)節(jié)坐標(biāo)系的姿態(tài)約束方程;將之前求 得的關(guān)節(jié)位置坐標(biāo)解分別代入姿態(tài)約束方程中,根據(jù)姿態(tài)約束方程, 求解各組關(guān)節(jié)變量中間值;對關(guān)節(jié)變量中間值進行分析處理,選取最 佳關(guān)節(jié)變量解。本發(fā)明采用空間幾何理論將機器人運動學(xué)反解中位置 和姿態(tài)進行分離求解,大大降低了幾何法運動學(xué)反解運算的復(fù)雜性, 并能夠應(yīng)用于
掃碼關(guān)注,查看更多科技成果