APP下载

任意姿态下矢量物理量的测量数据修正计算方法探讨

2019-05-08程国胜

数字海洋与水下攻防 2019年1期
关键词:转角矢量坐标系

程国胜

(中国船舶重工集团公司第七一〇研究所,湖北 宜昌 443003)

0 引言

对矢量物理量的测量,如水中目标的磁场、电场等目标特性的测量,要求测量出该物理量在确定的正交坐标系(通常为当地水平坐标系或者导航坐标系)中的3个方向分量,而在测量实施中,测量传感器或其安装平台的姿态角往往是随机但可以测量的。因此,在测量数据的处理中,需要对在任意姿态下测量的矢量物理量数据进行修正,即对测量的矢量结果在不同坐标系之间进行转换。在大多数现有文献和工程实践中,修正算法都是直接引用欧拉角旋转变换公式[1-3]。但是仔细分析,欧拉角旋转变换公式是基于有先后次序的绕坐标轴的旋转变换,而实际测量的姿态角,有陀螺仪测量、惯导系统测量、倾斜仪测量、磁场传感器测量以及多传感器组合测量,测量传感器或设备输出的姿态角有不同的定义,与旋转欧拉角的定义不一定完全一致。因此,直接引用欧拉角旋转变换公式进行修正计算,可能存在原理性误差。在运动载体中的矢量测量以及导航定位中的坐标旋转变换中也都存在类似的问题。

本文对姿态角定义和传感器测量原理进行分析,推导姿态角与旋转欧拉角的关系,进而推导出利用可测量的姿态角进行坐标变换修正的坐标转换矩阵。

1 坐标系及欧拉旋转变换

1.1 常用坐标系

在导航和矢量测量中常用的有以下5种正交右手坐标系[4]:

1)地心惯性坐标系OIXIYIZI,简记为I坐标系;

2)地心地球固定坐标系OEXEYEZE,简记为E坐标系;

3)导航坐标系ONXNYNZN,简记为N坐标系,主要用于确定载体相对于东、北和天方向的速度和位置;

4)当地水平坐标系OLXLYLZL,简记为L坐标系,主要用于确定载体相对于北、东和地方向的姿态;

5)载体坐标系OBXBYBZB,简记为B坐标系,主要用于描述载体的姿态(通常为俯仰角、横滚角和偏航角)。

导航应用中的测量计算如姿态、位置、速度、加速度、角速度等参数,常常需要在这些不同坐标系之间进行平移和旋转变换计算,而一般矢量物理量的测量中,最常用到的是其中的B坐标系以及N和L坐标系间的变换计算。

1.2 欧拉角

如图1(a)所示,固定坐标系OXgYgZg(通常为L坐标系)和载体坐标系OXYZ有共同原点,ON为OXgYg平面和OXY平面的相交线,ON与平面ZgOZ垂直,称为节线。

由坐标系OXgYgZg到OXYZ的转换步骤为:以轴OZg和OZ为基本轴,其垂直面OXgYg和OXY为基本平面。首先,在坐标系OXgYgZg中绕OZg轴逆时针方向(从OZg轴正向看)旋转角度α,OXg轴到达ON;再绕ON轴逆时针旋转角度β,OZg轴到达OZ;最后绕OZ轴逆时针旋转角度γ,ON轴到达OX,得到坐标系OXYZ。这种定义对应的3个角度(α,β,γ)称为欧拉角,其名称来源于天文学,最早由欧拉在1776年提出,其中β称为章动角,α称为进动角,γ称为自转角[5]。

图1 两种不同顺序欧拉角定义示意图Fig.1 Schematic diagram of definition of Euler angles in 2 different orders

