机器人刚体位姿描述及齐次变换