-
摘要:
针对车载捷联惯导系统(SINS),提出一种快速行进间粗对准方法。将捷联矩阵分解为3个矩阵相乘,利用GPS提供的载体在导航坐标系的速度和里程计提供的载体在载体坐标系的速度构建不共线向量,求解初始载体坐标系相对惯性坐标系的常值转换矩阵,进而求得初始姿态矩阵。该对准方法对载车的唯一要求是在对准过程中做一个转弯机动。与现有对准方法相比,该方法没有用到加速度计信息。仿真结果表明,该方法能在1 min之内完成粗对准,采用零偏为0.1(°)/h的低精度陀螺,对准误差小于0.3°。
Abstract:Aimed at vehicle-mounted strap-down inertial navigation system (SINS), a rapid coarse alignment method for marching vehicle is proposed. The matrix between navigation frame and body frame is decomposed into three parts. The problem to solve the matrix between navigation frame and body frame is attributed to solving the matrix between initial body frame and inertial frame, which can be obtained by the non-colinear vectors constructed with the vehicle's velocity from GPS in navigation frame and that from odometer in body frame. The only requirement of this alignment method for marching vehicle is a turning movement in the alignment stage. Compared with the existing alignment methods, this method does not use the measurement information of accelerometers. The simulation results show that the coarse alignment can be fulfilled in 1 minute, and the alignment error is less than 0.3° with low accuracy gyros whose zero bias is 0.1(°)/h.
-
Key words:
- coarse alignment /
- GPS /
- odometer /
- non-colinear vectors /
- turning movement
-
表 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 表 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 -
[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. http://www.cnki.com.cn/Article/CJFDTOTAL-ZGXJ200702009.htmLIAN 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). http://www.cnki.com.cn/Article/CJFDTOTAL-ZGXJ200702009.htm [21] 严恭敏,秦永元,马建萍.车载导航系统动态高精度初始对准技术[J].系统工程与电子技术,2006,28(9):1404-1407. http://www.cnki.com.cn/Article/CJFDTOTAL-XTYD200609029.htmYAN 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). http://www.cnki.com.cn/Article/CJFDTOTAL-XTYD200609029.htm [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. http://www.cnki.com.cn/Article/CJFDTOTAL-CGJS201011029.htmMA 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). http://www.cnki.com.cn/Article/CJFDTOTAL-CGJS201011029.htm [24] 孙枫,曹通.基于重力信息的惯性系粗对准精度分析[J].仪器仪表学报,2011,32(11):2409-2415. http://www.cnki.com.cn/Article/CJFDTOTAL-YQXB201111002.htmSUN 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). http://www.cnki.com.cn/Article/CJFDTOTAL-YQXB201111002.htm