实际上,对欧拉角的名称、符号以及旋转顺序并没有统一的规定,使用时必须先明确定义。图2(a)是按照Z轴-X轴-Z轴依次旋转的顺序,称为ZXZ顺序,也称为313顺序,或者按照中间字母X区分称为X顺规(实际上X顺规有4种不同形式);对应定义的欧拉角可以称为Z-X-Z顺序欧拉角。合乎规则的顺规共有12种,分别是:ZXZ,ZXY,YXZ,YXY,XYX,XYZ,ZYX,ZYZ,XZX,XZY,YZX,YZY。欧拉角及其旋转变换作为一种纯粹的数学概念,12种合乎规则的顺规都是可用的,不同顺规对应不同的欧拉角和不同的旋转变换矩阵。

1.3 欧拉角旋转变换

在惯性导航等运动分析中,常常使用Z-Y-X顺序定义欧拉角,实际上不同的旋转顺序对应不同的旋转变换矩阵和旋转结果,一种旋转结果可以对应许多组不同的旋转欧拉角。为了与常用的姿态角定义和测量计算方法一致,这里选择Z-Y-X顺序欧拉角(ψ,θ,φ)对欧拉角旋转变换进行分析。

如图1(b)所示,固定坐标系OXgYgZg(一般是L坐标系中的NED坐标系)和载体坐标系OXBYBZB有共同原点O,OXgYgZg依次经过Z、Y、X轴3次连续旋转,得到OXBYBZB,具体旋转过程及其坐标变换如下:

首先,坐标系绕Z轴旋转,旋转角度ψ为正(沿Z轴正方向看,逆时针方向旋转ψ角度定义为正角度,下同),由OXgYgZg旋转到OX1Y1Z1,此时OZ1轴与OZg轴重合;

第二步,坐标系绕Y轴旋转正角度θ,由OX1Y1Z1旋转到OX2Y2Z2,此时OY1轴与OY2轴重合;

第三步,坐标系绕X轴旋转正角度φ,由OX2Y2Z2旋转到OXBYBZB。

在上述每一步变换中,按照同一矢量在2个不同坐标系中的正交分解进行计算,求解同一矢量在不同坐标系中的量值关系,最后得到:

式中:Xg=[xg,yg,zg]T和XB=[xB,yB,zB]T分别是同一矢量X在OXgYgZg和OXBYBZB坐标系中的3个正交分量;是由OXgYgZg旋转到OXBYBZB的方向余弦矩阵;CgB是由OXBYBZB旋转到OXgYgZg的方向余弦矩阵,它们是互逆的正交矩阵,因此,

方向余弦矩阵的具体表达式如下:

应用到矢量物理量的测量变换中,姿态测量传感器固定在载体坐标系中,该坐标系从固定坐标系OXgYgZg以Z-Y-X顺序经欧拉角(ψ,θ,φ)旋转到OXBYBZB,在载体坐标系OXBYBZB中的测量结果为XB。如果姿态测量传感器测量得到的角度值是前述欧拉角(ψ,θ,φ),使用上面的公式,对在载体坐标系中的传感器测量值XB进行修正,可以求出所测量的矢量值在固定坐标系OXgYgZg中的3个分量,即求出Xg。

1.4 无限小角度转动

在上述Z-Y-X顺序欧拉旋转中,如果转动欧拉角(ψ,θ,φ)为无限小角度值,则在以欧拉角形式表示的方向余弦矩阵中有以下近似:

忽略二阶及以上乘积项如sinθsinφ、sinψsinφ、sinψsinθsinφ等小角度乘积项,则方向余弦矩阵可以近似简化为

可以看出,当转动欧拉角为无限小角度值时,以欧拉角形式表示的方向余弦矩阵均为对称矩阵,矩阵乘法的顺序不影响乘法结果。也就是说,当转动欧拉角为无限小角度值时,将转动分解为3次连续欧拉旋转,结果与旋转顺序无关。在惯性导航等设备的应用中,设备测量载体的姿态角度时,量化速率比较高,相当于每次叠加计算所对应的转动角度均为无限小角度,可以采用上述对称矩阵形式的方向余弦矩阵进行近似求解,大大简化求解过程,提高计算速度[5]。

