# Research on Low-Cost Attitude Estimation for MINS/Dual-Antenna GNSS Integrated Navigation Method

^{1}

^{2}

^{*}

## Abstract

**:**

## 1. Introduction

## 2. Reference Frame

## 3. System Model Analysis

#### 3.1. IMU Model

#### 3.1.1. Attitude Update

#### 3.1.2. Velocity Update

#### 3.1.3. Position Update

#### 3.2. Schematic of Inertial Navigation Process

#### 3.3. System Dynamic Model

## 4. Integrated Navigation Method

#### 4.1. Observation

#### 4.2. EKF Process and Work Sequence

#### 4.3. Integrated Navigation Structure

#### 4.4. Simulation Experiment

## 5. Experiment

#### 5.1. Design of the Prototype

#### 5.2. Dynamic Calibration of MEMS Devices

#### 5.3. Static test

#### 5.4. Dynamic Experiment

## 6. Conclusions

## Author Contributions

## Funding

## Conflicts of Interest

## References

- Gikas, V.; Retscher, G.; Kealy, A. Chapter 15—Collaborative Positioning for Urban Intelligent Transportation Systems (ITS) and Personal Mobility (PM): Challenges and Perspectives. In Mobility Patterns, Big Data and Transport Analytics; Antoniou, C., Dimitriou, L., Pereira, F., Eds.; Elsevier: Amsterdam, The Netherlands, 2019; pp. 381–414. [Google Scholar]
- Zhang, S.; Niu, T.; Wu, Y.; Zhang, K.M.; Wallington, T.J.; Xie, Q.; Wu, X.; Xu, H. Fine-grained vehicle emission management using intelligent transportation system data. Environ. Pollut.
**2018**, 241, 1027–1037. [Google Scholar] [CrossRef] - Sasani, S.; Asgari, J.; Amiri-Simkooei, A.R. Improving MEMS-IMU/GPS integrated systems for land vehicle navigation applications. GPS Solut.
**2016**, 20, 89–100. [Google Scholar] [CrossRef] - Li, W.; Cui, X.; Lu, M. A robust graph optimization realization of tightly coupled GNSS/INS integrated navigation system for urban vehicles. Tsinghua Sci. Technol.
**2018**, 23, 724–732. [Google Scholar] [CrossRef] - Li, Z.; Zhang, T.; Qi, F.; Tang, H.; Niu, X. Carrier phase prediction method for GNSS precise positioning in challenging environment. Adv. Space Res.
**2019**, 63, 2164–2174. [Google Scholar] [CrossRef] - Montenbruck, O.; Steigenberger, P.; Hauschild, A. Multi-GNSS signal-in-space range error assessment—Methodology and results. Adv. Space Res.
**2018**, 61, 3020–3038. [Google Scholar] [CrossRef] - Jie, H.; Xianlin, H.; Guofeng, W. Design and application of single-antenna GPS/accelerometers attitude determination system. J. Syst. Eng. Electron.
**2008**, 19, 220–227. [Google Scholar] [CrossRef] - Park, S.; Kee, C. Enhanced method for single-antenna GPS-based attitude determination. Aircr. Eng. Aerosp. Technol.
**2006**, 78, 236–243. [Google Scholar] [CrossRef] - Kee, C.; Jang, J.; Sohn, Y. Efficient Attitude Determination Using GPS Multiple Antennas—Geometrical Concept—. Trans. Jpn. Soc. Aeronaut. Space Sci.
**2005**, 47, 276–280. [Google Scholar] [CrossRef] - Park, B.; Jeon, S.; Kee, C. A closed-form method for the attitude determination using GNSS Doppler measurements. Int. J. Control Autom. Syst.
**2011**, 9, 701–708. [Google Scholar] [CrossRef] - Pan, Z.F.; An, L.; Wen, C.Y. Recent advances in fuel cells based propulsion systems for unmanned aerial vehicles. Appl. Energy
**2019**, 240, 473–485. [Google Scholar] [CrossRef] - Han, H.; Wang, J.; Du, M. GPS/BDS/INS tightly coupled integration accuracy improvement using an improved adaptive interacting multiple model with classified measurement update. Chin. J. Aeronaut.
**2018**, 31, 556–566. [Google Scholar] [CrossRef] - Wang, M.; Wu, W.; Zhou, P.; He, X. State transformation extended Kalman filter for GPS/SINS tightly coupled integration. GPS Solut.
**2018**, 22, 112. [Google Scholar] [CrossRef] - Xu, X.; Tian, X.; Zhou, L.; Li, Y. A decision-tree based multiple-model UKF for attitude estimation using low-cost MEMS MARG sensor arrays. Measurement
**2019**, 135, 355–367. [Google Scholar] [CrossRef] - Gustafsson, F.; Hendeby, G. Some Relations Between Extended and Unscented Kalman Filters. IEEE. Trans. Signal Process.
**2012**, 60, 545–555. [Google Scholar] [CrossRef] - Martino, L.; Read, J.; Elvira, V.; Louzada, F. Cooperative parallel particle filters for online model selection and applications to urban mobility. Digit. Signal Process.
**2017**, 60, 172–185. [Google Scholar] [CrossRef] [Green Version] - Djuric, P.M.; Kotecha, J.H.; Zhang, J.; Huang, Y.; Ghirmai, T.; Bugallo, M.F.; Miguez, J. Particle filtering. IEEE Signal Process. Mag.
**2003**, 20, 19–38. [Google Scholar] [CrossRef] - Martino, L.; Elvira, V.; Camps-Valls, G. Group Importance Sampling for particle filtering and MCMC. Digit. Signal Process.
**2018**, 82, 133–151. [Google Scholar] [CrossRef] [Green Version] - Yang, C.; Fang, H.; Shi, B. Particle filter with Markovian packet dropout and time delay. J. Franklin Inst.
**2019**, 356, 675–696. [Google Scholar] [CrossRef] - Chen, X.; Xu, Y.; Li, Q.; Tang, J.; Shen, C. Improving ultrasonic-based seamless navigation for indoor mobile robots utilizing EKF and LS-SVM. Measurement
**2016**, 92, 243–251. [Google Scholar] [CrossRef] - Saadeddin, K.; Abdel-Hafez, M.F.; Jaradat, M.A.; Jarrah, M.A. Performance enhancement of low-cost, high-accuracy, state estimation for vehicle collision prevention system using ANFIS. Mech. Syst. Signal Process.
**2013**, 41, 239–253. [Google Scholar] [CrossRef] - Qin, H.; Yue, S.; Cong, L.; Jin, T. A state-constrained tracking approach for Kalman filter-based ultra-tightly coupled GPS/INS integration. GPS Solut.
**2019**, 23, 55. [Google Scholar] [CrossRef] - Xie, F.; Sun, R.; Kang, G.; Qian, W.; Zhao, J.; Zhang, L. A jamming tolerant BeiDou combined B1/B2 vector tracking algorithm for ultra-tightly coupled GNSS/INS systems. Aerosp. Sci. Technol.
**2017**, 70, 265–276. [Google Scholar] [CrossRef] - Rafatnia, S.; Nourmohammadi, H.; Keighobadi, J.; Badamchizadeh, M.A. In-move aligned SINS/GNSS system using recurrent wavelet neural network (RWNN)-based integration scheme. Mechatronics
**2018**, 54, 155–165. [Google Scholar] [CrossRef] - Wang, Q.; Li, Y.; Diao, M.; Gao, W.; Qi, Z. Performance enhancement of INS/CNS integration navigation system based on particle swarm optimization back propagation neural network. Ocean Eng.
**2015**, 108, 33–45. [Google Scholar] [CrossRef] - Gandotra, P.; Jha, R.K. A survey on green communication and security challenges in 5G wireless communication networks. J. Network Comput. Appl.
**2017**, 96, 39–61. [Google Scholar] [CrossRef] - Poluzzi, L.; Barbarella, M.; Tavasci, L.; Gandolfi, S.; Cenni, N. Monitoring of the Garisenda Tower through GNSS using advanced approaches toward the frame of reference stations. J. Cult. Heritage
**2019**. [Google Scholar] [CrossRef] - Ko, N.; Youn, W.; Choi, I.; Song, G.; Kim, T. Features of Invariant Extended Kalman Filter Applied to Unmanned Aerial Vehicle Navigation. Sensors
**2018**, 18, 2855. [Google Scholar] [CrossRef] [PubMed]

