1. 假設(shè)相機(jī)已經(jīng)與機(jī)器人做過標(biāo)定，相機(jī)能直接給出對應(yīng)特征點(diǎn)在機(jī)器人wobj0（世界坐標(biāo)系）下的坐標(biāo)，則可以利用當(dāng)前特征點(diǎn)坐標(biāo)和當(dāng)前機(jī)器人tool0的笛卡爾坐標(biāo)，直接獲得當(dāng)前TCP。

2. Pcam=PTool0*TCP.tframe

其中，Pcam為當(dāng)前工具在機(jī)器人世界坐標(biāo)系下的值x100,y100,z100,a100,b100,c100,

PTool0為當(dāng)前tool0在機(jī)器人世界坐標(biāo)系下的值x0,y0,z0,a0,b0,c0,

TCP.tframe為待計(jì)算的TCP坐標(biāo)系xt,yt,zt,at,bt,ct.

由于Pcam（由相機(jī)提供數(shù)據(jù)，對于平面相機(jī)，可以事先固定Z和RX,RY，僅使用相機(jī)提供的X,Y和THETA）和PTool0已知，則

PTool0-1*Pcam= PTool0-1*PTool0*TCP.tframe （兩邊左乘PTool0矩陣的逆矩陣）

整理得到：

TCP.tframe= PTool0-1*Pcam

Pose數(shù)據(jù)的相乘和求逆，可以使用ABB機(jī)器人PoseMult和PoseInv函數(shù)實(shí)現(xiàn)

審核編輯 黃昊宇