2 姿态角及其坐标变换

2.1 姿态角

姿态角也是一组能够完整表述刚体相对于参照坐标系转动位置的参量,包括偏航角、俯仰角和滚转角,其中的俯仰角和滚转角通常为倾斜角。姿态角的参照固定坐标系通常为L坐标系中的北东地(NED)坐标系[6]。

图2 载体姿态角定义示意图Fig.2 Schematic diagram of definition of carrier's attitude

按欧拉角定义方法来定义固定坐标系和载体坐标系,在载体坐标系OXYZ中,OX轴相对于固定坐标系OgXgYgZg的水平面以及OgXg(正北方向)、OY轴相对于OgXgYgZg的水平面,存在3个偏角,它们反映了载体的姿态,称为载体的姿态角,通常用(ψ,θ,φ)表示,参见图2,具体定义如下。

偏航角ψ:载体坐标系X轴在水平面上投影与固定坐标系Xg轴之间的夹角,由载体X轴的投影线逆时针转至Xg轴时,偏航角为正,即机头右偏航为正,反之为负。偏航角通常也称为方位角或航向角。

俯仰角θ:载体坐标系X轴与水平面的夹角。当X轴的正半轴位于过坐标原点的水平面之上(抬头)时,俯仰角为正,否则为负。

滚转角φ:有2种定义,第一种定义为载体坐标系Z轴与包含载体X轴的铅垂面间的夹角,用φz表示,第二种定义为载体坐标系Y轴与水平面的夹角,用φy表示;载体向右滚为正,反之为负。滚转角的两种定义在实际工程计算中都有人使用。

旋转欧拉角主要是一种数学上的概念,姿态角的定义更具物理意义,容易通过测角传感器测量得到。但是,由于各种测角传感器的原理各异,具体使用时,需要明确传感器输出角度值的物理意义,以及滚转角的具体定义,准确使用姿态修正变换公式。

2.2 姿态角坐标变换中的问题

前面的欧拉旋转变换公式是基于3个欧拉角及其旋转顺序推导的,不同的旋转顺序对应不同的变换系数矩阵,它表明即使是相同的旋转角度,不同的旋转顺序对应的最终旋转结果也是不同的。

从欧拉角和姿态角的定义看,欧拉角和姿态角是不同的角度,因此,在矢量物理量测量及其坐标变换修正中,应仔细考虑角度测量传感器所测量角度的实际物理意义;否则直接将姿态角测量值当作旋转欧拉角,应用前述欧拉角旋转变换公式(1)和(2)进行坐标变换修正计算,可能存在原理性误差。

在实际工程应用中,角度测量传感器一般都是基于载体坐标系的,通过与载体固定连接,实时测量载体的姿态角度。各种不同的姿态角度测量传感器,往往原理不同,性能特点各异,适用的环境条件各不一样。常用的测角传感器有加速度计、磁力计、陀螺仪以及以陀螺仪为核心的惯导系统(包括平台式惯导系统和捷联惯导系统)等。

2.3 由加速度计求解倾斜角

加速度计也称重力感应器或力感应器,主要是通过测量组件在某个轴向的受力情况来计算轴向加速度的大小和方向。由于重力加速度只是地表垂直方向加速度,因此,借助三轴加速度计可以测得一个固定平台相对地球表面的运动方向[7]。

通常加速度计的测量值包含了重力加速度和其它受力运动产生的加速度,而在静态、匀速运动或接近匀速运动的低速(即维持惯性)条件下,可以认为或近似认为只有重力而无其它作用力,测量的三轴加速度值认为是重力加速度产生的,由三轴加速度测量值可以求解载体的倾斜角度(姿态角中的2个量)。

实际上,以下2种求解过程是互为逆运算关系:1)已知固定坐标系下重力加速度的3个分量,通过加速度计测量载体坐标系下的重力加速度,求解载体的倾斜角度;2)已知或者测量获得载体坐标系的倾斜角度,通过测量载体坐标系下的重力加速度的3个分量,求解固定坐标系下的重力加速度值。

