罗德里格斯公式矩阵形式