大角度范围内四元数转化为欧拉角的算法_辛岩

欧拉角四元数转换欧拉角和四元数都是用于描述物体在三维空间中的旋转状态的数学表示方法。

欧拉角是一个由三个角度组成的向量，而四元数是一个由四个实数组成的向量。

在计算机图形学和机器人学等领域中，这两种方法都被广泛使用。

欧拉角和四元数之间的转换可以帮助我们在不同的数学表示方法中进行转换，从而更方便地进行计算和应用。

下面是欧拉角和四元数之间的转换公式：欧拉角转四元数：给定欧拉角向量 [α, β, γ]，我们可以通过以下公式将其转换为对应的四元数 [q0, q1, q2, q3]：q0 = cos(α/2)cos(β/2)cos(γ/2) + sin(α/2)sin(β/2)sin(γ/2)q1 = sin(α/2)cos(β/2)cos(γ/2) - cos(α/2)sin(β/2)sin(γ/2)q2 = cos(α/2)sin(β/2)cos(γ/2) + sin(α/2)cos(β/2)sin(γ/2)q3 = cos(α/2)cos(β/2)sin(γ/2) - sin(α/2)sin(β/2)cos(γ/2)四元数转欧拉角：给定四元数 [q0, q1, q2, q3]，我们可以通过以下公式将其转换为对应的欧拉角向量 [α, β, γ]：α = atan2(2(q0q1 + q2q3), 1 - 2(q1^2 + q2^2))β = asin(2(q0q2 - q3q1))γ = atan2(2(q0q3 + q1q2), 1 - 2(q2^2 + q3^2))其中，atan2() 是一个带有两个参数的反正切函数，它可以根据两个参数的正负关系来确定结果的正负号。

通过以上公式，我们可以方便地在欧拉角和四元数之间进行转换，从而更加灵活地描述物体在三维空间中的旋转状态。

旋转矩阵、欧拉⾓、四元数理论及其转换关系1. 概述旋转矩阵、欧拉⾓、四元数主要⽤于表⽰坐标系中的旋转关系，它们之间的转换关系可以减⼩⼀些算法的复杂度。

本⽂主要介绍了旋转矩阵、欧拉⾓、四元数的基本理论及其之间的转换关系。

2、原理2.1 旋转矩阵对于两个三维点p1(x1,y1,z1)，p2(x2,y2,z2)，由点 p1 经过旋转矩阵 R 旋转到 p2，则有注：旋转矩阵为正交矩阵RR^T=E任意旋转矩阵：任何⼀个旋转可以表⽰为依次绕着三个旋转轴旋三个⾓度的组合。

这三个⾓度称为欧拉⾓。

三个轴可以指固定的世界坐标系轴，也可以指被旋转的物体坐标系的轴。

三个旋转轴次序不同，会导致结果不同。

2.2 欧拉⾓欧拉⾓有两种：静态：即绕世界坐标系三个轴的旋转，由于物体旋转过程中坐标轴保持静⽌，所以称为静态。

动态：即绕物体坐标系三个轴的旋转，由于物体旋转过程中坐标轴随着物体做相同的转动，所以称为动态。

使⽤动态欧拉⾓会出现万向锁现象；静态欧拉⾓不存在万向锁的问题。

对于在三维空间⾥的⼀个参考系，任何坐标系的取向，都可以⽤三个欧拉⾓来表现。

参考系⼜称为实验室参考系，是静⽌不动的。

⽽坐标系则固定于刚体，随着刚体的旋转⽽旋转。

如图1，设定xyz-轴为参考系的参考轴。

称xy-平⾯与XY-平⾯的相交为交点线，⽤英⽂字母（N）代表。

zxz顺规的欧拉⾓可以静态地这样定义：α是x-轴与交点线的夹⾓，β是z-轴与Z-轴的夹⾓，γ是交点线与X-轴的夹⾓。

图中三个欧拉⾓分别为：(α,β,γ)；蓝⾊的轴为：xyz轴红⾊的轴为：XYZ轴绿⾊的线为交线：Nα∈[0,2π],β∈[0,π],γ∈[0,2π]很可惜地，对于夹⾓的顺序和标记，夹⾓的两个轴的指定，并没有任何常规。

科学家对此从未达成共识。

每当⽤到欧拉⾓时，我们必须明确的表⽰出夹⾓的顺序，指定其参考轴。

实际上，有许多⽅法可以设定两个坐标系的相对取向。

