基于运动约束的航姿系统误差自主补偿方法

doi:10.12305/j.issn.1001-506X.2024.06.28

摘要/Abstract

摘要：

为了提高车载捷联航姿系统的长航时定姿精度, 提出利用载车的运动约束条件对航姿系统误差进行在线自主补偿。首先, 对航姿系统的传感器误差、安装误差等进行分析与建模, 选取航姿系统的各项误差作为误差补偿滤波的系统状态, 建立系统状态方程。然后, 根据发射车等特种车辆的运动特点, 利用车辆运动约束条件, 将载车行驶过程中航姿系统的速度输出在车体坐标系横向和垂向上的投影分量作为误差补偿滤波的量测, 推导获得误差补偿滤波的量测方程。最后, 采用卡尔曼滤波设计航姿系统误差在线估计算法。实验结果表明, 所提方法能够自主有效地补偿航姿系统的积累误差, 经过1 200 s的跑车实验, 系统的航姿误差始终保持有效收敛, 其中航向精度优于3.4′, 水平姿态精度优于0.4′。

关键词: 车载航姿系统, 误差补偿, 运动约束, 卡尔曼滤波

Abstract:

In order to improve the attitude determination accuracy of vehicle strapdown attitude and heading system in long distance, the on-line independent error compensation of attitude and heading system is proposed by using the motion constraints of the vehicle. Firstly, the sensor errors and installation errors of the attitude and heading system are analyzed and modeled. Then various errors of the attitude and heading system are selected as the system state of error compensation filtering, and the corresponding system state equation is established. Secondly, according to the motion characteristics of special vehicles such as launch vehicles, using the vehicle motion constraints, the projection components of the velocity output of attitude and heading system in the transverse and vertical directions of the vehicle body coordinate system are taken as the measurement of the error compensation filtering, and the measurement equation of the error compensation filtering is derived. Finally, kalman filter is used to design the on-line estimation algorithm of attitude and heading system errors. Experiment results show that the proposed method can independently and effectively compensate the accumu-lated errors of the attitude and heading system. After 1 200 s of vehicle experiment, the heading and attitude errors of the system always keep effective convergence, in which the heading accuracy is better than 3.4′, and the horizontal attitude accuracy is better than 0.4′.

Key words: vehicle attitude and heading system, error compensation, motion constraint, Kalman filter

中图分类号:

V249.3

杨波, 刘枫, 薛亮, 刘云峰. 基于运动约束的航姿系统误差自主补偿方法[J]. 系统工程与电子技术, 2024, 46(6): 2099-2106.

Bo YANG, Feng LIU, Liang XUE, Yunfeng LIU. Independent error compensation method of attitude and heading system based on motion constraints[J]. Systems Engineering and Electronics, 2024, 46(6): 2099-2106.

图/表 9

图1

图2

图3

图4

图5

图6

图7

图8

图9

参考文献 12

13	陈思,仲启媛,谭立龙,等.基于RFID的车载定位定向技术研究与应用[J].火炮发射与控制学报,2019,40(1):13-18.
	CHENS,ZHONGQ Y,TANL L,et al.Research and application of vehicle position and azimuth determining technology based on RFID[J].Journal of Gun Launch & Control,2019,40(1):13-18.
14	WANGM,WANGL,HANH.Research on improving heading and attitudes accuracy by online calibration of errors based on multi-RINSs joint rotation modulation[J].IEEE Sensors Journal,2022,22(5):4503-4513. doi: 10.1109/JSEN.2022.3141462
15	LI Y Y, ZHU T, LI R Y. Analysis of attitude and heading computer system in magnetic disturbance state[C]//Proc. of the 4th International Conference on Artificial Intelligence and Advanced Manufacturing, 2022: 202-207.
16	王平,张广鹏,杨波,等.基于零速的航姿误差补偿方法研究[J].仪器仪表学报,2018,39(11):125-132.
	WANGP,ZHANGG P,YANGB,et al.Research on error compensation method of attitude and heading based on zero velocity[J].Chinese Journal of Scientific Instrument,2018,39(11):125-132.
