https://www.youtube.com/watch?v=8XRvpDhTJpw
ch1 位姿表示和选择矩阵
原文:https://www.cnblogs.com/long5683/p/12381368.html