ABB機(jī)器人之姿態(tài)數(shù)據(jù)的旋轉(zhuǎn)方法

實(shí)現(xiàn)如圖中的工件坐標(biāo)Z方向旋轉(zhuǎn)。

改變它的姿態(tài)，如圖在沿Z方向旋轉(zhuǎn)30度，如何通過(guò)編程實(shí)現(xiàn)？

先創(chuàng)建程序數(shù)據(jù)用來(lái)存儲(chǔ)旋轉(zhuǎn)角度。如x,y,z,數(shù)據(jù)類型為num。

由于四元數(shù)的值不能直接加上度數(shù)，要先把四元數(shù)轉(zhuǎn)成歐拉角才能加上30度。所以把姿態(tài)數(shù)據(jù)用功能函數(shù)轉(zhuǎn)成歐拉角的度數(shù)，因再次轉(zhuǎn)成姿態(tài)時(shí)要用到三個(gè)角度，所以在此把三個(gè)角度都轉(zhuǎn)換過(guò)來(lái)。此函數(shù)的三個(gè)可選參數(shù)為三選一參數(shù)，所以要分別寫(xiě)。

把要旋轉(zhuǎn)的軸加上旋轉(zhuǎn)的值。

再通過(guò)功能函數(shù)把歐拉角轉(zhuǎn)成四元數(shù)。

在坐標(biāo)系里出現(xiàn)了用姿態(tài)數(shù)據(jù)的表達(dá)方式的值，用wobj1做參考編程的軌跡也就旋轉(zhuǎn)了30度，利用好坐標(biāo)系，可以輕松實(shí)現(xiàn)軌跡的偏移和旋轉(zhuǎn)。

本人從事教育培訓(xùn)行業(yè)，歡迎廣大工控愛(ài)好的朋友一起學(xué)習(xí)，共同進(jìn)步。如有想進(jìn)一步了解和交流，關(guān)注公眾號(hào)或加小編微信。