欧拉⾓⽅法只是其中的⼀种。

此外，不同的作者会⽤不同组合的欧拉⾓来描述，或⽤不同的名字表⽰同样的欧拉⾓。

欧拉角和四元数是在计算机图形学和游戏开发中常用的两种旋转表示方法，它们可以相互转化，用于描述物体的旋转姿态。

gl-matrix 是一种专门用于线性代数的JavaScript 库，提供了便利的函数来处理矩阵、向量、旋转等操作。

在 gl-matrix 中，也提供了欧拉角和四元数相互转化的函数，方便开发者在使用这两种表示方法时进行转换。

本文将介绍 gl-matrix 中欧拉角和四元数的相互转化方法，并结合实际案例进行详细讲解。

1. 欧拉角和四元数的概念在计算机图形学和游戏开发中，欧拉角和四元数是用来描述物体旋转的常用方法。

欧拉角是通过旋转顺序和旋转角度来描述物体在三维空间中的旋转姿态，一般包括绕 x 轴、y 轴和 z 轴的旋转角度。

而四元数是一种复数的扩展，可以用来表示三维空间中的旋转，其具有较好的数学性质和计算性能。

2. gl-matrix 中的欧拉角和四元数表示gl-matrix 是一种快速、轻量级且又开放源代码的数学库，用于矢量和矩阵运算。

在 gl-matrix 中，欧拉角和四元数都是以数组的形式来表示的。

欧拉角可以用一个包含三个旋转角度的数组来表示，而四元数则可以用包含四个元素的数组来表示。

3. 欧拉角和四元数相互转化的原理欧拉角和四元数是两种不同的旋转表示方法，它们之间存在着一定的转换关系。

在 gl-matrix 中，提供了方便的函数来实现欧拉角和四元数的相互转化。

欧拉角转四元数的原理是先将欧拉角转化为旋转矩阵，再将旋转矩阵转化为四元数；而四元数转欧拉角的原理是先将四元数转化为旋转矩阵，再将旋转矩阵转化为欧拉角。

4. 在 gl-matrix 中实现欧拉角和四元数的相互转化接下来，我们将通过一个具体的案例来演示在 gl-matrix 中如何实现欧拉角和四元数的相互转化。

假设我们有一个物体，其初始的欧拉角为 [0, 0, 0]，我们需要将其转化为四元数表示。

我们可以使用 gl-matrix 提供的函数 'quat.create()' 来创建一个四元数：```javascriptvar quaternion = quat.create();```我们可以使用 gl-matrix 提供的函数 'quat.fromEuler()' 来将欧拉角转化为四元数：```javascriptvar euler = [0, 0, 0];quat.fromEuler(quaternion, euler[0], euler[1], euler[2]);```通过上述操作，我们就可以将初始的欧拉角 [0, 0, 0] 转化为对应的四元数表示。

四元数与欧拉⾓（RPY⾓）的相互转换RPY⾓与Z-Y-X欧拉⾓ 描述坐标系{B}相对于参考坐标系{A}的姿态有两种⽅式。

第⼀种是绕固定（参考）坐标轴旋转：假设开始两个坐标系重合，先将{B}绕{A}的X轴旋转γ，然后绕{A}的Y轴旋转β，最后绕{A}的Z轴旋转α，就能旋转到当前姿态。

可以称其为X-Y-Z fixed angles或RPY⾓(Roll, Pitch, Yaw)。

Roll:横滚 Pitch: 俯仰Yaw: 偏航（航向） 由于是绕固定坐标系旋转，则旋转矩阵为（cα is shorthand for cosα, sα is shorthand for sinα,and so on.）R XYZ(γ,β,α)=R Z(α)R Y(β)R X(γ)=cαcβcαsβsγ−sαcγcαsβcγ+sαsγsαcβsαsβsγ+cαcγsαsβcγ−cαsγ−sβcβsγcβcγ 另⼀种姿态描述⽅式是绕⾃⾝坐标轴旋转：假设开始两个坐标系重合，先将{B}绕⾃⾝的Z轴旋转α，然后绕Y轴旋转β，最后绕X轴旋转γ，就能旋转到当前姿态。