**Figure 1.**(

**a**) Axes of the Earth-Centered Inertial Frame. This is nominally centered at the Earth’s center of mass and oriented with respect to the Earth’s spin axis and the stars. The rotation shown is that of the Earth with respect to space. The z-axis always points along the Earth’s axis of rotation from the center to the north pole (true, not magnetic); (

**b**) Axes of the Earth-Centered Earth-fixed Frame. The z-axis always points along the Earth’s axis of rotation from the center to the North Pole (true, not magnetic). The x-axis points from the center to the intersection of the equator with the reference meridian (IRM) or conventional zero meridian (CZM), which defines 0° longitude.

**Figure 2.**(

**a**) Axes of the Local Navigation Frame. The z axis, also known as the down (D) axis, is defined as the normal to the surface of the reference ellipsoid, pointing toward the center of the Earth roughly. True gravity deviates from this slightly due to local anomalies. The x-axis, or north (N) axis, is the projection in the plane orthogonal to the z-axis of the line from the user to the north pole. By completing the orthogonal set, the y-axis always points east and is hence known as the east (E) axis; (

**b**) Height and geodetic latitude of a body.

**Figure 3.**Block diagram of local-navigation-frame equation. (+) represents the t and (−) represents the (t − τ

_{0}).

**Figure 5.**(

**a**) The convergence characteristics of the velocity covariance; (

**b**) The convergence characteristics of the attitude angle for the Extended Kalman Filtering (EKF).

