Citation: | ZHANG Zhigang, ZHU Qiming, HE Jie, et al. Vehicle heading angle measure technology based on RTK-GNSS and MEMS gyroscope[J]. Journal of South China Agricultural University, 2019, 40(5): 34-37. DOI: 10.7671/j.issn.1001-411X.201905085 |
To better meet the accuracy requirement of vehicle heading angle measure.
Kalman filter algorithm was proposed. The latitude, longitude and elevation measured by RTK-GNSS receiver were converted to plane coordinates using Gaussian projection. The Gaussian plane coordinates and the accumulated heading angle measured by gyroscope were integrated by Kalman filter, and finally more accurate heading angle was obtained.
The integrated curve kept the entire variation trend of the heading angle measured by GNSS receiver and the partial variation trend measured by MEMS gyroscope. The curve was smoother than that based on GNSS and gyroscope, and could follow action of vehicle 180° turning.
The Kalman filter algorithm can measure the vehicle heading angle data in real time and the precision was improved 80% more than the result measured by GNSS.
[1] |
别韦苇, 卢飞腾, 胡进, 等. 基于多器件的航向角优化算法[C]// 2018中国汽车工程学会年会论文集. 上海: 中国汽车工程学会, 汽车环境保护技术分会. 2018: 104-107.
|
[2] |
卢志才, 米东, 徐章遂, 等. 基于改进巨磁阻传感器的地磁定向系统[J]. 传感技术学报, 2011, 24(2): 304-307. doi: 10.3969/j.issn.1004-1699.2011.02.028
|
[3] |
李秉玺. 基于系统芯片的捷联式定向系统研究[D]. 西安: 西北工业大学, 2004.
|
[4] |
HE P, CARDOU P, DESBIENS A, et al. Estimating the orientation of a rigid body moving in space using inertial sensors[J]. Multibody Syst Dyn, 2015, 35(1): 63-89. doi: 10.1007/s11044-014-9425-8
|
[5] |
LI Y, EFATMANESHNIK M, DEMPSTER A G. Attitude determination by integration of MEMS inertial sensors and GPS for autonomous agriculture applications[J]. GPS Solut, 2012, 16(1): 41-52. doi: 10.1007/s10291-011-0207-y
|
[6] |
刘永彪. 基于GNSS双天线的定向研究[D]. 南昌: 南昌大学, 2011.
|
[7] |
夏佩, 王峰, 黄祖德, 等. 基于双天线的RTK-GNSS定向方法[J]. 中国新通信, 2018, 20(22): 58-60. doi: 10.3969/j.issn.1673-4866.2018.22.045
|
[8] |
甘雨, 隋立芬, 戚国宾, 等. 陆地导航中GNSS/陀螺仪组合实时测姿方法[J]. 武汉大学学报(信息科学版), 2015, 40(3): 379-383.
|
[9] |
HE J, XIE J, HE X, et al. Analytical study and compensation for temperature drifts of a bulk silicon MEMS capacitive accelerometer[J]. Sens Actuators A Phys, 2016, 239: 174-184. doi: 10.1016/j.sna.2016.01.026
|
[10] |
陈亮, 杨柳庆, 肖前贵. 基于梯度下降法和互补滤波的航向姿态参考系统[J]. 电子设计工程, 2016, 24(24): 38-41.
|
[11] |
姚卓. 基于双天线的车载GNSS/INS组合导航技术研究[D]. 武汉: 武汉大学, 2017.
|
[12] |
张智刚, 罗锡文, 胡炼, 等. 4种DGPS模块动态定位精度测试与分析[J]. 华南农业大学学报, 2010, 31(1): 102-107. doi: 10.3969/j.issn.1001-411X.2010.01.025
|
[13] |
MOUSAZADEH H. A technical review on navigation systems of agricultural autonomous off-road vehicles[J]. J Terramechanics, 2013, 50(3): 211-232. doi: 10.1016/j.jterra.2013.03.004
|
[14] |
NAGASAKA Y, SAITO H, TAMAKI K, et al. An autonomous rice transplanter guided by global positioning system and inertial measurement unit[J]. J Field Robot, 2010, 26(6/7): 537-548.
|
[15] |
CECHOWICZ R. Bias drift estimation for MEMS gyroscope used in inertial navigation[J]. Acta Mechanica Et Automatica, 2017, 11(2): 104-110. doi: 10.1515/ama-2017-0016
|
1. |
林子钧,尤德安,廖滔,张嘉谋,彭志锋,王红军. 基于GNSS+IMU的草方格固沙机自动巡航控制系统. 农机化研究. 2024(05): 37-44 .
![]() | |
2. |
何杰,魏正辉,胡炼,汪沛,黄培奎,丁帅奇. 基于两位置法与改进STEKF的农机航向角测量方法. 农业机械学报. 2024(12): 365-372 .
![]() | |
3. |
陈学深,熊悦淞,齐龙,王宣霖,程楠,梁俊,刘善健. 基于触感引导的小型水田行进底盘自动对行方法. 农业工程学报. 2022(21): 8-15 .
![]() | |
4. |
曹丽琴,王琪,黄堃,徐成杰,石云波,马宗敏,程林. 基于微机电系统传感器的杆塔倾斜度无线监测系统. 科学技术与工程. 2021(02): 616-622 .
![]() | |
5. |
张智刚,王明昌,毛振强,王辉,丁凡,李洪开,张天. 基于星基增强精密单点定位的农机自动导航系统开发与测试. 华南农业大学学报. 2021(06): 109-116 .
![]() | |
6. |
周俊,许建康,王耀羲,梁友斌. 基于GNSS的智能水田旋耕平地机研究. 农业机械学报. 2020(04): 38-43 .
![]() | |
7. |
苏静. 船舶航向实时控制算法优化. 舰船科学技术. 2020(12): 55-57 .
![]() |