为了提高载车的机动性，实现行进间对准，本文提出一种快速行进间粗对准方法，受惯性坐标系对准方法的启发，将捷联矩阵分解为3个矩阵乘积的形式，但初始载体坐标系相对惯性坐标系的转换矩阵是通过GPS获得的载体速度在惯性坐标系的投影和里程计获得的速度在初始载体坐标系的投影来求解。与现有的对准方法相比，本文提出的对准方法没有用到加速度计的测量信息，这使得该方法是一种完全在行进中实现对准的方法，同时，也使得该方法不能在静止或摇摆晃动基座条件下完成对准；与现有的行进间对准方法[17, 20-21]相比，该方法可在较短时间内获得较高的对准精度。该方法的特点是对准精度依赖于载体的运行速度，对准时间短。
1 坐标系定义 1) 地球坐标系(e系)：Oxe轴在赤道平面内且指向中央子午线，Oze轴沿地球自转轴方向，3轴构成右手坐标系；e系与地球固连，相对惯性空间的旋转角速度为地球的自转角速度ωie。
2) 初始时刻地球坐标系(e0系)：在初始对准开始时刻(即t=t0=0 时)Oxe0轴在赤道平面内且指向当地经线，Oze0轴沿地球自转轴方向，3轴构成右手坐标系；e0系也与地球固连，相对惯性空间的旋转角速度为地球的自转角速度ωie。
3) 初始时刻惯性坐标系(i0系)：在对准开始时刻i0系的坐标轴与e0系对应的坐标轴重合，且i0 系相对惯性空间静止，即e0系相对i0系沿Ozi0轴以角速度ωi0e旋转。
4) 导航坐标系(n系)：选取“东-北-天”坐标系为导航坐标系。
5) 初始时刻导航坐标系(n0系)：把开始对准时刻的导航坐标系定义为n0系，它相对于地球表面不动。
6) 载体坐标系(b系)：定义“右-前-上”坐标系为载体坐标系。
7) 初始时刻载体惯性坐标系(ib0系)：在对准开始时刻ib0系与b系重合，且ib0系相对惯性空间静止。
2 对准算法 在行进间对准过程中，捷联矩阵Cbn(t)随时间变化，为了求得当前时刻的Cbn(t),将Cbn(t)的求解分解成3个矩阵乘积的形式[22]，即
 | (1) |
式中：Ci0n(t)为i0系到n系的转换矩阵；Cib0i0为ib0系到i0系的转换矩阵；Cbib0(t)系为b系到ib0系的转换矩阵，下面分别对这3个矩阵进行求解;t为对准时间。
2.1 求解矩阵Ci0n(t) 转换矩阵Ci0n(t)可以写为
 | (2) |
式中：Cen(t)为e系到n系的转换矩阵；Cn0e为n0系到e系的转换矩阵；Ce0n0为e0系到n0系的转换矩阵；Ci0e0(t)为i0系到e0系的转换矩阵，并且Cen(t)、Cn0e和Ce0n0可由载体所在位置的经度和纬度求得，Ci0e0(t)可由e0系相对i0系转过的角度确定，具体关系[23]为
 | (3) |
式中：λ0和L0为对准开始时刻捷联惯导所在位置的经度和纬度；λt和Lt为t时刻的实时经度和纬度。将式(3)代入式(2)经过整理可以得到
 | (4) |
由于GPS能够提供实时的经度和纬度信息，根据式(4)可以得到矩阵Ci0n(t)的实时值，在求得Ci0n(t)之后，由式(1)可知，要想得到Cbn(t)，还需要求解Cib0i0和Cbib0(t)，接下首先来求解Cbib0(t)。
2.2 求解矩阵Cbib0(t) 变换矩阵Cbib0(t)可通过陀螺仪采样输出，利用捷联惯导姿态更新算法求得，设b系相对ib0系的转动四元数为
 | (5) |
式中：q0~q3为Q的元素；ib、jb和kb为相应的矢量。Q的即时修正可通过解下面的四元数微分方程来实现：
 | (6) |
式中：ωib0bb=[ωib0bxbωib0bybωib0bzb]T为b系相对ib0系的旋转角速度在b系的投影，可以由陀螺仪的输出直接获得，由于在对准的开始时刻b系与ib0系重合，所以此时b系相对ib0系的转动四元数为Q0=[1 0 0 0]T，从而根据式(6)可以得到实时的Q，在获得Q后，矩阵Cb0bi(t)便可以由式(7)求得。
 | (7) |
