智能手机GNSS/MEMS IMU车载组合导航的安装角估计算法

王甫红; 程雨欣; 赵广越; 张万威

doi:10.13203/j.whugis20230381

您当前的位置：

首页 >

文章列表页 >

智能手机GNSS/MEMS IMU车载组合导航的安装角估计算法

大地测量学与测量工程 | 更新时间：2026-11-05

- 智能手机GNSS/MEMS IMU车载组合导航的安装角估计算法
- Mounting Angle Estimation Algorithm for Smartphone GNSS/MEMS IMU Vehicle-Borne Integrated System
- 武汉大学学报（信息科学版） 2025年50卷第10期页码：1948-1956
- 作者机构：
  
  武汉大学测绘学院，湖北武汉，430079
- 作者简介：
  
  王甫红，博士，教授，主要从事卫星导航定位和卫星定轨方法的教学与研究工作。fhwang@sgg.whu.edu.cn
- 基金信息：
  
  国家自然科学基金(62103307;62073044);卫星导航系统与装备技术国家重点实验室开放基金(CEPNT-2021KF-05)
- DOI：10.13203/j.whugis20230381
  中图分类号： P228
- 收稿：2023-12-23，
  
  纸质出版：2025-10-05
- 稿件说明：
移动端阅览
王甫红,程雨欣,赵广越，等.智能手机GNSS/MEMS IMU车载组合导航的安装角估计算法[J].武汉大学学报（信息科学版）,2025,50(10):1948-1956.

WANG Fuhong,CHENG Yuxin,ZHAO Guangyue,et al.Mounting Angle Estimation Algorithm for Smartphone GNSS/MEMS IMU Vehicle-Borne Integrated System[J].Geomatics and Information Science of Wuhan University,2025,50(10):1948-1956.
王甫红,程雨欣,赵广越，等.智能手机GNSS/MEMS IMU车载组合导航的安装角估计算法[J].武汉大学学报（信息科学版）,2025,50(10):1948-1956. DOI：,10.13203/j.whugis20230381

WANG Fuhong,CHENG Yuxin,ZHAO Guangyue,et al.Mounting Angle Estimation Algorithm for Smartphone GNSS/MEMS IMU Vehicle-Borne Integrated System[J].Geomatics and Information Science of Wuhan University,2025,50(10):1948-1956. DOI：,10.13203/j.whugis20230381

摘要