图3 加速度计测量计算姿态角的原理示意图Fig.3 Principle diagram of measuring attitude angles by accelerometer

下面来推导由加速度计求解倾斜角度的具体求解过程。

如图3所示,OXgYgZg为固定坐标系,OXYZ为载体坐标系,三分量加速度计固联在载体坐标系的坐标轴上。图中将水平面OXgYg旋转到了铅锤面上。

在OXgYgZg坐标系中,重力加速度的值为G=[Gx,Gy,Gz]T=[0,0,g]T,g为重力加速度常数;在OXYZ坐标系中,加速度计的测量值为g=[gx,gy,gz]T。

我们假定由坐标系OXgYgZg到坐标系OXYZ是经过Y-Z顺序2个欧拉旋转实现的,旋转的具体步骤:

1)在OXgYgZg坐标系内,绕OYg轴(顺螺旋方向,即逆时针方向)旋转θ角,即OXg轴和OZg轴均在OXgZg平面内旋转了θ角度,得到坐标系OX′Y′Z′,其中Y′与Yg重合;

2)在OX′Y′Z′坐标系内,绕OX′轴(顺螺旋方向,即逆时针方向)旋转φ角,即OY′轴和OZ′轴均在OY′Z′平面内旋转了φ角度,得到坐标系OXYZ,其中X与X′重合。

至此,可以得到以下一些关系:

1)OX轴在OXgZg平面内,因此θ等于OX轴与水平面OXgYg的夹角,即目标的俯仰角;

2)OY′与OYg重合,OYg⊥OXgZg平面,因此平面OY′Z′⊥OXgZg平面(即铅锤面),OZ′为相交线;OY′、OY、OZ′、OZ在同一平面OY′Z′内,OY和OZ在OXgZg平面上的投影均为OZ′;因此,OZ轴与铅锤面OXgZg的夹角等于φ,也就是滚转角的第一种定义值φz=φ;

3)假设OY轴在水平面OXgYg上的投影为OP,OY与水平面OXgYg的夹角即为滚转角的第二种定义值φy。用φy和φ两个角度分别计算OY轴上的单位矢量在OZg上的投影分量,则有:sinφy=sinφcosθ。

根据以上关系,重力加速度在OXgYgZg坐标系中的值G=[Gx,Gy,Gz]T=[0,0,g]T与加速度计的测量值g=[gx,gy,gz]T之间,满足欧拉角旋转变换关系,即:

由Gx=0和Gy=0可以得到:

由上式推导出:

所以,由加速度计求解倾斜角的计算方法:

1)在载体坐标系中测量3个正交加速度计的值gx,gy,gz;

2)用上述2个式(4)和式(5)求解出θ和φ;

3)俯仰角为θ;

4)滚转角φ的第一种定义值为φz=φ,第二种定义值φy由关系式sinφy=sinφcosθ求解;

由加速度计求解倾斜角适用于静止、匀速或近似匀速运动的条件。在不考虑偏航角的情况下,可以通过测量倾斜角对矢量测量值进行倾斜修正。

假设在载体坐标系下测量得到的矢量值为X=[x,y,z]T,载体坐标系的倾斜角(θ,φ)由传感器测量得到,则将X转换到固定坐标系下的值为Xg=[xg,yg,zg]T,按照公式(3),得到:

式中:θ为俯仰角测量值;滚转角φ的传感器测量值如果为第一种定义φz,则φ=φz,为第二种定义φy时,则由sinφ=sinφy/cosθ计算得出φ。

2.4 由磁力计求解偏航角

磁力计也称为磁感器,可用于测试磁场强度和方向,原理类似指南针。