2.3 求解常值矩阵Cib0i0 常值矩阵Cib0i0表示ib0系到i0系的转换矩阵，只要同时获得某一物理量在ib0系和i0系中的投影，便可求得Cib0i0，基于这一想法，寻求满足要求的物理量便成了求解Cib0i0的关键点，这也是本文的创新之处。
在GPS和里程计辅助的惯导系统中，GPS可以提供载体相对地球在n系的实时速度Vn(t)=[VEn VNnVUn]T，VnE、VnN和VnU分别为载体沿东向、北向和天向的速度。里程计可以提供载体相对地球在b系的实时速度Vb(t)=[0 Vyb 0]T，其中Vyb为载体前进方向的速度。不难发现，可以由Vn(t)获得载体在i0系的速度投影V0i(t)如式(8)所示，同理，可以由Vb(t)获得载体在ib0系的速度投影Vb0i(t)如式(9)所示。
 | (8) |
 | (9) |
式中：Cni0(t)=(Ci0n(t))T可以由式(4)获得，Cbib0(t)可以由式(7)得到。
在获得Vi0(t)和Vib0(t)之后，便可用类似解析式粗对准的方法来求解Cib0i0，很明显存在式(10)的关系，Cib0i0=(Cib0i0)T。
 | (10) |
在对准时，选取2个不同的时刻t1和t2，可以得到
 | (11) |
将式(11)写成矩阵的形式可得
 | (12) |
对式(12)作进一步的变形可得到Cib0i0的具体表达为
 | (13) |
值得注意的是，为了求得Cib0i0，要求Vi0(t1)与Vi0(t2)不平行，为了满足这一要求，在对准时，载体只需做一转弯运动，即要求航向角有明显的变化，将t1和t2分别取为转弯前的某一时刻和转弯后的某一时刻；同时，为了减小测量速度误差的影响，要求载体在t1和t2时刻具有较快的运行速度，对其他时间段的运行速度不作要求。
综上可知，行进间初始对准算法中将捷联矩阵Cbn(t)的求解分解成Ci0n(t)、Cbib0(t)和Cib0i03个矩阵乘积的形式，这3个矩阵分别由式(4)、式(7)和式(13)求得，最后将求得的结果代入式(1)，便可求得初始姿态矩阵Cbn(t)，完成初始对准。
3 误差分析 3.1 误差分析方法1 对式(1)两端取微分，可得
 | (14) |
由式(14)可知，对准算法的误差由3部分组成，由Ci0n(t)的表达式(4)可知，Ci0n(t)的值由对准开始时刻的经度和纬度、当前时刻的经度和纬度以及对准时间所决定，而经度由GPS实时提供，认为是准确的，那么由Ci0n(t)带来的误差可以被忽略，即
 | (15) |
由δCbib0(t)引起的误差[24]为
 | (16) |
式中：Φib0为ib0系的失准角(计算坐标系相对真实坐标系的误差角)。由于εb很小，本文中采用低精度的陀螺，其常值漂移为0.1(°)/h，与转弯时的角速度(通常在10(°)/s)相比，完全可以忽略，又因对准时间一般较短，所以由εb引起的误差可以忽略不计，即
 | (17) |
接下来主要分析Cib0i0引起的姿态角误差，由Cib0i0的求解过程可知，Cib0i0是由Vn(t)、Vb(t)、Ci0n(t) 和Cbib0(t)共同决定的，由式(16)和式(17)可知Ci0n(t)和Cbib0(t)可以认为是准确的，如果直接分析由Vn(t)和Vb(t)的误差引起的Cib0i0的误差，进而分析由Cib0i0的误差引起的姿态角误差比较困难，但可以从Vn(t)、Vb(t)以及姿态角Φ=[θ γ φ]T之间的关系来分析由Vn(t)和Vb(t)的误差引起的姿态角误差，其中θ、γ和φ分别为俯仰角、横滚角和航向角。Vn(t)、Vb(t)和姿态角Φ之间的关系为
 | (18) |
由式(18)可得
 | (19) |
对式(19)两端求微分可得式(20)。
 | (20) |
式中：d(·) 为增量，也就是误差，将式(18)代入式(20)并进行整理，可得
 | (21) |
对于陆用惯导系统，由于对准时间比较短，可认为对准过程中的俯仰角约为0°且保持不变，则式(21)可进一步化解为
 | (22) |
3.2 误差分析方法2 为了获得误差方程，Cib0i0的表达式需要被改写为另一种形式，根据正交矩阵的性质，由式(13)可得
 | (23) |
其中：
取t2 时刻为对准结束时刻t ，将式(23)代入式(1)可得
 | (24) |
式中：
 |