针对智能手机车载导航时因安装角未知而降低全球导航卫星系统(global navigation satellite system

GNSS)/惯性导航系统组合导航精度与性能的问题，在智能手机GNSS/微机械惯性测量单元(micro-electro-mechanical system inertial measurement unit，MEMS IMU）紧组合导航算法的基础上，提出以载波相位时间差分计算得出的历元间位置变化量来构建安装角估计的观测方程，并在线估计智能手机车载导航安装角的卡尔曼滤波算法。在典型城市环境的两组车载实验结果表明，所提算法在较为严重的遮挡环境下可在80 s内实现大安装角初始化，安装角滤波器收敛后安装角波动在2°以内。安装角估计成功后，使用非完整性约束算法，严重遮挡条件下车载组合导航的精度与性能得到明显提升，平面位置与高程的精度统计均能维持在5 m左右。所提算法不需要增加里程计等辅助设备，能够较快实现智能手机大安装角的精确估计。

Abstract

Objectives

The unknown inertial measurement unit (IMU) mounting angles

i.e.

the misalignment angles between the smartphone's IMU and the vehicle body frame

can seriously affect the smartphone-based global navigation satellite system (GNSS)/inertial navigation system integrated system for vehicular navigation.

Methods

A real-time estimation of the IMU mounting angles is addressed through a Kalman filter whose measurement updates are realized by position variation between epochs derived by time-differenced carrier phase besides the smartphone GNSS/ micro-electro-mechanical system inertial measurement unit (MEMS IMU) tightly-coupled integration algorithm.

Results

Two vehicular navigation experiments were carried out in urban challenging environments to evaluate the performance of the proposed algorithm. The results show that a large mounting angle can be initialized within 80 s under moderate occlusion conditions

then convergence of the estimated mounting angle is shown to occur within minutes

and the accuracy is in the order of 2°. When the mounting angle is estimated successfully

the positioning performance of smartphone vehicular positioning will be improved significantly

both horizontal and vertical accuracy can be maintained at about 5 m in terms of root mean square by applying non-holonomic constraint under severe occlusion conditions.

Conclusions

The proposed algorithm can estimate large mounting angles accurately and rapidly without any auxiliary equipment such as an odometer.

关键词

Keywords

references

张小红，陶贤露，王颖喆，等 . 城市场景智能手机GNSS/MEMS融合车载高精度定位［J］. 武汉大学学报（信息科学版）， 2022 ， 47 （ 10 ）： 1740 - 1749 .

ZHANG Xiaohong ， TAO Xianlu ， WANG Yingzhe ， et al . MEMS-Enhanced Smartphone GNSS High-Precision Positioning for Vehicular Navigation in Urban Conditions ［J］. Geomatics and Information Science of Wuhan University ， 2022 ， 47 （ 10 ）： 1740 - 1749 .

王颖喆，胡捷，陶贤露，等 . Android智能手机双频GNSS伪距差分动态定位性能分析［J］. 导航定位与授时， 2021 ， 8 （ 5 ）： 103 - 110 .

WANG Yingzhe ， HU Jie ， TAO Xianlu ， et al . Performance Analysis of Dual-Frequency GNSS Pseudo-Range Differential Dynamic Positioning for Android Smartphones ［J］. Navigation Positioning and Timing ， 2021 ， 8 （ 5 ）： 103 - 110 .

王颖喆，陶贤露，朱锋，等 . 利用智能手机实现GNSS原始观测值的高精度差分定位［J］. 武汉大学学报（信息科学版）， 2021 ， 46 （ 12 ）： 1941 - 1950 .

WANG Yingzhe ， TAO Xianlu ， ZHU Feng ， et al . High Accuracy Differential Positioning with Smartphone GNSS Raw Measurements ［J］. Geomatics and Information Science of Wuhan University ， 2021 ， 46 （ 12 ）： 1941 - 1950 .

朱元，吴博宇，陆科，等 . 城市复杂环境下的车辆组合定位算法研究［J］. 重庆理工大学学报（自然科学）， 2023 ， 37 （ 1 ）： 9 - 18 .

ZHU Yuan ， WU Boyu ， LU Ke ， et al . Research on the Integrated Vehicle Positioning Algorithm in Complex Urban Environments ［J］. Journal of Chongqing University of Technology（Natural Scien‑ce）， 2023 ， 37 （ 1 ）： 9 - 18 .

纪新春，魏东岩，袁洪，等 . 基于智能手机的车辆多源融合导航方法［J］. 中国惯性技术学报， 2020 ， 28 （ 5 ）： 638 - 644+693 .

JI Xinchun ， WEI Dongyan ， YUAN Hong ， et al . Vehicle Multi-source Fusion Navigation Method Based on Smartphone Platform ［J］. Journal of Chinese Inertial Technology ， 2020 ， 28 （ 5 ）： 638 - 644 .

旷俭，葛雯斐，张全，等 . 基于手机内置传感器的车辆组合定位方法［J］. 中国惯性技术学报， 2020 ， 28 （ 6 ）： 701 - 708 .

KUANG Jian ， GE Wenfei ， ZHANG Quan ， et al . Smartphone Built-in Sensors Based Vehicle Integrated Positioning Method ［J］. Journal of Chinese Inertial Technology ， 2020 ， 28 （ 6 ）： 701 - 708 .

SHIN E ， EI-SHEIMY N . Accuracy Improvement of Low Cost INS/GPS for Land Applications ［D］. Canada ： University of Calgary ， 2001 .

DISSANAYAKE G ， SUKKARIEH S ， NEBOT E ， et al . The Aiding of a Low-Cost Strapdown Inertial Measurement Unit Using Vehicle Model Constraints for Land Vehicle Applications ［J］. IEEE Transactions on Robotics and Automation ， 2002 ， 17 （ 5 ）： 731 - 747 .

邓玥，余江，郭文飞，等 . 信号遮挡环境下融合TOA/AOD的5G/SINS组合导航算法模型与精度分析［J］. 武汉大学学报（信息科学版）， 2022 ， 47 （ 7 ）： 1133 - 1139 .

DENG Yue ， YU Jiang ， GUO Wenfei ， et al . Mode‑ling and Accuracy Analysis of TOA/AOD Based 5G/SINS Integrated Navigation in Case of Signal Blockage ［J］. Geomatics and Information Science of Wuhan University ， 2022 ， 47 （ 7 ）： 1133 - 1139 .

牛小骥，丁龙阳，旷俭，等 . 基于MEMS IMU和运动约束的共享单车定位算法［J］. 中国惯性技术学报， 2021 ， 29 （ 3 ）： 300 - 306 .

NIU Xiaoji ， DING Longyang ， KUANG Jian ， et al . A MEMS IMU and Motion Constraint-Based Positioning Algorithm for Shared Bicycles ［J］. Journal of Chinese Inertial Technology ， 2021 ， 29 （ 3 ）： 300 - 306 .

SYED Z F ， AGGARWAL P ， NIU X J ， et al . Civilian Vehicle Navigation： Required Alignment of the Inertial Sensors for Acceptable Navigation Accuracies ［J］. IEEE Transactions on Vehicular Technology ， 2008 ， 57 （ 6 ）： 3402 - 3412 .

冯木榉，高迪，何文涛 . 面向低成本车载IMU的安装姿态估计［J］. 测绘通报， 2020 （ 6 ）： 67 - 70 .

FENG Muju ， GAO Di ， HE Wentao . A Mounting-Attitude Estimation Algorithm for Low-Cost Vehicle IMU ［J］. Bulletin of Surveying and Mapping ， 2020 （ 6 ）： 67 - 70 .

WAHLSTRÖM J ， SKOG I ， HǍNDEL P . IMU Alignment for Smartphone-Based Automotive Navigation ［C］// The 18th International Conference on Information Fusion （Fusion）， Washington D C， USA ， 2015 .

LU Y S ， XIONG L ， XIA X ， et al . Vehicle Heading Angle and IMU Heading Mounting Angle Improvement Leveraging GNSS Course Angle ［J］. Procee‑dings of the Institution of Mechanical Engineers ， Part D： Journal of Automobile Engineering， 2023 ， 237 （ 9 ）： 2249 - 2261 .

WU Y X ， GOODALL C ， EL-SHEIMY N . Self-calibration for IMU/Odometer Land Navigation： Simulation and Test Results ［C］// The 2010 International Technical Meeting of The Institute of Navigation ， San Diego， CA ， 2010 .

CHEN Q J ， ZHANG Q ， NIU X J . Estimate the Pitch and Heading Mounting Angles of the IMU for Land Vehicular GNSS/INS Integrated System ［J］. IEEE Transactions on Intelligent Transportation Systems ， 2020 ， 22 （ 10 ）： 6503 - 6515 .

邓成剑，陈起金，张提升，等 . 基于航位推算的车载组合导航系统NHC杆臂估计算法［J］. 北京航空航天大学学报， 2025 ， 51 （ 2 ）： 668 - 675 .

DENG Chengjian ， CHEN Qijin ， ZHANG Tisheng ， et al . NHC Lever Arm Estimation Algorithm for Vehicle-Integrated Navigation Systems Based on Dead Reckoning ［J］. Journal of Beijing University of Aeronautics and Astronautics ， 2025 ， 51 （ 2 ）： 668 - 675 .

MU M X ， ZHAO L . A GNSS/INS-Integrated System for an Arbitrarily Mounted Land Vehicle Navigation Device ［J］. GPS Solutions ， 2019 ， 23 （ 4 ）： 112 .

HWANG Y ， JEONG Y ， KWEON I S ， et al . Online Misalignment Estimation of Strapdown Navigation for Land Vehicle Under Dynamic Condition ［J］. International Journal of Automotive Technology ， 2021 ， 22 （ 6 ）： 1723 - 1733 .

张嘉骅，陶贤露，朱锋 . 安卓智能手机GNSS单点测速性能评估［J］. 导航定位学报， 2021 ， 9 （ 3 ）： 26 - 35 .

ZHANG Jiahua ， TAO Xianlu ， ZHU Feng . The Performance Evaluation of GNSS Absolute Velocity Determination for Android Smartphone ［J］. Journal of Navigation and Positioning ， 2021 ， 9 （ 3 ）： 26 - 35 .

王甫红，栾梦杰，程雨欣，等 . 城市环境下智能手机车载GNSS/MEMS IMU紧组合定位算法［J］. 武汉大学学报（信息科学版）， 2023 ， 48 （ 7 ）： 1106 - 1116 .

WANG Fuhong ， LUAN Mengjie ， CHENG Yuxin ， et al . Smartphone GNSS/MEMS IMU Tightly-Coupled Integration Positioning Method for Vehicular Navigation in Urban Conditions ［J］. Geomatics and Information Science of Wuhan University ， 2023 ， 48 （ 7 ）： 1106 - 1116 .

王献忠，张肖 . 基于准北东地系地面静态对准算法［J］. 航天控制， 2022 ， 40 （ 1 ）： 37 - 41 .

WANG Xianzhong ， ZHANG Xiao . Ground Static Alignment Algorithm Based on Quasi-North-East Ground Coordinate System ［J］. Aerospace Control ， 2022 ， 40 （ 1 ）： 37 - 41 .

郭磊，王甫红，桑吉章，等 . 一种新的利用历元间位置变化量约束的 GNSS 导航算法［J］. 武汉大学学报（信息科学版）， 2020 ， 45 （ 1 ）： 21 ‐ 27 .

GUO Lei ， WANG Fuhong ， SANG Jizhang ， et al . A New Inter-Epoch Position Variation Constrained Navigation Algorithm for Stand-Alone GNSS Receiver ［J］. Geomatics and Information Science of Wuhan University ， 2020 ， 45 （ 1 ）： 21 ‐ 27 .

WU Y X ， WU M P ， HU X P ， et al . Self-Calibration for Land Navigation Using Inertial Sensors and Odometer： Observability Analysis ［C］// AIAA Guidance， Navigation， and Control Conference ， Chicago， Illinois ， 2009 .

浏览量

下载量

CSCD

文章被引用时，请邮件提醒。

提交

工具集

关联资源

城市环境下智能手机车载GNSS/MEMS IMU紧组合定位算法

城市场景智能手机GNSS/MEMS融合车载高精度定位

时空智能学：理论与应用

构造大地测量学研究进展与机遇挑战

大众智能终端GNSS有意干扰检测技术研究现状与展望