**Figure 6.**(

**a**) Covariance of the east, north, and down positions; (

**b**) The characteristic of the up position.

**Figure 7.**(

**a**) The convergence characteristic of the yaw error; (

**b**) The convergence characteristics of the roll angle error.

**Figure 8.**(

**a**) The device appearance of Micro-electromechanical Systems-Inertial Navigation System (MINS); (

**b**) The integrated circuit system.

**Figure 9.**(

**a**) The two-dimensional temperature control turntable; (

**b**) The output of the gyroscope after calibration.

**Figure 10.**(

**a**) The installation instruction of the dual-antenna/MINS; (

**b**) The convergence of the yaw for the static test.

**Figure 11.**(

**a**) The Synchronous Position, Attitude and Navigation (SPAN-CPT) reference system; (

**b**) The driving vehicle.

**Figure 14.**(

**a**) The standard deviation of GNSS heading angle; (

**b**) The yaw angle test of the dual-antenna GNSS is unavailable.

**Figure 16.**(

**a**) The position of the dual-antenna GNSS is blocked; (

**b**)The position of the dual-antenna GNSS/MINS integration.

**Figure 17.**(

**a**) The top view of the driving test trajectory from Google Earth; (

**b**) The magnified map of the test location.

Filter State | The Noise Value | Filter State | The Noise Value | Filter State | The Noise Value |
---|---|---|---|---|---|

${\delta}_{\alpha}$ | $(3\times {10}^{-3}{)}^{2}s$ | ${\delta}_{\beta}$ | $(3\times {10}^{-3}{)}^{2}s$ | ${\delta}_{\lambda}$ | $(3\times {10}^{-3}{)}^{2}s$ |

${\delta}_{VE}$ | $(1\times {10}^{-3}m/s{)}^{2}s$ | ${\delta}_{VN}$ | $(1\times {10}^{-3}m/s{)}^{2}s$ | ${\delta}_{VU}$ | $(1\times {10}^{-3}m/s{)}^{2}s$ |

$\delta L$ | $(6\times {10}^{-9}m{)}^{2}s$ | $\delta \lambda $ | $(6\times {10}^{-9}m{)}^{2}s$ | $\delta h$ | $(6\times {10}^{-9}m{)}^{2}s$ |

$\delta f$ | $(9\times {10}^{-4}{m/s}^{2}{)}^{2}s$ | $\delta {f}_{y}$ | $(9\times {10}^{-4}{m/s}^{2}{)}^{2}s$ | $\delta {f}_{z}$ | $(9\times 1{0}^{-4}m/{s}^{2}{)}^{2}s$ |

${\delta}_{\omega x}$ | $(0.01\xb0/s{)}^{2}s$ | ${\delta}_{\omega y}$ | $(0.01\xb0/s{)}^{2}s$ | ${\delta}_{\omega z}$ | $(0.01\xb0/s{)}^{2}s$ |

Performance Parameter | Axial | Parameter Value (°) |
---|---|---|

Position Error RMSE (m) | North | 0.1542 |

East | 0.1442 | |

Down | 0.2212 | |

Velocity Error RMSE (m) | North | 0.2321 |

East | 0.2451 | |

Down | 0.3264 | |

Attitude Error RMSE (°) | Pitch | 0.3342 |

Yaw | 0.2514 |

© 2019 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).

## Share and Cite

**MDPI and ACS Style**

Wang, H.; Liu, N.; Su, Z.; Li, Q.
Research on Low-Cost Attitude Estimation for MINS/Dual-Antenna GNSS Integrated Navigation Method. *Micromachines* **2019**, *10*, 362.
https://doi.org/10.3390/mi10060362

**AMA Style**

Wang H, Liu N, Su Z, Li Q.
Research on Low-Cost Attitude Estimation for MINS/Dual-Antenna GNSS Integrated Navigation Method. *Micromachines*. 2019; 10(6):362.
https://doi.org/10.3390/mi10060362

**Chicago/Turabian Style**

Wang, Hailu, Ning Liu, Zhong Su, and Qing Li.
2019. "Research on Low-Cost Attitude Estimation for MINS/Dual-Antenna GNSS Integrated Navigation Method" *Micromachines* 10, no. 6: 362.
https://doi.org/10.3390/mi10060362