称其为Z-Y-X欧拉⾓，由于是绕⾃⾝坐标轴进⾏旋转，则旋转矩阵为：R Z′Y′X′(α,β,γ)=R Z(α)R Y(β)R X(γ)=cαcβcαsβsγ−sαcγcαsβcγ+sαsγsαcβsαsβsγ+cαcγsαsβcγ−cαsγ−sβcβsγcβcγ 可以发现这两种描述⽅式得到的旋转矩阵是⼀样的，即绕固定坐标轴X-Y-Z旋转(γ,β,α)和绕⾃⾝坐标轴Z-Y-X旋转(α,β,γ)的最终结果⼀样，只是描述的⽅法有差别⽽已。

In gerenal: three rotations taken about fixed axes yield the same final orientation as the same three rotations taken in opposite order about the axes of the moving frame.Axis-Angle与四元数 绕坐标轴的多次旋转可以等效为绕某⼀转轴旋转⼀定的⾓度。

四元数和欧拉角
四元数与欧拉角：
1、四元数
四元数是一种数学物体，它由ONE个实部和THREE个虚部组成。

实部是非负实数，其余的THREE个部分是虚数。

四元数的表达式可以表示为：Q=a+bi+cj+dk (a、b、c、d是实实部）。

它们有助于以三维空间中的方式表示方向和旋转。

离散空间中表示四元数，当旋转发生时，它们保持一致。

2、欧拉角：
欧拉角是一种三维旋转矢量，可以用来表示不同方向之间的关系。

它将旋转分成THREE个不同的轴，分别为X轴、Y轴和Z轴。

每个轴都有自己的旋转角度，比如X轴有X角度，Y轴有Y角度，Z轴有Z角度。

欧拉角的表达式可以写作：[X,Y,Z]，其中X、Y、Z分别表示每个轴的旋转角度。

欧拉角与四元数之间的差别在于欧拉角表示的是不同方向间的关系，而四元数表示的是不同方向的空间旋转。

可以说四元数和欧拉角均是用来表示旋转有关信息的，但是又是有所差别的。

下面我们来总结下它们两者之间的区别：
1）表示方式不同：欧拉角表示的是不同方向间的关系，而四元数是表
示不同方向的空间旋转；
2）用途不同：欧拉角被广泛应用于3D图形学处理领域，可以很方便
地实现3D模型的几何变换；而四元数方便地表示空间任意的旋转变换，是用来表达机器人的运动控制中的基本角度表示方式；
3）值域不同：欧拉角的值域为[0,2π)，而四元数的值域为[-1,1]；
4）叠加角度表示方法不同：四元数是可以用乘法表达累加旋转；而欧
拉角只能使用加法来表达叠加旋转。

我们要找出欧拉角（Euler angles）对四元数（quaternion）的导数。

首先，我们需要了解欧拉角和四元数的基本定义和关系。

欧拉角是用来描述三维空间中物体方向的一组角度，通常表示为(φ, θ, ψ)。

四元数是一种复数扩展，用于表示三维空间中的旋转，通常表示为(q0, q1, q2, q3)。

欧拉角和四元数之间的关系可以通过一系列的转换公式来表示。

为了简化问题，我们假设使用Z-Y-X欧拉角。

根据Z-Y-X欧拉角到四元数的转换公式，我们有：q0 = cos(ψ/2) * cos(θ/2) * cos(φ/2) + sin(ψ/2) * sin(θ/2) * sin(φ/2)q1 = sin(ψ/2) * cos(θ/2) * cos(φ/2) - cos(ψ/2) * sin(θ/2) * sin(φ/2)q2 = cos(ψ/2) * sin(θ/2) * cos(φ/2) + sin(ψ/2) * cos(θ/2) * sin(φ/2)q3 = cos(ψ/2) * cos(θ/2) * sin(φ/2) - sin(ψ/2) * sin(θ/2) * cos(φ/2)为了找到欧拉角对四元数的导数，我们需要对上述每个四元数组件分别求导。

这将涉及到对cos和sin函数的求导，并使用链式法则。

针对q0的求导示例：δq0/δφ = -1/2 * sin(ψ/2) * cos(θ/2) * sin(φ/2) - 1/2 * cos(ψ/2) * sin(θ/2) * cos(φ/2)同理，我们可以求出δq0/δθ和δq0/δψ，以及其他q1, q2, q3对欧拉角的导数。

注意，这是一个相对复杂的过程，涉及到多个三角函数的求导和组合。

最终结果会是一系列与欧拉角相关的三角函数表达式。

四元数转欧拉角公式1 四元数简介四元数是一种数学上的扩张，它可以用来表示旋转、仿射变换、坐标变换等多种数学表示。

四元数由一个标量和一个三维向量组成，其中标量称为实部，三维向量称为虚部。

2 四元数转欧拉角欧拉角是指绕三个坐标轴的旋转角度，分别称为滚动角、俯仰角和偏向角。

将四元数转换为欧拉角可以用以下公式：psi = atan2(2(q0*q1 + q2*q3), 1 - 2(q1*q1 + q2*q2))theta = asin(2(q0*q2 - q3*q1))phi = atan2(2(q0*q3 + q1*q2), 1 - 2(q2*q2 + q3*q3))其中psi、theta、phi分别对应欧拉角的偏向角、俯仰角和滚动角，q0、q1、q2、q3为四元数的四个分量。

3 四元数转欧拉角的原理通过四元数和欧拉角的定义，我们可以知道，欧拉角相当于描述了三个坐标轴的旋转，而四元数可以表示任意旋转。

因此，我们可以使用四元数来表示欧拉角相应的旋转，然后通过比较四元数和欧拉角的定义，推出它们之间的关系式。

4 四元数转欧拉角的应用四元数转欧拉角常常用于3D游戏、计算机图形学等领域。

在3D 游戏中，我们需要获取角色的坐标和旋转信息，通过四元数转换欧拉角可以获得相应的旋转角度；在计算机图形学中，我们需要将三维模型转换为投影到二维屏幕上的二维图像，通过四元数转换欧拉角可以对三维对象进行旋转变换。

5 结论四元数和欧拉角是两种不同的数学表达方式，但它们之间存在一定的关系，通过转换可以实现相互转换。

四元数转换为欧拉角的公式虽然有些复杂，但是在实际应用中可以轻松地进行计算，并且可以提高程序的效率和可读性。

四元数与欧拉角之间的转换早在1843年哈米尔顿就提出了四元数的基本概念[138]，但当时仅停留在理论概念的讨论上。

20世纪以来，随着航天、航空工业的发展，四元数得到了广泛地实际应用[139-142]。

四元数的定义为[143]4q ⎛⎫≡ ⎪⎝⎭Q q（0-1）式中：123(,,)sin 2T q q q α≡=Q e （0-2）4cos2q α= （0-3）其中，e 是沿旋转轴的单位向量，α是旋转角度。

四元数满足约束条件1T =q q（0-4）四元数与姿态矩阵具有如下关系：224334222212341234132422221234123423142222132423141234()22[]()()2()2()2()2()2()2()T T q I q q q q q q q q q q q q q q q q q q q q q q q q q q q q q q q q q q q q q ⨯=-+-⨯=Ξψ⎛⎫--++-⎪=--+-++ ⎪⎪+---++⎝⎭A Q QQ Q q q q（0-5）其中，33⨯I 是33⨯单位矩阵，433[]()T q ⨯+⨯⎛⎫Ξ≡ ⎪-⎝⎭I Q q Q（0-6）433[]()T q ⨯-⨯⎛⎫ψ≡ ⎪-⎝⎭I Q q Q（0-7）3231210[]00q q q q q q -⎛⎫ ⎪⨯=- ⎪ ⎪-⎝⎭Q （0-8）地面坐标系Axyz 和弹体坐标系O 1x 1y 1z 1的关系可以用下式来表示=b Ar（0-9）其中，b 、r 分别为某向量在弹体坐标系和地面坐标系中的表示形式，A 的表达形式见错误！未找到引用源。

，具体为cos cos sin cos sin sin cos cos sin sin cos cos sin sin cos cos sin sin cos sin sin cos cos sin sin sin sin cos cos ϑψϑϑψϑψγψγϑγϑψγψγϑψγψγϑγϑψγψγ-⎛⎫⎪=-++ ⎪ ⎪+--+⎝⎭A（0-10）比较式（0-5）和式（0-10），得到姿态角的四元数表示131324222211123412123432231422222212342()arctan arctan arcsin arcsin 2()2()arctan arctan q q q q q q q q q q q q q q q q q q q q ψθφ⎧-=-=-⎪--+⎪⎪==+⎨⎪-⎪=-=-⎪-+-+⎩q q q q q A A A A A （0-11）也可以用姿态角来表示四元数q ，即(cossinj)(cossinj)(cos sin j)222222ψψθθφφ=+⊗+⊗+q（0-12）其中，符号⊗表示四元数乘法，其定义如下[144-145]41234123(i j k)(i j k)A A A A B B B B ⊗=+++⊗+++A B44123114322341232143B A A A A B A A A A A A A A B A A A A B ---⎛⎫⎛⎫ ⎪ ⎪- ⎪⎪= ⎪⎪- ⎪ ⎪ ⎪-⎝⎭⎝⎭44112233144132232431421334211243()()i ()j ()kA B A B A B A B A B A B A B A B A B A B A B A B A B A B A B A B =---++-++++-+-++（0-13）其中，4123i j k A A A A =+++A 和4123i j k B B B B +++B =均为四元数。

四元数与旋转一．四元组基础Q(x,y,z,w)，其中x，y，z用来确定旋转轴，w为旋转的角度Q=w+xi+yj+zk，i，j，k为三个虚轴的单位分量I*j=kJ*k=i;K*i=j;叉乘：c=a × b=| i j k||a1 b1 c1||a2 b2 c2|=(b1c2-b2c1,c1a2-a1c2,a1b2-a2b1)c也为一个向量，且c的长度为|a||b|sin(theta)，垂直于a和b所在的平面，方向由右手法则来判定，用右手的四指先表示向量a的方向，然后手指朝着手心的方向摆动到向量b的方向，大拇指所指的方向就是向量c 的方向1．四元组相乘：Q1=w1+x1i+y1j+z1k=(w1,v1)Q2=w2+x2i+y2j+z2k=(w2,v2)Q1*Q2=(w1*w2-<v1,v2>,w1*v2+w2*v1+v1xv2)( w1+x1i+y1j+z1k)*( w2+x2i+y2j+z2k)=w1*w2-x1*x2-y1*y2-z1*z2+(W1*x2+x1*w2+y1*z2-z1-y2)i+(y1*w2+w1*y2+z1*x2-x1*z2)j+(w1*z2+z1*w2+x1*y2-y1*x2)k对于其中的轴部分，假如v1//v2，则有v1 x v2=0（平行向量的叉乘结果为0）2．四元组的点乘，点乘积为数值：Q1.*Q2=w1*w2+<v1,v2>=w1*w2+x1*x2+y1*y2+z1*z2;3．数乘s为一实数，q为四元组，则有sq=qs4．共轭p=(w,v)，则p*=(w,-v)(pq)*=q*p*N(q)=w2+x2+y2+z2q-1=q*/N(q)---------------显然可得qq-1=(1,0)二．使用四元数旋转向量假如有一表示向量的四元组q=(w,v)，对其应用旋转量p后的结果为：q’=pqp-1=(w,v’)从上可以看出，计算的结果q’的实部和q的实部是相等的，并且有N(v)=N(v’)如果N(q)=1，则可以令q=(cosa,usina)，u也为一个单位向量，则q’是q绕u旋转2a个弧度的结果假如S(q)表示q的实部，则有2S(q)=q+q*2S(pqp-1)= pqp-1+( pqp-1)*=pqp*+(pqp*)*=pqp*+pq*p*=p(q+q*)p*=2S(q)（这里由于p是单位四元数，所以有p-1等于p*）欧拉角到四元数的转换定义pitch, yaw, roll分别为绕X轴、Y轴、Z轴的旋转弧度float p = pitch * PIOVER180 / 2.0;float y = yaw * PIOVER180 / 2.0;float r = roll * PIOVER180 / 2.0;float sinp = sin(p);float siny = sin(y);float sinr = sin(r);float cosp = cos(p);float cosy = cos(y);float cosr = cos(r);this->x = sinr * cosp * cosy - cosr * sinp * siny;this->y = cosr * sinp * cosy + sinr * cosp * siny;this->z = cosr * cosp * siny - sinr * sinp * cosy;this->w = cosr * cosp * cosy + sinr * sinp * siny;normalise();三．使用matlab进行相关计算计算两个向量v1和v2之间的旋转量四元数p，使得v1应用p后到达v2假如v1转到v2的旋转轴为v，旋转角为theta，则q=[v*cos(theta/2)sin(theta/2)]Matlab代码：function q=vector2q(v1,v2)%..normalize....len1=sqrt(v1*v1');len2=sqrt(v2*v2');v1=v1/len1;v2=v2/len2;angle=v1*v2';axis=cross(v1,v2);alen=sqrt(axis*axis');axis=axis/alen;t=acos(angle);t=t/2;q(1)=axis(1)*sin(t);q(2)=axis(2)*sin(t);q(3)=axis(3)*sin(t);q(4)=cos(t);end计算出了q之后，可以获得对应的旋转矩阵，旋转矩阵的计算Matlab里面的矩阵是以列为主顺序的function r=q2rot(q)w=q(4);x=q(1);y=q(2);z=q(3);r=zeros(3,3);r(1,1)=1-2*y*y-2*z*z;r(1,2)=2*x*y+2*w*z;r(1,3)=2*x*z-2*w*y;r(2,1)=2*x*y-2*w*z;r(2,2)=1-2*x*x-2*z*z;r(2,3)=2*z*y+2*w*x;r(3,1)=2*x*z+2*w*y;r(3,2)=2*y*z-2*w*x;r(3,3)=1-2*x*x-2*y*y;r=r';end同时，也可以根据四元数来计算欧拉角function R=q2euler(q)w=q(4);x=q(1);y=q(2);z=q(3);t11=2*(w*x+y*z);t12=1-2*(x*x+y*y);R(1)=atan2(t11,t12);t2=2*(w*y-z*x);R(2)=asin(t2);t31=2*(w*z+x*y);t32=1-2*(y*y+z*z);R(3)=atan2(t31,t32);end计算出来的欧拉角rx，ry，rz，分别为绕X轴、Y轴和Z轴的旋转角，假如有：Rotq=q2rot(q)R=q2euler(q)[rotx roty rotz]=Rotation(R)可以发现Rotq==rotz*roty*rotx从这里可以看出，上面使用四元数这样计算出来的旋转矩阵的旋转顺序分别是X轴、Y轴和Z轴的ra=pi/4;qz=[0 0 -sin(ra) cos(ra)] %绕z旋转-90度qy=[0 sin(ra) 0 cos(ra) ] %绕y旋转90度qyz=qmult(qy,qz)r=q2euler(qyz)上面的r得出的结果为r = -1.5708 0.0000 -1.5708也就是说其几何意义变成先绕X轴旋转-90度，再绕Z轴旋转-90度，而根据qy和qz的相乘我们实际进行的操作却是先绕Z轴旋转-90度，再绕Y轴旋转90度，但是结果却是这两种操作等价，这说明由四元数到欧拉角可以有多个解两个四元数，假如它们的方向是相反的，用它们作用于向量得到的新向量的值仍然相等q1=[0.024666 -0.023954 0.504727 0.862594];arm=[-8.881719 6.037597 -2.36776];q2=-q1;rot1=q2rot(q1);rot2=q2rot(q2);v1=rot1*arm'v2=rot2*arm'上面计算出来的v1等于v2四元数的余弦值为它们的内积假如余弦值小于0，则需要将其中的一个取反，因为上面我们知道一个四元数和它的反方向的四元数对一个向量起相同的作用四元数的相乘，代表旋转的累积pq=p*q;rotp=q2rot(p);rotq=q2rot(q);rotpq=q2rot(pq);rotmul=rotp*rotq;这里rotpq与rotmul相等四． OGRE中Quaternion类的几个函数1.四元数到旋转向量void Quaternion::ToRotationMatrix (Matrix3& kRot) const1 - 2*qy2 -2*qz22*qx*qy -2*qz*qw2*qx*qz +2*qy*qw2*qx*qy + 2*qz*qw 1 - 2*qx2 -2*qz22*qy*qz -2*qx*qw2*qx*qz -2*qy*qw 2*qy*qz +2*qx*qw1 - 2*qx2 -2*qy22.旋转量到四元数根据1中的表格，有：4 *(1-qx2-qy2-qz2) = 1 + m00 + m11 + m22又qw2=1-qx2-qy2-qz2，可得4 *qw2= 1 + m00 + m11 + m22这里解qw必须保证1 + m00 + m11 + m22>=0，如果不是的话，就构造其他的等式来计算，OGRE中分成两种情况，一种是m00 + m11 + m22>=0，就可以直接先解出qw，否则的采用另外的等式计算3．Local axisVector3 xAixs(void) const;取得旋转矩阵的第一列，旋转矩阵和一个向量相乘的话，第一列的数据均和向量的x分量相乘Vecotr3 yAxis(void) const;取得旋转矩阵的第二列，旋转矩阵和一个向量相乘的话，第二列的数据均和向量的y分量相乘Vecotr3 zAxis(void) const;取得旋转矩阵的第三列，旋转矩阵和一个向量相乘的话，第三列的数据均和向量的z分量相乘。