说明：求刚体变换的刚体矩阵的开源程序，自己所编，用到svd方法

刚体变换 matlab开源程序 rigid-body 刚体