在地球表面,地磁场始终是沿着磁感应线(地磁场的磁力线)指向北的,某点的磁场强度方向为磁感应线在该点的切线方向,它在北向和垂直方向有相应的分量,在东西方向的分量为0。因此,在固定坐标系下,地磁场矢量可以表示为Mg=[Mxg,Myg,Mzg]T=[Mxg,0,Mzg]T,即Myg=0。如图4所示,地磁场强度总量为Mg,其北向分量为Mxg=Mgcosδ,垂直分量为Mzg=Mgsinδ,东向分量为Myg=0。

图4 地磁场及其三分量指向示意图Fig.4 Schematic diagram of geomagnetic field and its tricomponent

由此可以看出,在载体目标上安装三轴磁力计,测量出三轴地磁场强度M=[Mx,My,Mz]T,就可以计算出载体坐标系的方位角(即偏航角)ψM。当然,实际上地球的地理北极和地磁南极并不重合,有一定的夹角,称为磁偏角Δψ。根据经纬度可以查询到该磁偏角Δψ的大小。固定坐标系的北向指向地理北极,磁力计求得的北向指向地磁南极,因此,用磁力计求解的方位角ψM需要进行磁偏角Δψ修正,才能得到地理方位,即真正的偏航角ψ[8]。

和加速度计的测量一样,通常情况下,安装磁力计的载体坐标系也是处于运动状态,具有一定的倾斜角,因此,利用磁力计测量值求解方位时,也需要进行倾斜修正。

下面来推导由磁力计求解偏航角的具体求解过程。

假设在载体坐标系下测量得到的地磁场为M=[Mx,My,Mz]T,载体坐标系的倾斜角(θ,φ)通过加速度计求解得到,按照公式(6),可以将地磁场测量值M=[Mx,My,Mz]T进行倾斜修正,得到相对于固定坐标系OXgYgZg仅有偏航角ψM而无倾斜角的坐标系下的值Mp=[Mxp,Myp,Mzp]T:

而Mp=[Mxp,Myp,Mzp]T是由地磁场在固定坐标系下的值Mg=[Mx,0,Mzg]T经过旋转偏航角ψM得到的,而且,这个偏航角的旋转在倾斜之前或之后,结果都是一样的。因此有:

式中:θ为俯仰角测量值,φ=φz(当滚转角测量值为第一种定义值φz时)或者由计算式sinφ=sinψy/cosθ计算得到(当滚转角测量值为第二种定义值φy时)。

再考虑磁偏角Δψ的修正,相对于固定坐标系的偏航角为:ψ=ψM+Δψ。

所以,通过测量或测量计算得到载体坐标系的倾斜角(θ,φ),以及载体坐标系下地磁场的值M=[Mx,My,Mz]T,可以求解偏航角ψM,再进行磁偏角Δψ修正,就可以求得相对于固定坐标系的偏航角ψ。最终得到载体的姿态角(ψ,θ,φ)。

2.5 姿态角的坐标变换计算

综合前面的分析,在载体坐标系下测量某一矢量物理量时,同步测量载体的姿态角,通过姿态角的坐标变换,将载体坐标系下的矢量测量结果变换到固定坐标系。而姿态角与旋转欧拉角在定义上是有区别的。因此,在姿态角的测量以及角度计算中,要明确角度输出值的定义,特别是滚转角的输出值所对应的定义,引用合适的变换矩阵,而不能简单直接地引用欧拉角旋转变换公式。

一组姿态角对应一种旋转结果,但一种旋转结果可以对应多组旋转欧拉角。下面以Z-Y-X旋转顺序为例,在前述倾斜角修正和偏航角修正算法的基础上,推导姿态角与Z-Y-X顺序欧拉角之间的关系。

图5为姿态角与Z-Y-X顺序欧拉旋转角的关系示意图。图中的旋转步骤如下:

1)固定坐标系为OXgYgZg,一般是L坐标系(其中的NED坐标系)。在坐标系为OXgYgZg内,绕OZg轴(顺螺旋方向,即逆时针方向)旋转ψ角,即OXg轴和OYg轴均在OXgYg平面(通常为水平面)内旋转了ψ角度,得到坐标系OX1Y1Z1,其中OZ1轴与OZg轴重合,OX1轴和OY1轴均在OXgYg平面内;

2)在OX1Y1Z1坐标系内,绕OY1轴(顺螺旋方向,即逆时针方向)旋转θ角,即OX1轴和OZ1轴均在铅锤面OX1Zg内旋转了θ角度,得到坐标系OX2Y2Z2,其中OY2轴与OY1轴重合,OX2轴和OZ2轴均在铅锤面OX1Zg内,OX2轴在水平面OXgYg上的投影为OX1轴;

3)在OX2Y2Z2坐标系内,绕OX2轴(顺螺旋方向,即逆时针方向)旋转φ角,得到坐标系OX3Y3Z3,其中OX3轴在与OX2轴重合,OZ3轴在铅锤面OX1Zg上的投影为OZ2轴,OZ3轴与铅锤面OX1Zg的夹角即是滚转角的第一种定义,记为φz,显然有φz=φ;而OY3轴与水平面OXgYg的夹角记为φy。

图5 姿态角与Z-Y-X顺序欧拉旋转角的关系示意图Fig.5 Schematic diagram of relation between attitude angles and Z-Y-X order

从坐标系OXgYgZg到OX3Y3Z3,根据姿态角的定义得到:ψ为偏航角,θ为俯仰角,φ为横滚角第一种定义值,即φz=φ,下面来推导滚转角第二种定义值φy的表达式。

假设OY3轴上有一个单位矢量uy3,在坐标系OXgYgZg上进行正交分解,它在OZg轴上的分量为sinψy;

如果在坐标系OX2Y2Z2上对uy3进行正交分解,它在OZ2轴上的分量为sinψy,在OY2轴上的分量为cosφ,在OX2轴上的分量为0;OY2轴上的分量为cosφ在坐标系OXgYgZg上进行正交分解,由于OY2在水平面OXgYg上,因此cosφ在OZg轴上分量为0;OZ2轴上的分量为sinφ在坐标系OXgYgZg上进行正交分解,它在OZg轴上分量为sinψcosθ。

OY3轴上的单位矢量uy3,用两种不同的正交分解方法求解在OZg轴上的分量,结果应该相等,因此有:sinψy=sinψcosθ。

由此得出姿态角与Z-Y-X顺序欧拉角的关系为:欧拉角ψ等于偏航角;欧拉角θ等于俯仰角;欧拉角φ与2种定义横滚角的关系:φz=φ,sinψy=sinψcosθ。

因此,矢量物理量的姿态变换计算方法:假设载体坐标系下的矢量测量值为X=[x,y,z]T,载体坐标系的姿态角测量值为(ψ,θ,φ),则矢量X在固定坐标系下的修正结果Xg=[xg,yg,zg]T为

式中:ψ为偏航角测量值,如果偏航角是通过磁力计测量的,需要进行磁偏角Δψ修正;θ为俯仰角测量值;当滚转角的测量值为第一种定义值φz时,φ=φz;当滚转角测量值为第二种定义值φy时,由计算式sinφ=sinφy/cosθ计算得到φ。

姿态角的取值范围为:ψ,φ∈[-π,π],θ∈[-π/2,π/2]。

2.6 陀螺仪和惯导系统测量姿态角的比较

陀螺仪也称作地感器,由陀螺构成的惯导系统,无论是传统的机械转子陀螺平台式惯导系统,还是新型光纤陀螺捷联惯导系统,都可以求解运动目标的瞬时速度、位置以及姿态角度[4,8]。

在传统的机械转子陀螺和平台式惯导系统中,经过初始对准后,输出的倾斜角是载体坐标系x、y轴相对于基准水平面的角度,而偏航角则是相对于正北方向的。俯仰角和偏航角与姿态角中的定义完全一致,滚转角则与姿态角中的第二种定义一致,使用变换计算式(10)时,由计算得到φ。

