ur机器人计算相对位姿

已知MInB0,PInB0, 计算PInM

BInM0 = pose_inv(MInB0)

PInM = pose_trans(BInM0,PInB0)

根据以上结果,已知MInB,计算PInB

PInB = pose_trans(MInB,PInM)

注:pose_trans(pa,pb)即pa*pb

猜你喜欢

转载自blog.csdn.net/xiaoshuying/article/details/88305986