17	FARHANGIANF,LANDRYR.Accuracy improvement of attitude determination systems using EKF-based error prediction filter and PI controller[J].Sensors,2020,20(14):4055. doi: 10.3390/s20144055
18	VERTZBERGERE,KLEINI.Attitude adaptive estimation with smartphone classification for pedestrian navigation[J].IEEE Sensors Journal,2021,21(7):9341-9348. doi: 10.1109/JSEN.2021.3053843
19	VERTZBERGER E, KLEIN I. Attitude and heading adaptive estimation using a data driven approach[C]//Proc. of the International Conference on Indoor Positioning and Indoor Navigation, 2021.
20	FARAHANS B,MACHADOJ J M,GOMESF A D,et al.9-DOF IMU-based attitude and heading estimation using an extended Kalman filter with bias consideration[J].Sensors,2022,22(9):3416. doi: 10.3390/s22093416
21	ASSEFINEWW,JINSEOKJ,SEUNGKIK,et al.Improved attitude and heading accuracy with double quaternion parameters estimation and magnetic disturbance rejection[J].Sensors,2021,21(16):5475. doi: 10.3390/s21165475
1	黎蕾蕾,孙红星,李德仁,等.车载移动测量中定位定姿系统误差校正与补偿研究[J].武汉大学学报: 信息科学版,2016,41(9):1245-1252.
	LIL L,SUNH X,LID R,et al.Calibration and compensation study on position and orientation system in mobile mapping application[J].Geomatics and Information Science of Wuhan University,2016,41(9):1245-1252.
2	KEIGHOBADIJ,FARAJIJ,JANABI-SHARIFIF,et al.Design and experimental evaluation of block-pulse functions and Legendre polynomials observer for attitude-heading reference system[J].ISA Transactions,2021,116(10):232-244.
3	LI D H, GAO Y, XIE J X, et al. Aircraft attitude data fusion based on gradient descent algorithm[C]//Proc. of the 5th International Conference on Robotics, Control and Automation, 2021.
4	王丽芬,杨功流,单友东,等.车载定位定向系统误差在线补偿方法[J].中国惯性技术学报,2015,23(2):145-149.
	WANGL F,YANGG L,SHANY D,et al.On-line error compensation of vehicular position and orientation determination system[J].Journal of Chinese Inertial Technology,2015,23(2):145-149.
5	NIKOLAY V, MIKHAIL V, DMITRY T. Heading and attitude determination system with low-cost IMU embedded inside one of multiple antennas[C]//Proc. of the IEEE/ION Position, Location and Navigation Symposium, 2018.
6	LUOL,HUANGY L,ZHANGZ,et al.A position loci-based in-motion initial alignment method for low-cost attitude and heading reference system[J].IEEE Trans.on Instrumentation and Measurement,2021,70,7500618.
7	邓瑀, 严恭敏, 杨小康. 基于SINS/GNSS/ADS融合的MEMS航姿参考系统研究[C]//惯性技术发展动态发展方向研讨会——惯性传感器技术与应用, 2020.
	DENG Y, YAN G M, YANG X K. Research on MEMS attitude and heading reference system based on SINS/GNSS/ADS[C]//Proc. of the Conference on the Dynamic Development Direction of Inertial Technology—Inertial Technology and Application, 2020.
8	SUNW,SUNP L,WUJ J.An adaptive fusion attitude and heading measurement method of MEMS/GNSS based on cova-riance matching[J].Micromachines,2022,13(10):1787. doi: 10.3390/mi13101787
9	TAOC H,SONGZ P,WENGZ P.MCTLS-assisted completed SINS/GPS integrated and applied to low-cost attitude and heading reference system[J].Mathematical Problems in Engineering,2021,2021,4260162.
10	胡永江,武斌,陈鹏,等.小型尾坐式飞行器航姿测量系统设计与验证[J].系统工程与电子技术,2017,39(4):866-875.
	HUY J,WUB,CHENP,et al.Design and validation of attitude and heading measurement system of small tail-sitter aircraft[J].Systems Engineering and Electronics,2017,39(4):866-875.
22	YUJ Y,ZHANGX,KHANA S M.Attitude heading refe-rence algorithm based on transformed cubature Kalman filter[J].Measurement and Control,2020,53(7/8):1446-1453.
23	王琮,陈安升,陈帅,等.MIMU/GNSS/ODO/高度计/航姿仪组合导航微系统硬件设计[J].航天控制,2020,38(5):73-79.
	WANGC,CHENA S,CHENS,et al.Hardware design of MIMU/GNSS/ODO/altimeter/attitude instrument integrated navigation system[J].Aerospace Control,2020,38(5):73-79.
