4 、机器人的微分算子
操作机手部的位姿矩阵: T
T 相对基础坐标系经过一次微分转动 Rot(K,d
) 和一次微分
移动 Trans(dx,dy,dz) 得到手部微分运动后的新位姿:
T+dT
于是 T+dT= Trans(dx,dy,dz) Rot(K, d
)T
dT= [Trans(dx,dy,dz) Rot(K, d
) –I ]T
令△ = Trans(dx,dy,dz) Rot(K, d
) - I
,
称此表达式为
微分算子。于是
dT= [Trans(dx,dy,dz) Rot(K, d
) –I ]T =△T
0000
0
0
0
),(),,(
dzxy
dyxz
dxyz
IKRotdzdydxTrans