运用四元数模型和罗德里格模型进行三维坐标转换，任意旋转角度均能得到正确结果，且加入了粗差剔除算法。