簡易檢索 / 詳目顯示

研究生: 彭錕垚
Peng, Kun-Yao
論文名稱: 利用適應性卡曼濾波器結合非諧和約制發展緊耦合之INS/GNSS整合演算法
The Performance Analysis of an AKF Based Tightly Coupled INS/GNSS Sensor Fusion Scheme with Non-holonomic Constraints
指導教授: 江凱偉
Chiang, Kai-Wei
學位類別: 碩士
Master
系所名稱: 工學院 - 測量及空間資訊學系
Department of Geomatics
論文出版年: 2012
畢業學年度: 100
語文別: 英文
論文頁數: 100
中文關鍵詞: INS/GNSS整合系統緊耦合非諧和約制適應性卡曼濾波器
外文關鍵詞: INS/GNSS integration, Tightly-coupled scheme, Non-holonomic constraints, Adaptive Kalman filter
相關次數: 點閱:143下載:6
分享至:
查詢本校圖書館目錄 查詢臺灣博碩士論文知識加值系統 勘誤回報
  • INS/GNSS整合系統可克服GNSS或INS獨立運行之缺點,進而提升更高精度的定位定向能力。INS使用整合後的加速度及角速度觀測量提供相對位置,GNSS則是提供初始值和位置更新至整合演算法中,降低INS隨時間而累積的誤差,倘若GNSS發生訊號失鎖,INS則可持續提供導航定位解。
    在INS/GNSS整合演算法中,擴展式卡曼濾波器(EKF)最為常見,現今常見的整合架構為鬆耦合;在鬆耦合架構中,GNSS濾波器估算出GNSS位置及速度解,更新至INS濾波器中進行最後估算,產生導航定位解,鬆耦合架構簡單且容易實現,但GNSS濾波器在可視衛星低於4顆的情形下,無法提供的位置及速度解,導致INS獨立運作;相對來說,緊耦合僅使用單一濾波器整合INS和GNSS原始觀測量,故當只要可視衛星大於1顆以上,GNSS可持續提供位置及速度更新至整合演算法中。近期許多研究亦指出緊耦合相較於鬆耦合,可提供較穩定的導航定位解。
    使用EKF緊耦合架構在都市或郊區中衛星訊號遮蔽嚴重之區域雖有幫助,卻無法降低不可靠的衛星訊號影響,而導致導航定位精度受損。適應性卡曼濾波器(AKF)最大概似法給定適當的權重和卡曼增益矩陣,進而調整觀測量協變方矩陣(R),故AKF比起EKF可有效降低不可靠的衛星訊號影響。當進行觀測量更新時,本研究使用狀態更新序列給定權重,而後調整觀測量協變方矩陣。
    在車載導航系統中,車體正常行駛於路面上不易產生上下震動或左右滑動情形,故車體速度僅有行進方向(X軸)之速度,而垂直於行進方向的Y軸和Z軸速度可約制為零,形成非諧和約制。本研究分別實現EKF和AKF緊耦合結合非諧和約制,透過實驗成果顯示,兩種卡曼濾波器結合非諧和約制相較於原始的卡曼濾波器可提升20%~30%的定位精度。特別是在GNSS訊號失鎖時,非諧和約制可以有效約制單獨運作的INS的飄移量。因此,AKF結合非諧和約制發展緊耦合INS/GNSS整合演算法,在GNSS訊號失鎖時,較能提供穩定的導航定位解,適合廣泛應用於都市或郊區中衛星訊號遮蔽嚴重之區域。

    Integrated Inertial Navigation System (INS)/Global Navigation Satellite Systems (GNSS) systems can overcome the shortcoming of GNSS alone or INS alone so that provide superior performance. Due to the integrations any bias is accumulated resulting in divergence of the positions with time. INSs use integrated accelerations and angular rates to develop relative positions, thus their position estimates tend to diverge with time if left uncorrected. GNSS can be used to update the inertial estimates and minimize their drift over time. The inertial measurements can then be relied upon when the GNSS signals are blocked.
    It is common to use an Extended Kalman Filter (EKF) to accomplish the data fusion. Loosely-coupled integration has the benefit of a simpler architecture which is easy to utilize in navigation systems. The position and velocity of the estimated by the GNSS KF is processed in the navigation Kalman filter to aid the INS, which is known as decentralized or cascaded filtering as well. However, the errors in the position and velocity information provided by the GNSS KF are time-correlated, which can cause a degradation in performance or even instability of the navigation Kalman filter, if these correlations are not considered by some means. In the case of incomplete constellations, i.e. less than four satellites in view, the output of the GNSS receiver has to be ignored completely, leaving the INS alone.
    On the other hand, the tightly-coupled integration uses a single Kalman filter to integrate GNSS and INS measurements. In the TC integration, the GPS pseudo-range and delta-range measurements are processed directly in the main Kalman filter. For some authors, the aiding of the GNSS receiver tracking loops using velocity information provided by the INS is an essential characteristic of a tightly-coupled system, too. The primary advantage of this integration is that raw GNSS measurements can still be used to update the INS when less than four satellites are available.
    Therefore, this study implements a tightly-coupled INS/GNSS integration scheme using the Adaptive Kalman Filter (AKF) as the core estimator by tuning the measurement covariance matrix (R) adaptively. The AKF is based on the maximum likelihood criterion for choosing the most appropriate weight and thus the Kalman gain factors. The conventional EKF implementation suffers uncertain results while the update measurement covariance matrix R does not meet the case. The primary advantage of AKF is that the filter has less relationship with the priori statistical information because the R varies with time. The innovation sequence in the study is used to derive the measurement weights through the measurement covariance matrices R, innovation-based adaptive estimation (IAE). The measurement covariance matrices (R) are adapted in the study when measurements update with time.
    The integrated algorithm in this study is applied for land vehicle navigation and there are two non-holonomic constraints (NHC) available. Land vehicles will not jump off the ground or slid on the ground under normal condition. Using these constraints, the velocity of the vehicle in the plane perpendicular to the forward direction (x-axis) is almost zero. EKF and AKF based tightly-coupled scheme with NHC are implemented in the study.
    To validate the performance of the KFs (EKF and AKF) based tightly-coupled INS/GPS integration scheme with NHC, simulation scenarios and field scenarios were conducted in the downtown area of Tainan city. The test platform was mounted on the top of a land vehicle. The results show the 20%~30% improvements in position errors when compared with the results without NHC. Therefore, NHC can be used as a stand-alone positioning tool during GNSS outages of 1 minute. AKF based tightly-coupled INS/GNSS integration scheme can provide more stable solutions combined with NHC during GNSS outages of 1 minute likewise.

    摘 要 I Abstract II 誌 謝 IV Contents V List of Tables VII List of Figures IX Chapter 1. Introduction 1 1.1 Background 1 1.2 Objectives 3 1.3 Thesis Outline 4 Chapter 2 Inertial Navigation System 6 2.1 Inertial Sensor Technologies 6 2.1.1 Optical Gyros 7 2.1.2 MEMS Gyros 8 2.1.3 Accelerometer 10 2.1.4 Market for Inertial Navigation Systems 12 2.2 Coordinate Frames 14 2.2.1 Inertial frame 14 2.2.2 Earth-Centered-Earth-Fixed frame 15 2.2.3 Navigation Frame 16 2.2.4 Body Frame 17 2.2.5 Sensor Frame 18 2.3 Inertial Sensor Simulation 18 2.3.1 Models of Inertial Sensor 18 2.3.2 INS Calibration Methods 19 2.4 INS Static Simulation 22 2.5 Stand-alone INS Evaluation 28 Chapter 3 Inertial Navigation Mechanization 33 3.1 Reference Frame Transformations 33 3.2 INS Mechanization 37 3.2.1 Error Compensation 38 3.2.2 Attitude Integration 38 3.2.3 Velocity and Position Integration 40 3.2.4 Global Navigation Satellite Systems Aided INS 41 Chapter 4 INS/GNSS Integration Methodology 46 4.1 Integration Architecture 46 4.2 Extended Kalman Filter 48 4.2.1 Discrete-Time System 48 4.3 INS Error Model 51 4.3.1 Perturbation Analysis 52 4.3.2 Position Error Dynamics 53 4.3.3 Velocity Error Dynamics 53 4.3.4 Attitude Error Dynamics 57 4.4 Kalman Filtering INS/GNSS Integration 59 4.5 Adaptive Kalman Filtering 62 4.5.1 Multiple Model Adaptive Estimation 63 4.5.2 Innovation-based Adaptive Estimation 65 4.5.3 Maximum Likelihood Estimation Adaptive Kalman Filter 66 4.5.4 Adapting the measurement error covariance matrix 68 4.6 Non-Holonomic Constraints 70 Chapter 5 Results and Analysis 73 5.1 Test Instrument 73 5.2 Static mode simulation 74 5.3 Kinematic scenario 76 5.4 Results 78 5.4.1 EKF with NHC 79 5.4.2 AKF with NHC 84 5.5 Analysis 90 Chapter 6 Conclusions and Recommendations 93 6.1 Summaries and Conclusions 93 6.2 Recommendations 94 Reference 96

    Barbour, N. and Schmidt, G.: “Inertial Sensor Technology Trends”, IEEE Sensors Journal, Vol. 1, No. 4, 2001, pp. 332-339, 2001.
    Barbour, N.M., Hopkins, R., Kourepenis, A. and Ward P.: “Inertial MEMS System Applications”, NATO RTO Lecture Series, RTO-EN-SET-116, Low-Cost Navigation Sensors and Integration Technology, 2010.
    Barbour, N.M.: “Inertial Navigation Sensors”, NATO RTO Lecture Series, RTO-EN-SET-116, Low-Cost Navigation Sensors and Integration Technology, 2010.
    Britting, K.R.: “Inertial Navigation Systems Analysis”, John Wiley & Sons, Inc., 1971.
    Brown, R.G. and Hwang, P.Y.C.: “Introduction to Random Signals and Applied Kalman Filtering”, John Wiley & Sons, Inc., second edition, 1992.
    Chatfield, A.B.: “Fundamentals of High Accuracy Inertial Navigation”, American Institute of Aeronautics and Astronautics, Inc., 1997.
    Chiang, K. W., Noureldin, A. and El-Sheimy, N.: “A New Weight Updating Method for INS/GPS Integration Architectures Based on Neural Networks”, Measurement Science and Technology, 15(10), pp.2053-2061., 2003.
    Chiang, K.W. and Huang, Y.W.: “An Intelligent Navigator for Seamless INS/GPS Integrated Land Vehicle Navigation Applications”, Applied Soft Computing, Vol.8, Issue 1, pp.722-733., 2008.
    Chiang, K.W., Chu, C.H., Huang, Y.W., Rau, J.Y. and Tseng, Y.H.: “The Performance Analysis of a Vehicle Based Mobile Mapping System Using Tightly Coupled INS/GNSS fusion Scheme”, C1053, International Journal of Engineering and Technology Innovation (IJETI, ISSN 2223-5329), 2011.
    Dauwalter, C. and Ha, J.: “Magnetically Suspended MEMS Spinning Wheel Gyro”, IEEE A&E Systems Magazine, Vol.20, No.2, 2005.
    Diggelen, F.: “GNSS Accuracy: Lies, Damm Lies and Statistics”, GPS World, No.1, pp. 26-32., 2007.
    Divakaruni, S. and Sanders, S.: “Fiber Optic Gyros – A Compelling Choice for High Accuracy Applications”, 18th International Conference on Optical Fiber Sensors, Cancun, Mexico, 2006.
    Edu I.R., Obreja R., and Grigorie T.L.: “Current technologies and trends in the development of gyros used in navigation applications – a review”, Proceedings of the 5th International Conference on Communications and Information Technology, Corfu Island, Greece, July 14-17, pp.63-68., 2011.
    ElGizawy, M.L.: “Continuous measurement-while-drilling surveying system utilizing MEMS inertial sensors”, Dissertation, UCGE reports Number 20284, The University of Calgary, Calgary, Alberta, Canada, 2009.
    Enge, P., Walter, T., Pullen, S., Kee, C., Chao, Y. and Tsai, Y.: “Wide area augmentation of the global positioning system”, Proceedings of the IEEE, Vol.84, No.8, pp.1063-1088., 1996.
    Farrell, J. A. and Barth, M.: “The Global Positioning System & Inertial Navigation”, McGraw–Hill, 1998.
    Gary R.A. and Maybeck, P.S.: “An integrated GPS/INS/BARO and RADAR altimeter system for aircraft precision approach landings”, Dept. of Electrical and Computer Eng., Air Force Institute of Technology, Ohio, 1996.
    Gelb, A., Kasper Jr., J. F., Nash Jr., R. A., Price, C. F., and Sutherland Jr., A.A.: “Applied Optimal Estimation”, The M. I. T. Press, 1974.
    Godha, S.: “Performance Evaluation of Low Cost MEMS-Based IMU Integrated With GPS for Land Vehicle Navigation Application”, MSc Thesis, Dep. of Geomatics Eng., The University of Calgary, Calgary, Alberta, Canada, 2006.
    Godha, S.: “Performance Evaluation of Low Cost MEMS-Based IMU Integrated With GPS for Land Vehicle Navigation Application”, MSc Thesis, Dept. of Geomatics Eng., The University of Calgary, Calgary, Alberta, Canada, 2006.
    Godha, S.: “Performance Evaluation of Low Cost MEMS-Based IMU Integrated with GPS for Land Vehicle Navigation Application”, MSc thesis, UCGE Reports Number 20239, The University of Calgary, Calgary, Alberta, Canada, 2006.
    Gordon, N.J., Salmond, D.J. and Smith, A.F.M.: “Novel approach to nonlinear/non-Gaussian Bayesian state estimation”, Radar and Signal Processing, IEE Proceedings F, Vol.140, issue 2, pp.107-113, 1993.
    Hayal, A.G.: “Static Calibration of the Tactical Grade Inertial Measurement Units”, M.Sc. Thesis, the Ohio State University, Columbus, Ohio, USA, 2010.
    Jekeli, C.: “Inertial Navigation Systems with Geodetic Applications”, Walter de Gruyter, Inc., Berlin, 2000.
    Kailath, T.: “Lectures on Wiener and Kalman filtering”, CISM courses and lectures No.140, Springer, Berlin Heidelberg New York, 1981.
    Kim, J. and Sukkarieh, S.: “Flight Test Results of a GPS/INS Navigation Loop for an Autonomous Unmanned Aerial Vehicle (UAV)”, Proceedings of the 15th International Technical Meeting of the Satellite Division of the Institute of Navigation, September, OR, USA, pp.510-517, 2002.
    Magill, D.T.: “Optimal adaptive estimation of sampled stochastic processes”, IEEE Trans Automat Contr. AC-10(4), pp.434-439., 1965.
    Marias, J., Berbineau, M. and Heddebaut, M.: “Land mobile GNSS availability and multipath evaluation tool”, IEEE Trans. on Veh. Techn., Vol.54, No.5, pp.1697-1704, 2005.
    Maybeck, P.S.: “Stochastic models, estimation, and control”, Vol.I and II, Academic Press, New York, 1982.
    Mehra, R.K.: “On the identification of variance and adaptive Kalman filtering”, IEEE Trans Automat Contr. 4C-15(2), pp.175-184., 1970.
    Mehra, R.K.: “On-line identification of linear dynamic systems with applications to Kalman filtering”, IEEE Trans Automat Contr. AC-16(1), 1971.
    Mohamed A.H.: “Optimizing the Estimation Procedure in INS/GPS Integration for Kinematic Applications”, Dissertation, Dept. of Geomatics Eng., The University of Calgary, Calgary, Alberta, Canada, 1999.
    Nassar, S., Syed, Z., Niu, X. and El-Sheimy, N.: “Improving MEMS IMU/GPS Systems for Accurate Land-Based Navigation Applications”, The Institute of Navigation National Technical Meeting (ION NTM 2006), Monterey, California, USA, pp. 523-529, 2006.
    Nassar, S., Syed, Z., Niu, X. and El-Sheimy, N.: “Improving MEMS IMU/GPS Systems for Accurate Land-Based Navigation Applications”, The Institute of Navigation National Technical Meeting (ION NTM 2006), Monterey, California, USA, pp.523-529, 2006.
    Nassar, S.: “Improving the Inertial Navigation System (INS) Error Model for INS and INS/DGPS Applications”, PhD thesis, UCGE Reports Number 20183, The University of Calgary, Calgary, Alberta, Canada, 2003.
    Noureldin, A.: “New Measurement-While-Drilling Surveying Technique Utilizing Sets of Fiber Optic Rotation Sensors”, Dissertation, Dept. Elect. Eng., The University of Calgary, Calgary, Alberta, Canada, 2002.
    Osiander, R. and Garrison, M.A.: “Overview of Micro-electro-mechanical Systems and Microstructures in Aerospace Applications”, Taylor and Francis, 2006.
    Petovello, M.G.: “Real-Time Integration of Tactical Grade IMU and GPS for High-Accuracy Positioning and Navigation”, PhD Thesis, UCGE Report 20116, Dept. of Geomatics Eng., The University of Calgary, Calgary, Alberta, Canada, 2003.
    Rogers, R.M.: “Applied Mathematics in Integrated Navigation Systems”, American Institute of Aeronautics and Astonautics, Inc., 2000.
    Salychev, O.S.: “Special studies in dynamic estimation procedures with case studies in inertial surveying”, ENGO 699.26 lecture notes, Dept. of Geomatics Eng., The University of Calgary, Calgary, Alberta, Canada, 1994.
    Sanders, S., Strandjord, L., and Mead, D.: “Fiber-Optic Gyro Technology Trends - A Honeywell Perspective”, 15th Optical Fiber Sensors Conference Technical Digest, pp.5-8, Vol.1, 2002.
    Scherzinger, B.M.: “Precise robust positioning with Inertial/GPS RTK”, Proc. 13th Technical Meeting of the Satellite Division of the Institute of Navigation (Salt Lake City, UT), 2000.
    Schmidt, G.: “INS/GPS Technology Trends”, NATO RTO Lecture Series, RTO-EN-SET-116, Low-Cost Navigation Sensors and Integration Technology, 2008.
    Schwarz, K.P. and Wei, M.: “INS/GPS Integration for Geodetic Applications: Lecture Notes ENGO 623”, Dept. of Geomatics Eng., The University of Calgary, Calgary, Alberta, Canada, 2000.
    Schwarz, K.P.: “Fundamentals of Geodesy: Lecture Notes ENGO 421”, Dept. of Geomatics Eng., The University of Calgary, Calgary, Alberta, Canada, 1999.
    Shin, E.H.: “Estimation Techniques for Low-Cost Inertial Navigation”, PhD Thesis, Dept. of Geomatics Eng., The University of Calgary, Calgary, Alberta, Canada, 2005.
    Shin, E.H.: “Estimation Techniques for Low-Cost Inertial Navigation”, PhD Thesis, Dept. of Geomatics Eng., The University of Calgary, Calgary, Alberta, Canada, 2005.
    Shwarz, K. P. and Mohamed, A. H.: “Adaptive Kalman Filtering for INS/GPS”, Journal of Geodesy, pp.193-203., 1999.
    Sukkarieh, S.: “Low Cost, High Integrity, Aided Inertial Navigation Systems for Autonomous Land Vehicles”, PhD Thesis, Dept. of Mechanical and Mechatronic Eng., University of Sydney, Sydney, Australia, 2000.
    Syed, Z. F.: “Design and Implementation Issues of a Portable Navigation System”, Dissertation, UCGE reports Number 20288, The University of Calgary, Calgary, Alberta, Canada, 2009.
    Syed, Z.F., Aggarwal, P., Goodall, C., Niu, X. and El-Sheimy, N.: “A New Multi-Position Calibration Method for MEMS Inertial Navigation Systems”, Measurement Science and Technology, 18, pp.1897-1907, 2007.
    Titterton, D.H. and Weston, J.L.: “Strap-down Inertial Navigation Technology”, 2nd revised edition, American Institute of Aeronautics and Astronautics, Inc., 2004.
    Wang, J., Xu, C. and Wang, J.A.: “Applications of Robust Kalman Filtering Schemes in GNSS Navigation”, Int. Symp. On GPS/GNSS, Yokohama, Japan, pp.308-316., 2008.
    Wendel, J. And Trommer, G.F.: “Tightly coupled GPS/INS integration for missile applications”, Aerospace Science and Technology 8, pp.627-634., 2004
    Wendel, J., and Trommer, G.F.: “Tightly coupled GPS/INS integration for missile applications”, Aerospace Science and Technology 8, pp.627-634., 2004.
    White N.A., Maybeck, P.S., and DeVilbiss, S.L.: “MMAE detection of interference/jamming and spoofing in a DGPS-aided inertial system”, Dept. Electrical and Computer Eng., Air Force Institute of Technology, Ohio, 1996.
    Yang, Y.,: “Tightly Coupled MEMS INS/GPS Integration with INS Aided Receiver Tracking Loops”, Dissertation, Dept. of Geomatics Eng., The University of Calgary, Calgary, Alberta, Canada, 2008.
    Yao, G.Y.: “The Development of a Tightly-coupled INS/GPS Sensors Fusion Scheme Using Adaptive Kalman Filter”, thesis, Dept. of Geomatics, National Cheng Kung University, Taiwan, 2010.

    下載圖示 校內:2017-02-15公開
    校外:2017-02-15公開
    QR CODE