由于对准的时间比较短，因而载车在t1 时刻的位置和在t2 时刻的位置的经纬度基本相等，所以关系式(25)成立。
 | (25) |
根据式(25)，进一步可得
 | (26) |
在对准过程中，俯仰角和横滚角可近似为0°，假设载车从t1 时刻到t2 时刻转过的角度为α，从而可得
 | (27) |
根据式(27)可得
 | (28) |
将式(26)和式(28)代入式(24)可得
 | (29) |
由姿态角和矩阵Cbnt2 之间的关系可得
 | (30) |
式中：TMN为矩阵Cbn(t2)中第M行第N列的元素。用式(19)推导式(22)的方法可得姿态角的误差方程为
 | (31) |
比较式(22)和式(31)可以发现，2种误差分析方法所得到的俯仰角和航向角的误差表达式是相同的，这也相互印证了2种方法的合理性。
根据式(31)还可以明确转弯角度、最小行驶速度及速度误差对姿态角误差的影响，很明显，在GPS和里程计的测速误差确定的条件下，行驶速度越快，姿态角误差越小，如果知道允许的最大姿态角误差，便可以求得最小的运行速度；转弯角度不能太小，如果想知道在行驶速度和器件误差确定的条件下，转弯角度为多少度时，横滚角误差最小，可通过对横滚角误差方程求极值的方法获得。
由式(31)可知，GPS的测速误差、载车的运行速度是引起姿态角误差的主要原因。当载车以25 m/s的速度运行，GPS的测速误差为0.1 m/s，对准过程中载车转过90°的弯，即航向角由0°变为 90°时，俯仰角的误差为dθ =0.229 2°，横滚角的误差为dγ=-0.229 2°，航向角的误差为dφ=-0.229 2°。
4 仿真实验与分析 4.1 仿真条件设置 本文提出的对准算法要求载车在对准过程有一次转弯运动，所以设计载车的运行路线为：载车先以25 m/s 的速度沿北向做直线运动，5 s之后开始减速为转弯运动做准备，经过5 s的减速运动后，以 2 m/s 的速度转弯，经过20 s后转过90°，此时载车的速度方向指向西，然后载车做5 s的加速运动，在第35 s时载车的速度达到25 m/s,之后载车以此速度做45 s的匀速直线运动。
开始对准时的经度为λ0=116.343 4°，纬度为L0=39.977 8°，初始的姿态角为Φ0=[0 0 0]T，低精度陀螺仪的采样率设为100 Hz，GPS和里程计的更新率为1 Hz，里程计的测量误差为行驶里程的千分之一，并将其转化为速度误差，GPS、里程计和陀螺仪的误差如表 1所示，表中的随机误差为白噪声误差。在仿真时，将t1取为1 s，t2取为t(t≥35 s)。
表 1 传感器误差设置 Table 1 Sensor errors setting
| 传感器误差 | 常值偏移 | 随机误差 |
| 陀螺仪误差/((°)·h-1) | 0.1 | 0.01 |
| 东向速度GPS误差/(m·s-1) | 0.1 | 0.01 |
| 北向速度GPS误差/(m·s-1) | 0.1 | 0.01 |
| 天向速度GPS误差/(m·s-1) | 0.1 | 0.01 |
| 里程计误差/(m·s-1) | 0.05 | 0.005 |
表选项
4.2 仿真结果与分析 图 1是俯仰角、横滚角和航向角在第35 s到第80 s之间的误差曲线，图中的圆点表示解算得到的姿态角误差，表 2 是相应的误差统计数据。由图可知，经过35 s便可完成对准，对准时间比较短而且对准误差小于0.3°，满足粗对准的要求。
 |