24	FANJ C,WANGZ C,LINM X,et al.Research on vehicle attitude and heading reference system based on multi-sensor information fusion[J].Proceedings of the Institution of Mechanical Engineers, Part D Journal of Automobile Engineering,2020,234(13):3056-3067. doi: 10.1177/0954407020927546
25	YANGB,XIJ X,YANGJ,et al.An alignment method for strapdown inertial navigation systems assisted by Doppler radar on a vehicle-borne moving base[J].Sensors,2019,19(20):4577. doi: 10.3390/s19204577
26	LIX,LIH X,HUANGG W,et al.Non-holonomic constraint (NHC)-assisted GNSS/SINS positioning using a vehicle motion state classification (VMSC)-based convolution neural network[J].GPS Solutions,2023,27(3):144-153. doi: 10.1007/s10291-023-01483-9
27	秦永元,张洪钺,汪叔华.卡尔曼滤波与组合导航原理[M].4版西安:西北工业大学出版社,2021.
	QINY Y,ZHANGH Y,WANGS H.Kalman filter and integrated navigation principle[M].4th edXi'an:Northwestern Polytechnic University Pres,2021.
28	YANGB,WANGY G,XUEL,et al.Accurate integrated position and orientation method for vehicles based on strapdown inertial navigation system/Doppler radar[J].Measurement and Control,2018,51(9/10):431-442.
11	李翔,石琦.融合光流与惯性传感器的扩展卡尔曼姿态滤波[J].电子测量技术,2021,44(17):88-92.
	LIX,SHIQ.Extended Kalman attitude filter incorporating optical flow and inertial sensors[J].Electronic Measurement Technology,2021,44(17):88-92.
12	LIUX,YANGJ,LIW S,et al.Tightly coupled modeling and reliable fusion strategy for polarization-based attitude and heading reference system[J].IEEE Trans.on Industrial Informatics,2023,19(1):62-73. doi: 10.1109/TII.2022.3160164

[1]	郭士荦, 王春雨, 李洋, 田鹏. 卡尔曼滤波器异常自检及其在SINS初始对准中的应用[J]. 系统工程与电子技术, 2024, 46(2): 668-674.
[2]	刘正洋, 周丽, 张瑞. 随机参数摄动下的高超声速飞行器姿态控制[J]. 系统工程与电子技术, 2024, 46(2): 703-714.
[3]	陈炳龙, 王磊, 刘帮, 周衡. 基于太阳导行镜测量的高精度姿态确定算法[J]. 系统工程与电子技术, 2024, 46(1): 245-253.
[4]	王希彬, 戴洪德, 全闻捷, 王瑞, 贾临生. 基于加速度补偿的惯性行人导航非零速区间姿态估计CKF算法[J]. 系统工程与电子技术, 2023, 45(9): 2894-2901.
[5]	查峰, 位秋硕, 何泓洋, 李豹. 基于IMU体对角线旋转的双轴旋转方案[J]. 系统工程与电子技术, 2023, 45(8): 2546-2554.
[6]	戴洪德, 马宇峰, 戴邵武, 郑百东, 张笑宇. 航向误差非线性预测的惯性行人导航零速修正算法[J]. 系统工程与电子技术, 2023, 45(8): 2555-2561.
[7]	戴礼灿, 刘欣, 张海瀛, 代翔, 王成刚. 基于卡尔曼滤波算法展开的飞行目标轨迹预测[J]. 系统工程与电子技术, 2023, 45(6): 1814-1820.
[8]	何益康, 张文瀚, 王振华, 何闻. 用于卫星应急恢复的太阳电池阵转角估计方法[J]. 系统工程与电子技术, 2023, 45(3): 797-805.
[9]	靳凯迪, 柴洪洲, 宿楚涵, 向民志, 李明. 基于状态变换卡尔曼滤波的DVL/SINS组合导航算法[J]. 系统工程与电子技术, 2023, 45(11): 3624-3631.
[10]	穆静, 严东升, 蔡远利, 王长元. 基于Masreliez-Martin的鲁棒分数阶容积卡尔曼滤波算法及应用[J]. 系统工程与电子技术, 2023, 45(1): 234-240.
[11]	徐庚, 何永旭, 张勇刚. 基于罗德里格斯参数的惯性系传递对准算法[J]. 系统工程与电子技术, 2022, 44(9): 2903-2913.
[12]	史浩然, 卢发兴, 祁江鑫, 杨光. 基于辅助信标的无人机协同目标跟踪[J]. 系统工程与电子技术, 2022, 44(7): 2302-2310.
[13]	翟光, 王妍欣, 孙一勇. 基于低轨星网的多目标协同跟踪滤波技术[J]. 系统工程与电子技术, 2022, 44(6): 1957-1967.
[14]	董一平, 刘宁, 苏中, 王靖骁, 白宏阳. 基于AEKF的高速自旋飞行体组合导航方法[J]. 系统工程与电子技术, 2022, 44(6): 1977-1983.
[15]	李文华, 汪立新, 沈强, 李灿, 吴宗收. 基于鲁棒EKF的MEMS-INS/GNSS/VO组合导航方法[J]. 系统工程与电子技术, 2022, 44(6): 1994-2000.