960 960 960 960 960 Rodrigues’ formula罗德里格斯公式 ：也被称作exponential coordinate 960 注意区分和。为一个向量，是一个利用计算得来的screw symmetric matrix 960 960 960