Design and Simulation of the Integrated Navigation System Based on Extended Kalman Filter
Total Page:16
File Type:pdf, Size:1020Kb
Open Phys. 2017; 15:182–187 Research Article Open Access Weidong Zhou, Jiaxin Hou*, Lu Liu, Tian Sun, and Jing Liu Design and Simulation of the Integrated Navigation System based on Extended Kalman Filter DOI 10.1515/phys-2017-0019 traffic management and other services [1, 2]. The naviga- Received Oct 30, 2016; accepted Nov 14, 2016 tion technology is used to guide an object from one point to another point [3]. Navigation system platforms are able Abstract: The integrated navigation system is used to esti- to measure instantaneous velocity, direction, position and mate the position, velocity, and attitude of a vehicle with posture, and then provides this information to the opera- the output of inertial sensors. This paper concentrates on tor and then provides proper guidance to the carrier [4, 5]. the problem of the INS/GPS integrated navigation system With the rapid progress and development of technol- design and simulation. The structure of the INS/GPS in- ogy, more and more information can be exploited in the tegrated navigation system is made up of four parts: 1) navigation system, and navigation methods have been up- GPS receiver, 2) Inertial Navigation System, 3) Extended dated frequently. Apart from traditional inertial navigation Kalman filter, and 4) Integrated navigation scheme. After- systems, (such as satellite navigation system, doppler nav- wards, we illustrate how to simulate the integrated naviga- igation systems, ground-based radio navigation system, tion system with the extended Kalman filter by measuring and so on) there are many new navigation systems, such as position, velocity and attitude. Particularly, the extended the celestial navigation system, the geomagnetic naviga- Kalman filter can estimate states of the nonlinear system in tion system, the scene matching system, the terrain match- the noisy environment. In extended Kalman filter, the esti- ing system, and the visual navigation system [6]. mation of the state vector and the error covariance matrix As is well known that, the INS/GPS navigation system are computed by steps: 1) time update and 2) measurement has been widely used in integrated navigation system. In- update. Finally, the simulation process is implemented by ertial Navigation System (denoted as INS) refers to a sys- Matlab, and simulation results prove that the error rate of tem which can compute the position, velocity, and attitude statement measuring is lower when applying the extended of a device with the output of inertial sensors [7]. Particu- Kalman filter in the INS/GPS integrated navigation system. larly, the measurements of the inertial sensors include er- Keywords: Integrated Navigation System; Extended rors because of physical limitations. However, errors may Kalman Filter; Inertial Navigation System; Global Posi- be accumulated in the navigation scheme of INS [8]. On tioning System; Nonlinear system the other hand, Global Positioning System (named as GPS) is often utilized as an aiding sensor in INS. Therefore, the PACS: 01.20.+x INS/GPS integrated system has been widely exploited in several navigation fields. Unfortunately, there are many drawbacks in GPS, such as low sampling rate [9, 10]. To 1 Introduction solve this proposed problem, in this paper, we focus on the INS/GPS Integrated Navigation System simulation. Early navigation theory was used to handle ships sailing Innovations of this paper lie in the following aspects: on the ocean, however, navigation technology has pene- 1. The extended Kalman filter is used to estimate states trated into every conceivable a vehicle in recent years, in- of the nonlinear system in the noisy environment. cluding land search, remote tracking, ship management, 2. In the extended Kalman filter, the estimation of the state vector and the error covariance matrix are ob- tained by a time update process and a measurement *Corresponding Author: Jiaxin Hou: College of Automation, Harbin Engineering University, Harbin 150001, China; Email: yuguo- update process. [email protected] In recent years, the rapid development of computer Weidong Zhou, Lu Liu, Tian Sun, Jing Liu: College of Automation, technology has encouraged the development of Kalman Harbin Engineering University, Harbin 150001, China. © 2017 W. Zhou et al., published by De Gruyter Open. This work is licensed under the Creative Commons Attribution-NonCommercial-NoDerivs 3.0 License. Design and Simulation of INS Ë 183 filtering model, and Kalman filtering has been success- that the neural extended Kalman filter is used online to es- fully used in the integrated navigation system. To solve timate an error between the motion model of the mobile the problem in standard Kalman filtering, the extended robot and the real system performance [13]. Kalman filter is introduced in this paper. The rest ofthe Zareian et al. proposed an appropriate approach for paper is organized as follows. Section 2 illustrates related computing road friction coefficient. The proposed algo- works about the extended Kalman filter. In section 3, we rithm utilized measured values from wheel angular veloc- discuss how to design the INS/GPS integrated navigation ity and yaw rate sensors of a vehicle. Particularly, vehi- system. Section 4 proposes the method to simulate the cle lateral and longitudinal velocities along with yaw rate integrated navigation system using the Extended Kalman value are obtained by the extended Kalman filter. After- Filter. In section 5, experimental simulation is given the wards, lateral and longitudinal tidal forces are calculated test the performance of the proposed method. Finally, the with a recursive least square algorithm [14]. whole paper is concluded in Section 6. Liu et al. combined the Minimum Model Error criterion with the Extended Kalman Filter to estimate states of 4WD vehicle states. Moreover, this paper constructed a general 2 Related works 5-input 3-output and 3 states estimation system, which utilized both the arbitrary nonlinear model error and the white Gauss measurement noise [15]. The basic function of navigation is to provide real-time Apart from the above works, the extended Kalman Fil- status information for the carrier. Due to system noises ter has been utilized in other fields, such as hemodynamic and measurement noises, how to extract the real states state estimation [16], Acoustic velocity measurement [17], of the information from the noise navigation environment Proton Exchange Membrane Fuel Cell [18], structural pa- should be solved. Furthermore, the key issue in integrated rameters estimation [19], and Radar Tracking [20]. In this navigation system is the fusion filtering. In order to effec- paper, we try to introduce the extended Kalman Filter to tively model the nonlinear systems, the extended Kalman estimate the states of the INS/GPS integrated navigation filter (EKF) has been proposed and widely used. system. The core idea of the extended Kalman filter is to ap- proximate nonlinear model by iterative filtering with a lin- earized method used in EKF is by using the nonlinear Tay- lor expansion which ignores the rest of the higher order 3 Overview of the INS/GPS terms. The extended Kalman filter has been exploited in integrated navigation system nonlinear filtering application, such as aerospace, naviga- tion, target tracking, and so on. Related works on the ex- Inertial Navigation System (INS) refers to a system which tended Kalman filter are listed as follows. can compute the position, velocity, and attitude using Delgado et al. proposed a model-based method to inertial sensors. The measurements of the inertial sen- detect and isolate non-concurrent multiple leaks in a sors may include errors because of its design limitations, pipeline, and pressure and flow sensors are located at the and the errors are accumulated in the navigation process. pipeline ends. Particularly, the proposed method depends Hence, if the error is not compensated with other types on a nonlinear modelling derived from Water-Hammer of sensors, the information of INS can be used in a short equations, and the Extended Kalman Filters are exploited time. Currently, the Global Positioning System (GPS) can to calculate leak coefficients [11]. provide helpful information for INS. On the other hand, Bukhari et al. proposed a real-time algorithm to fore- GPS also has some disadvantages, such as low sampling cast respiratory motion in 3D space and realizing a gating rate and satellite signal loosing. Structure of the INS/GPS function without pre-specifying a particular phase of the integrated navigation system is shown in Figure 1. patient’s breathing cycle. The proposed method utilize an As is shown in Figure 1, INS system obtains inputs extended Kalman filter independently along each coordi- from the gyros and accelerometers, and a state vector is nate to forecast the respiratory motion and then exploits a defined as follows. Gaussian process regression network to revise the predic- T tion error of the EKF in 3D space [12]. X = [ϕE , ϕN , ϕU , δVE , δVN , δVU , δL, δλ, δh] (1) Miljkovic et al. used the EKF coupled with a feed- where parameters ϕE , ϕN , ϕU represent errors of the plat- forward neural network for the simultaneous localization form misalignment respectively, and δVE , δVN , δVU refer and mapping. The main innovations of this paper lie in to the velocity errors respectively. Furthermore, δL, δλ, δh 184 Ë W. Zhou et al. 4 Integrated navigation system simulation based on the extended Kalman filter In this section, we discuss how to simulate the Integrated Navigation System using the Extended Kalman Filter by measuring position, velocity and attitude. The Kalman fil- ter is used to estimate states of dynamic systems by a Figure 1: Structure of the INS/GPS integrated navigation system stochastic linear state-space model as follows [21–23]. denote position errors of latitude, longitude and altitude X (t) = AX (t) + Bu (t) + W (t) (7) respectively. Based on the definition of state vector, the er- The above equation refers to that the continuous state ror state at time t is represented as follows.