假设:
现在首先构造一个正交框架:
为了将全局坐标系转换为凸轮坐标系,您可以应用以下矩阵M_R:
- | R_x,R_y,R_z,0 |
- | U_x,U_y,U_z,0 |
- | -D_x,-D_y,-D_z,0 |
- | 0.0、0.0、0.0、1.0 |
如果您的凸轮不在全球原点,则还必须应用平移M_T:
- | 1,0,0,-e_x |
- | 0、1、0,-e_y |
- | 0,0,1,-e_z |
- | 0,0,0,1 |
最后,从全局坐标到凸轮坐标的完整转换矩阵为:
- | R_x,R_y,R_z(R点-E)|
- | U_x,U_y,U_z(U点-E)|
- | -D_x,-D_y,-D_z,(D点E)|
- | 0.0、0.0、0.0、1.0 |