| 图 1 俯仰角误差、横滚角误差及偏航角误差曲线 Fig. 1 Alignment errors for pitch angle，roll angle and yaw angle |
| 图选项 |
表 2 误差统计数据 Table 2 Statistics of alignment errors
| 姿态角 | 误差均值/(°) | 误差标准差/(°) |
| 俯仰角 | 0.225 8 | 0.025 2 |
| 横滚角 | -0.247 2 | 0.001 6 |
| 航向角 | -0.234 6 | 0.012 6 |
表选项
由表 2可知，俯仰角和航向角的误差均值分别为0.225 8°和-0.234 6°，与由误差方程计算得到的俯仰角和航向角误差0.229 2°和-0.229 2°相比，分别相差-0.003 4°和-0.005 4°，说明上面推导的误差方程是合理的。由图 1(a) 和图 1(c)还可以发现，俯仰角和航向角的误差存在小幅度的波动现象，由式(21)可知，这主要是由表 1中GPS的随机误差引起的，这也是造成解算得到的误差与由误差方程计算得到的误差存在差异的主要原因。由式(31)可知，在转弯角为90°，时，横滚角的误差主要由t1 时刻GPS的天向速度误差和运行速度决定，仿真时t1 时刻的速度误差为0.108 7m/s(常值误差与随机误差的和)，由式(31)计算得到的横滚角误差为-0.249 1°，与表 2中的误差均值-0.247 2°相差-0.001 9°说明误差方程是可信的。由图 1(b)横滚角的误差曲线可知，其值由-0.249°变到-0.244°，变化量为0.005°，与误差值相比可以忽略，且其在变化过程中也并非严格的在数值上递减，所以可以认为在转弯角为90°时，横滚角误差保持不变。
由图 1(b)中横滚角的误差变化曲线可知，在转弯角为90°时，横滚角的误差几乎没有波动，说明与俯仰角和航向角相比，受随机误差的影响比较小，这一结论同样可由表 2中的误差标准差说明；另一方面，由式(31)可知，俯仰角和航向角误差主要受t2 时刻速度误差的影响，而横滚角误差主要受t1 时刻速度误差的影响，由于t2是变化的，t1 是保持不变的，这也能说明为什么横滚角受随机误差的影响比较小。
尽管在误差方程中没有体现出里程计误差对姿态角误差的影响，但测量得到的载车在b 系的速度并非载车的真实速度，而是包含了里程计测量误差的速度，所以在对准过程中里程计的测量误差已经对姿态角的误差产生了作用。
2种误差分析方法中都假定了俯仰角和横滚角为0°，同时再考虑计算误差和舍入误差等的影响，必然使得由误差方程计算得到的误差与通过仿真得到的误差之间存在微小的差异。
5 结 论 针对车载捷联惯导系统，提出一种快速行进间粗对准方法，根据理论分析和仿真实验可以得出如下结论：
1) 该行进间对准方法能在1min之内完成粗对准，采用0.1(°)/h的低精度陀螺，对准误差小于0.3°。
2) 姿态角误差主要受GSP提供的速度的常值误差的影响，且载车的运行速度越快，姿态角误差越小。
3) 与现有的对准方法相比，该方法没有用到加速度计的测量信息，这使得该方法只能在行进间完成对准；与现有的行进间对准方法相比，该方法对载车的机动方式没有过多的限制，且可以快速完成粗对准。
本文中用2种方法给出了姿态角的误差方程，接下来会在此基础上对该算法进行改进，提高对准的精度；同时研究如何将该方法与现有的滤波方法相结合，以期获得一种对准精度高且对准时间短的行进间对准方法。
参考文献
| [1] | YU H, WU W, WU M, et al. Stochastic observability-based analytic optimization of SINS multiposition alignment[J].IEEE Transactions on Aerospace and Electronic Systems, 2015, 51(3): 2181–2192.DOI:10.1109/TAES.2015.130674 |
| [2] | SUN F,SUN W,WU L.Coarse alignment based on IMU rotational motion for surface ship[C]//Position Location and Navigation Symposium (PLANS),IEEE/ION.Piscataway,NJ:IEEE Press,2010:151-156. |
| [3] | LEE J G, PARK C, PARK H W. Multiposition alignment of strapdown inertial navigation system[J].IEEE Transactions on Aerospace and Electronic Systems, 1993, 29(4): 1323–1328.DOI:10.1109/7.259535 |
| [4] | FANG J C, WAN D J. A fast initial alignment method for strapdown inertial navigation system on stationary base[J].IEEE Transactions on Aerospace and Electronic Systems, 1996, 32(4): 1501–1504.DOI:10.1109/7.543871 |
| [5] | YU M J, LEE J G, PARK C G. Nonlinear robust observer design for strapdown INS in-flight alignment[J].IEEE Transactions on Aerospace and Electronic Systems, 2004, 40(3): 797–807.DOI:10.1109/TAES.2004.1337455 |
| [6] | GAO S, WEI W H, ZHONG Y M, et al. Rapid alignment method based on local observability analysis for strapdown inertial navigation system[J].Acta Astronautica, 2014, 94(2): 790–798.DOI:10.1016/j.actaastro.2013.10.003 |
| [7] | CHEN Y, ZHAO Y. New rapid transfer alignment method for SINS of airborne weapon systems[J].Journal of Systems Engineering and Electronics, 2014, 25(2): 281–287.DOI:10.1109/JSEE.2014.00032 |
| [8] | SUN F, SUN W. Mooring alignment for marine SINS using the digital filter[J].Measurement, 2010, 43(10): 1489–1494.DOI:10.1016/j.measurement.2010.08.008 |
| [9] | LU S, XIE L, CHEN J. New techniques for initial alignment of strapdown inertial navigation system[J].Journal of the Franklin Institute, 2009, 346(10): 1021–1037.DOI:10.1016/j.jfranklin.2009.09.003 |
| [10] | EL-SHEIMY N, NASSAR S, NOURELDIN A. Wavelet de-noising for IMU alignment[J].Aerospace and Electronic Systems Magazine, IEEE, 2004, 19(10): 32–39.DOI:10.1109/MAES.2004.1365016 |
| [11] | LI Z, WANG J, GAO J, et al. A Vondrak low pass filter for IMU sensor initial alignment on a disturbed base[J].Sensors, 2014, 14(12): 23803–23821.DOI:10.3390/s141223803 |
| [12] | LI Q, BEN Y, YANG J. Coarse alignment for fiber optic gyro SINS with external velocity aid[J].Optik-International Journal for Light and Electron Optics, 2014, 125(16): 4241–4245.DOI:10.1016/j.ijleo.2014.04.015 |
| [13] | LIU X, LIU X, SONG Q, et al. A novel self-alignment method for SINS based on three vectors of gravitational apparent motion in inertial frame[J].Measurement, 2015, 62: 47–62.DOI:10.1016/j.measurement.2014.11.010 |
| [14] | MA L, WANG K, SHAO M. Initial alignment on moving base using GPS measurements to construct new vectors[J].Measurement, 2013, 46(8): 2405–2410.DOI:10.1016/j.measurement.2013.04.058 |
| [15] | GU D,EI-SHEIMY N,HASSAN T,et al.Coarse alignment for marine SINS using gravity in the inertial frame as a reference[C]//Position,Location and Navigation Symposium,IEEE/ION.Piscataway,NJ:IEEE Press,2008:961-965. |
| [16] | SILON P M G, JORDAN S.A novel inertial coarse alignment method[C]//Proceedings of the AIAA Guidance,Navigation and Control Conference.Reston:AIAA,2010:2-5. |
| [17] | 刘飞, 杨功流, 周卫宁. 基于里程计的捷联惯导行进中对准方法研究[J].导航与控制, 2010, 9(4): 41–45.LIU F, YANG G L, ZHOU W N. Research on SINS ODO initial alignment on moving base[J].Navigation and Control, 2010, 9(4): 41–45.(in Chinese) |
| [18] | SILON P M G. Coarse alignment of a ship's strapdown inertial attitude reference system using velocity loci[J].IEEE Transactions on Instrumentation and Measurement, 2011, 60(6): 1930–1941.DOI:10.1109/TIM.2011.2113131 |
| [19] | LI W, TANG K, LU L, et al. Optimization-based INS in-motion alignment approach for underwater vehicles[J].Optik-International Journal for Light and Electron Optics, 2013, 124(20): 4581–4585.DOI:10.1016/j.ijleo.2013.01.069 |
| [20] | 练军想, 吴文启, 吴美平, 等. 车载SINS行进间初始对准方法[J].中国惯性技术学报, 2007, 15(2): 155–159.LIAN J X, WU W Q, WU M P, et al. SINS initial alignment algorithm for marching vehicles[J].Journal of Chinese Inertial Technology, 2007, 15(2): 155–159.(in Chinese) |
| [21] | 严恭敏, 秦永元, 马建萍. 车载导航系统动态高精度初始对准技术[J].系统工程与电子技术, 2006, 28(9): 1404–1407.YAN G M, QIN Y Y, MA J P. High precision dynamic initial alignment technique for vehicular navigation system[J].Systems Engineering and Electronics, 2006, 28(9): 1404–1407.(in Chinese) |
| [22] | SUN F, LAN H Y, YU C Y, et al. A robust self-alignment method for ship's strapdown INS under mooring conditions[J].Sensors, 2013, 13(7): 8103–8139.DOI:10.3390/s130708103 |
| [23] | 马建萍. GPS辅助捷联惯导系统动基座初始对准新方法[J].传感技术学报, 2010, 23(11): 1656–1661.MA J P. A new GPS aided initial alignment algorithm for SINS on moving base[J].Chinese Journal of Sensors and Actuators, 2010, 23(11): 1656–1661.(in Chinese) |
| [24] | 孙枫, 曹通. 基于重力信息的惯性系粗对准精度分析[J].仪器仪表学报, 2011, 32(11): 2409–2415.SUN F, CAO T. Accuracy analysis of coarse alignment based on gravity in inertial frame[J].Chinese Journal of Scientific Instrument, 2011, 32(11): 2409–2415.(in Chinese) |
