// // Created by qian on 19-7-16. // /* 相机位姿用四元数表示 q = [0.35, 0.2, 0.3, 0.1] x,y,z,w * 注意:输入时Quaterniond(w,x,y,z) W 在前!!! * 实现:输出四元素对应的旋转矩阵,旋转矩阵的转置, * 旋转矩阵的逆矩阵,旋转矩阵乘以自身的转置,验证旋转矩阵的正交性 * Vector3.normalized的特点是当前向量是不改变的并且返回一个新的规范化的向量: * Vector3.Normaliz