而在捷联惯导系统中,使用虚拟的数学平台代替了物理平台,陀螺测量的是载体相对于惯性坐标系的转动角速度,然后通过计算得到载体的姿态角,具体计算过程为

1)陀螺仪测量,运用地球参数和位置参数计算;

3)用姿态四元数的元素表示姿态矩阵;

4)根据余弦矩阵和欧拉角定义,用欧拉角表示的姿态矩阵形式求解欧拉角(ψ,θ,φ)。

由上述导航解算原理可知,捷联惯导系统实际给出的是Z-Y-X顺序欧拉角,其中偏航角输出已经修正为正北航向,俯仰角和滚转角经过象限修正为欧拉角真值,滚转角等同于姿态角中的第一种定义φz。坐标修正变换可以直接使用变换计算式(10),其中φ=φz。

3 结束语

在实施任意姿态(也就是载体坐标系)下矢量物理量的测量时,一般需要同步测量载体的姿态角,然后通过坐标变换公式对矢量测量值进行修正,求解出固定坐标系下的矢量值。

以测量水面舰船目标的磁场为例,测量时,目标在水面上,测量传感器沉底布放,传感器的姿态(包括方位)与确定的固定坐标系不平行,即存在一个传感器坐标系,其姿态角可以测量,因此,对传感器的测量结果,应该进行姿态角变换修正。

很多文献和工程实践中,无论是基于陀螺测量的姿态角还是其它传感器测量的倾斜角,往往直接引用旋转欧拉角坐标变换公式,进行测量数据修正和坐标变换计算。从前面的分析可以看出,各种不同的传感器测量的姿态角,其输出值所代表的物理意义不一定完全相同,特别是滚转角存在两种不同的定义,如果传感器的滚转角输出值物理意义不同于欧拉角定义,直接引用旋转欧拉角坐标变换公式,就会产生原理性误差。

正确的做法是:分析姿态角传感器的工作原理,明确姿态角测量值的定义,确定姿态角测量值与某种欧拉角(通常采用Z-Y-X顺序欧拉角)的数值关系,再引用欧拉角修正变换计算式。

如果滚转角输出值对应第一种定义,即载体坐标系Z轴与包含载体X轴的铅垂面间的夹角,则与旋转欧拉角定义一致,可以直接引用旋转欧拉角坐标变换公式;如果滚转角输出值对应第二种定义,即载体坐标系Y轴与水平面的夹角,则与旋转欧拉角定义不一致,不能直接引用旋转欧拉角坐标变换公式。

另外,在工程应用中,通常在静态或接近静态条件下,使用低成本的倾斜仪测量倾斜角,使用磁方位仪测量方位角,滚转角测量值为第二种定义值,在坐标变换修正计算中应用前述公式(10)时,由计算φ。在运动状态下,一般使用陀螺仪或基于陀螺仪的惯导系统测量姿态角。如果是传统的机械转子陀螺或者平台式惯导系统,姿态角测量值与倾斜仪+磁方位仪相同,滚转角测量值为第二种定义值,坐标变换修正计算中应用前述公式(10)时,由计算φ;现在更广泛使用的是光纤陀螺捷联惯导系统,姿态角测量值一般为Z-Y-X顺序欧拉角,滚转角测量值为第一种定义值φz,在坐标变换修正计算中应用前述公式(10)时,φ=φz。

猜你喜欢

转角矢量坐标系
一种矢量信息重构的最优双矢量定姿算法
独立坐标系椭球变换与坐标换算
一种适用于高轨空间的GNSS矢量跟踪方案设计
矢量三角形法的应用
百花深处
一种门窗转角连接件
坐标系背后的故事
三角函数的坐标系模型
求坐标系内三角形的面积
三角形法则在动态平衡问题中的应用