刚体坐标变换

下面是正文部分。