Direct Kalman Filtering of GPS/INS for Aerospace Applications

Total Page:16

File Type:pdf, Size:1020Kb

Direct Kalman Filtering of GPS/INS for Aerospace Applications Direct Kalman Filtering of GPS/INS for Aerospace Applications J. Wendel, C. Schlaile, Gert F. Trommer University of Karlsruhe, Germany [email protected] BIOGRAPHY This contribution investigates the influence of these two different approaches of Kalman filtering on the overall Jan Wendel received the Dipl.-Ing. (M.S.E.E.) from the system performance of a loosely coupled GPS/INS sys- Technical University of Karlsruhe in 1998. He is cur- tem for aerospace applications. Both filter formulations rently a Ph.D. candidate at the University of Karlsruhe, were implemented and compared via Monte Carlo sim- where his research interests are focused on data fusion ulation runs with focus on the accuracy of the estimated algorithms in integrated navigation systems. inertial sensor biases and on GPS drop out situations. Christian Schlaile received the Dipl.-Ing. (M.S.E.E.) We found a comparable performance of both navigation from the Technical University of Karlsruhe in 2000. algorithms concerning attitude and position errors as He is currently a Ph.D. candidate at the University of well as inertial sensor bias estimation as long as GPS Karlsruhe, where his research interests are focused on aiding was available. However, the simulation results data fusion algorithms in automotive driver assistant indicate a superior performance of the direct Kalman systems. filter formulation in GPS drop out situations, which can by explained by the way the inertial measurements are Gert F. Trommer received the Dipl.-Ing. (M.S.E.E.) and processed. the Dr.-Ing. (Ph.D.) degrees from the TU Munich, Ger- many in 1978 and 1982, respectively. He joined EADS/LFK, formerly DaimlerChrysler Aerospace, where he was project manager for the IMU 1 INTRODUCTION development in the UK ASRAAM program. He held the directorate of ’Flight Control Systems’ with An integrated navigation system exploits the complemen- the responsibility for the Navigation, Guidance and Con- tary characteristics of different navigation sensors to in- trol Subsystem, the IR Seeker and the Fin Actuators in the crease the precision of the navigation solution. In addi- German/Swedish Taurus KEPD 350 program. tion, the resulting redundancy allows the detection of bad Since 1999 he is professor and director of the ’Institute sensor data, which then can be rejected. Such an integrity of Systems Optimization’ at the University of Karlsruhe monitoring increases the reliability of the navigation so- with research focus on automotive driver assistant lution significantly. The navigation technique common systems and INS/GPS/TRN-aided integrated navigation to almost all integrated navigation systems is the iner- systems. tial navigation. In a strapdown inertial navigation sys- tem (INS), an inertial measurement unit (IMU) mounted to the vehicle senses accelerations and angular rates for all six degrees of freedom of the vehicle. From these data, a strapdown algorithm (SDA) can compute a navigation so- ABSTRACT lution presumed that initial position, velocity and attitude are known. This type of navigation is autonomous, there- In integrated navigation systems Kalman filters are fore intentional or unintentional external jamming is im- widely used to increase the accuracy and reliability of the possible. Unfortunately, only short-term accuracy of the navigation solution. navigation solution is assured as the measurement errors of the inertial sensors sum up. Therefore, further navi- Usually, an indirect Kalman filter formulation is applied gation sensors such as global positioning system (GPS), to estimate the errors of an INS strapdown algorithm terrain reference navigation (TRN) by baro-altimeter and (SDA), which are used to correct the SDA. In contrast radar-altimeter, and image based navigation (IBN) by IR to that, in the direct Kalman filter formulation total seekers are used to aid the INS and to assure the long- quantities like position, velocity and attitude are among term accuracy of the navigation solution. The data fusion the state variables of the filter, which allows them to be of these different sensors is commonly accomplished by estimated directly. a Kalman filter [1],[2]. The performance of the Kalman filter is crucial to overall system performance, especially when low-cost sensors are integrated. This paper focusses equations[6]: on filtering GPS and IMU data. In the classical way of aiding the INS, which is consid- ered here for reference purposes, an indirect Kalman fil- ter formulation is chosen. The Kalman filter estimates the @~q 1 b b n n = ~q 0; ~!ib Cn [~!ie + ~!en] (1) errors of the SDA state vector, which can be corrected @t 2 ∗ − n subsequently. The development of this design took place @~ve n ~ b n n n n = Cb fib (2~!ie + ~!en) ~ve + ~gl (2) when due to limited computational ressources, the com- @t − × @L vn putational efficiency of the algorithm was of superior im- = e;north (3) portance [3]. In a direct Kalman filter formulation, total @t Rn + h quantities like position and velocity are estimated. As it @λ vn = e;east (4) is considered to be computationally more demanding, this @t (Re + h) cos(L) design was commonly used only for alignment and cali- @h n bration tasks and applications in which only slow dynam- = ve;down (5) @t − ics were involved [4]. However, as CPU clock speeds are increasing, the computational cost of the algorithms used in an integrated navigation system is becoming less im- portant. Herein denotes This paper describes in detail both approaches to design Kalman filters for the data fusion task in integrated navi- ~q attitude quaternion gation systems. In the next section, the navigation equa- quaternion multiplication ∗ n tions are introduced. In Section three, indirect and direct Cb Direction cosine matrix that transforms a Kalman filter formulations are described. In Section four, vector from its b-frame component form an alternative direct formulation with a computational ef- to its n-frame component form, computed ficiency comparable to the indirect formulation is derived. from ~q. ~ b In Section five, simulation results are given. Finally, con- fib specific force acceleration b clusions are drawn. ~!ib angular rate of the b-frame with respect to a nonrotating inertial frame (i-frame), given in b-frame component form n ~!ie angular rate of a coordinate frame with one 2 THE NAVIGATION EQUATIONS axis parallel to the Earth’s polar axis and the other axes fixed to the Earth (e-frame) The navigation equations are important for both the SDA with respect to the i-frame, given in n- and the Kalman filter. In the SDA, these differential equa- frame component form n tions are integrated to keep track of position, velocity and ~!en angular rate of the n-frame with respect to attitude of the vehicle. For the indirect Kalman filter for- the e-frame, given in n-frame component mulation, the navigation equations are used to derive the form n error propagation equations by means of a Taylor series ~ve velocity in north, east, and down direction expansion which is truncated after the linear part. The with respect to the Earth, given in n-frame error propagation equations represent the system model component form according to which the indirect Kalman filter is designed. L; λ, h lattitude, longitude, height For the direct Kalman filter, the navigation equations rep- Rn;Re Earth’s meridian, and transverse radius of resent the nonlinear system the filter has to observe. The curvature. n investigations presented in this paper were carried out us- ~gl local gravity vector in n-frame component ing the navigation equations in a navigation frame (n- form frame) mechanisation. The axes of the n-frame are given by the directions north, east and down. The down axis is The IMU and the SDA which integrates (1)-(5) using the parallel to the local gravity vector, which is the sum of the currently available angular rate and specific force mea- gravitational acceleration and the centripetal acceleration surements form the INS. Without any further aiding, the caused by the rotation of the earth. The n-frame as well error in the computed position provided by the INS grows as the body-fixed coordinate frame (b-frame) have their with second or even third order of time, respectively. In origins at the location of the navigation system. The axes this contribution only loosly coupled systems are consid- of the b-frame are aligned with the roll, pitch and yaw ered: it is assumed that the long-term accuracy of the axes of the vehicle. In the SDA, the attitude information navigation solution is assured by aiding the INS with the was represented using a quaternion [5] in order to avoid position information provided by a GPS receiver. The singularities that can occur when Euler angles are used. data fusion of INS and GPS can be accomplished using The continuous form strapdown inertial navigation equa- different Kalman filter formulations, which are described tions are given by following set of nonlinear differential in the next section. 3 INDIRECT AND DIRECT KALMAN FILTER A11 I 0 0 0 0 n 1 FORMULATION A21 A22 A23 Cb 0 n A = B A31 A32 A33 0 C C (13) B b C 3.1 Indirect Formulation B 0 0 0 0 0 C B C @ 0 0 0 0 0 A For the indirect Kalman filter formulation in which the errors of the SDA are estimated, the error propagation Herein I denotes the 3 3 unity matrix and 0 denotes equations are needed. The equations for the position and a 3 3 matrix containing× only zeros. Finally, the mea- velocity errors follow from (2)-(5). These nonlinear equa- surement× model which is needed to process the position tions can be written in the following form: information provided by a GPS receiver is given by @~x = f~(~x) (6) @t ∆~zk = H∆~xk + ~νk (14) Expanding Eq.
Recommended publications
  • A Neural Implementation of the Kalman Filter
    A Neural Implementation of the Kalman Filter Robert C. Wilson Leif H. Finkel Department of Psychology Department of Bioengineering Princeton University University of Pennsylvania Princeton, NJ 08540 Philadelphia, PA 19103 [email protected] Abstract Recent experimental evidence suggests that the brain is capable of approximating Bayesian inference in the face of noisy input stimuli. Despite this progress, the neural underpinnings of this computation are still poorly understood. In this pa- per we focus on the Bayesian filtering of stochastic time series and introduce a novel neural network, derived from a line attractor architecture, whose dynamics map directly onto those of the Kalman filter in the limit of small prediction error. When the prediction error is large we show that the network responds robustly to changepoints in a way that is qualitatively compatible with the optimal Bayesian model. The model suggests ways in which probability distributions are encoded in the brain and makes a number of testable experimental predictions. 1 Introduction There is a growing body of experimental evidence consistent with the idea that animals are some- how able to represent, manipulate and, ultimately, make decisions based on, probability distribu- tions. While still unproven, this idea has obvious appeal to theorists as a principled way in which to understand neural computation. A key question is how such Bayesian computations could be per- formed by neural networks. Several authors have proposed models addressing aspects of this issue [15, 10, 9, 19, 2, 3, 16, 4, 11, 18, 17, 7, 6, 8], but as yet, there is no conclusive experimental evidence in favour of any one and the question remains open.
    [Show full text]
  • Kalman and Particle Filtering
    Abstract: The Kalman and Particle filters are algorithms that recursively update an estimate of the state and find the innovations driving a stochastic process given a sequence of observations. The Kalman filter accomplishes this goal by linear projections, while the Particle filter does so by a sequential Monte Carlo method. With the state estimates, we can forecast and smooth the stochastic process. With the innovations, we can estimate the parameters of the model. The article discusses how to set a dynamic model in a state-space form, derives the Kalman and Particle filters, and explains how to use them for estimation. Kalman and Particle Filtering The Kalman and Particle filters are algorithms that recursively update an estimate of the state and find the innovations driving a stochastic process given a sequence of observations. The Kalman filter accomplishes this goal by linear projections, while the Particle filter does so by a sequential Monte Carlo method. Since both filters start with a state-space representation of the stochastic processes of interest, section 1 presents the state-space form of a dynamic model. Then, section 2 intro- duces the Kalman filter and section 3 develops the Particle filter. For extended expositions of this material, see Doucet, de Freitas, and Gordon (2001), Durbin and Koopman (2001), and Ljungqvist and Sargent (2004). 1. The state-space representation of a dynamic model A large class of dynamic models can be represented by a state-space form: Xt+1 = ϕ (Xt,Wt+1; γ) (1) Yt = g (Xt,Vt; γ) . (2) This representation handles a stochastic process by finding three objects: a vector that l describes the position of the system (a state, Xt X R ) and two functions, one mapping ∈ ⊂ 1 the state today into the state tomorrow (the transition equation, (1)) and one mapping the state into observables, Yt (the measurement equation, (2)).
    [Show full text]
  • D5.2: Process Map for Autonomous Navigation
    Grant Agreement number: 314286 Project acronym: MUNIN Project title: Maritime Unmanned Navigation through Intelligence in Networks Funding Scheme: SST.2012.5.2‐5: E‐guided vessels: the 'autonomous' ship D5.2: Process map for autonomous navigation Due date of deliverable: 2013‐07‐31 Actual submission date: Start date of project: 2012‐09‐01 Project Duration: 36 months Lead partner for deliverable: Fraunhofer CML Distribution date: 2013‐09‐27 Document revision: 1.0 Project co‐funded by the European Commission within the Seventh Framework Programme (2007‐2013) Dissemination Level PU Public Public PP Restricted to other programme participants (including the Commission Services) RE Restricted to a group specified by the consortium (including the Commission Services) CO Confidential, only for members of the consortium (including the Commission Services) MUNIN – FP7 GA‐No 314286 D5.2 ‐ Print date: 14/01/07 Document summary information Deliverable D5.2: Process map for autonomous navigation Classification PU (public) Initials Author Organization Role WB Wilko Bruhn CML Editor HCB Hans‐Christoph Burmeister CML Editor LW Laura Walther CML Contributor JM Jonas Moræus APT Contributor ML Matt Long APT Contributor MS Michèle Schaub HSW Contributor EF Enrico Fentzahn MsoftContributor Rev. Who Date Comment 0.1 WB 2013‐08‐01 First draft 0.2 ØJR 2013‐08‐12 Partner review 0.3 AV 2013‐08‐13 Partner review 0.4 BS 2013‐08‐13 Partner review 0.5 WB 2013‐08‐30 Second draft after comments 1.0 HCB 2013‐08‐27 Formating Internal review needed: [ X ] yes [ ] no Initials Reviewer Approved Not approved FS Fariborz Safari X AV Ari Vésteinsson X Disclaimer The content of the publication herein is the sole responsibility of the publishers and it does not necessarily represent the views expressed by the European Commission or its services.
    [Show full text]
  • Global Maritime Distress and Safety System (GMDSS) Handbook 2018 I CONTENTS
    FOREWORD This handbook has been produced by the Australian Maritime Safety Authority (AMSA), and is intended for use on ships that are: • compulsorily equipped with GMDSS radiocommunication installations in accordance with the requirements of the International Convention for the Safety of Life at Sea Convention 1974 (SOLAS) and Commonwealth or State government marine legislation • voluntarily equipped with GMDSS radiocommunication installations. It is the recommended textbook for candidates wishing to qualify for the Australian GMDSS General Operator’s Certificate of Proficiency. This handbook replaces the tenth edition of the GMDSS Handbook published in September 2013, and has been amended to reflect: • changes to regulations adopted by the International Telecommunication Union (ITU) World Radiocommunications Conference (2015) • changes to Inmarsat services • an updated AMSA distress beacon registration form • changes to various ITU Recommendations • changes to the publications published by the ITU • developments in Man Overboard (MOB) devices • clarification of GMDSS radio log procedures • general editorial updating and improvements. Procedures outlined in the handbook are based on the ITU Radio Regulations, on radio procedures used by Australian Maritime Communications Stations and Satellite Earth Stations in the Inmarsat network. Careful observance of the procedures covered by this handbook is essential for the efficient exchange of communications in the marine radiocommunication service, particularly where safety of life at sea is concerned. Special attention should be given to those sections dealing with distress, urgency, and safety. Operators of radiocommunications equipment on vessels not equipped with GMDSS installations should refer to the Marine Radio Operators Handbook published by the Australian Maritime College, Launceston, Tasmania, Australia. No provision of this handbook or the ITU Radio Regulations prevents the use, by a ship in distress, of any means at its disposal to attract attention, make known its position and obtain help.
    [Show full text]
  • Lecture 8 the Kalman Filter
    EE363 Winter 2008-09 Lecture 8 The Kalman filter • Linear system driven by stochastic process • Statistical steady-state • Linear Gauss-Markov model • Kalman filter • Steady-state Kalman filter 8–1 Linear system driven by stochastic process we consider linear dynamical system xt+1 = Axt + But, with x0 and u0, u1,... random variables we’ll use notation T x¯t = E xt, Σx(t)= E(xt − x¯t)(xt − x¯t) and similarly for u¯t, Σu(t) taking expectation of xt+1 = Axt + But we have x¯t+1 = Ax¯t + Bu¯t i.e., the means propagate by the same linear dynamical system The Kalman filter 8–2 now let’s consider the covariance xt+1 − x¯t+1 = A(xt − x¯t)+ B(ut − u¯t) and so T Σx(t +1) = E (A(xt − x¯t)+ B(ut − u¯t))(A(xt − x¯t)+ B(ut − u¯t)) T T T T = AΣx(t)A + BΣu(t)B + AΣxu(t)B + BΣux(t)A where T T Σxu(t) = Σux(t) = E(xt − x¯t)(ut − u¯t) thus, the covariance Σx(t) satisfies another, Lyapunov-like linear dynamical system, driven by Σxu and Σu The Kalman filter 8–3 consider special case Σxu(t)=0, i.e., x and u are uncorrelated, so we have Lyapunov iteration T T Σx(t +1) = AΣx(t)A + BΣu(t)B , which is stable if and only if A is stable if A is stable and Σu(t) is constant, Σx(t) converges to Σx, called the steady-state covariance, which satisfies Lyapunov equation T T Σx = AΣxA + BΣuB thus, we can calculate the steady-state covariance of x exactly, by solving a Lyapunov equation (useful for starting simulations in statistical steady-state) The Kalman filter 8–4 Example we consider xt+1 = Axt + wt, with 0.6 −0.8 A = , 0.7 0.6 where wt are IID N (0, I) eigenvalues of A are
    [Show full text]
  • Global Navigation Satellite Systems and Their Applications Dr
    ISSN (Print): 2279-0063 International Association of Scientific Innovation and Research (IASIR) (An Association Unifying the Sciences, Engineering, and Applied Research) ISSN (Online): 2279-0071 International Journal of Software and Web Sciences (IJSWS) www.iasir.net Global Navigation Satellite Systems and Their Applications Dr. G. Manoj Someswar1, T. P. Surya Chandra Rao2, Dhanunjaya Rao. Chigurukota3 1Principal and Professor, Department of CSE, AUCET, Vikarabad, A.P. 2Associate Professor in Department of CSE 3Associate Professor in Nasimhareddy Engineering Collge ABSTRACT: Global Navigation Satellite System (GNSS) plays a significant role in high precision navigation, positioning, timing, and scientific questions related to precise positioning. Ofcourse in the widest sense, this is a highly precise, continuous, all-weather and a real-time technique. This Research Article is devoted to presenting recent results and developments in GNSS theory, system, signal, receiver, method and errors sources such as multipath effects and atmospheric delays. To make it more elaborative, this varied GNSS applications are demonstrated and evaluated in hybrid positioning, multi- sensor integration, height system, Network Real Time Kinematic (NRTK), wheeled robots, status and engineering surveying. This research paper provides a good reference for GNSS designers, engineers, and scientists as well as the user market. I. USE AND APPLICATIONS OF GLOBAL NAVIGATION SATELLITE SYSTEMS In the year 2001, pursuant to the Third United Nations Conference on the Exploration and Peaceful Uses of Outer Space (UNISPACE-III), the United Nations Committee on the Peaceful Uses of Outer Space (COPUOS) established the Action Team on Global Navigation Satellite Systems (GNSS) under the leadership of the United States and Italy and with the voluntary participation of 38 Member States and 15 organizations.
    [Show full text]
  • EMERGENCY NAVIGATION SYSTEM Swati R
    G.J. E.D.T., Vol. 2(4): 23-28 (July-August, 2013) ISSN: 2319 – 7293 EMERGENCY NAVIGATION SYSTEM Swati R. Dhabarde Department of Information Technology Priyadarshini Indira Gandhi College of Engineering , Nagpur, India 1 Abstract In my project I am developing a computer program that will simulate and explain the need of technology and advance system for any person moving or navigating in a car (or any vehicle). Every person in day to day life requires some navigation for the proper working of his work .it is the human nature that ever man takes some guidance about some or another work without guidance the job taken by a human being will be completed properly or not is not known. So, for a proper working of your decided schedule you should know everything about the place where you live. You do know and if you ought to know then you can use “Emergency Navigation System”. ‘Emergency Navigation System’ is specialized software which is able to track the current position (of any person driving vehicles) and tell the path and other detailed information about your destination. If there are occurrences of multiple paths to the same destination then it can show the shortest one among them. 1.1 Keywords SAPI,GPS,GSM,SMS SDK,NAVIGATION 2. Introduction The project is an application to facilitate the car drivers with some artificial intelligence and other helping features/guidance. This will be used or implemented in the near future by various car companies. So our project is mainly a navigation system for car drivers along with a map of the city with some intelligent helping and guidance features i.e.
    [Show full text]
  • Kalman-Filter Control Schemes for Fringe Tracking
    A&A 541, A81 (2012) Astronomy DOI: 10.1051/0004-6361/201218932 & c ESO 2012 Astrophysics Kalman-filter control schemes for fringe tracking Development and application to VLTI/GRAVITY J. Menu1,2,3,, G. Perrin1,3, E. Choquet1,3, and S. Lacour1,3 1 LESIA, Observatoire de Paris, CNRS, UPMC, Université Paris Diderot, Paris Sciences et Lettres, 5 place Jules Janssen, 92195 Meudon, France 2 Instituut voor Sterrenkunde, KU Leuven, Celestijnenlaan 200D, 3001 Leuven, Belgium e-mail: [email protected] 3 Groupement d’Intérêt Scientifique PHASE (Partenariat Haute résolution Angulaire Sol Espace) between ONERA, Observatoire de Paris, CNRS and Université Paris Diderot, France Received 31 January 2012 / Accepted 28 February 2012 ABSTRACT Context. The implementation of fringe tracking for optical interferometers is inevitable when optimal exploitation of the instrumental capacities is desired. Fringe tracking allows continuous fringe observation, considerably increasing the sensitivity of the interfero- metric system. In addition to the correction of atmospheric path-length differences, a decent control algorithm should correct for disturbances introduced by instrumental vibrations, and deal with other errors propagating in the optical trains. Aims. In an effort to improve upon existing fringe-tracking control, especially with respect to vibrations, we attempt to construct con- trol schemes based on Kalman filters. Kalman filtering is an optimal data processing algorithm for tracking and correcting a system on which observations are performed. As a direct application, control schemes are designed for GRAVITY, a future four-telescope near-infrared beam combiner for the Very Large Telescope Interferometer (VLTI). Methods. We base our study on recent work in adaptive-optics control.
    [Show full text]
  • The Global Positioning System
    The Global Positioning System Assessing National Policies Scott Pace • Gerald Frost • Irving Lachow David Frelinger • Donna Fossum Donald K. Wassem • Monica Pinto Prepared for the Executive Office of the President Office of Science and Technology Policy CRITICAL TECHNOLOGIES INSTITUTE R The research described in this report was supported by RAND’s Critical Technologies Institute. Library of Congress Cataloging in Publication Data The global positioning system : assessing national policies / Scott Pace ... [et al.]. p cm. “MR-614-OSTP.” “Critical Technologies Institute.” “Prepared for the Office of Science and Technology Policy.” Includes bibliographical references. ISBN 0-8330-2349-7 (alk. paper) 1. Global Positioning System. I. Pace, Scott. II. United States. Office of Science and Technology Policy. III. Critical Technologies Institute (RAND Corporation). IV. RAND (Firm) G109.5.G57 1995 623.89´3—dc20 95-51394 CIP © Copyright 1995 RAND All rights reserved. No part of this book may be reproduced in any form by any electronic or mechanical means (including photocopying, recording, or information storage and retrieval) without permission in writing from RAND. RAND is a nonprofit institution that helps improve public policy through research and analysis. RAND’s publications do not necessarily reflect the opinions or policies of its research sponsors. Cover Design: Peter Soriano Published 1995 by RAND 1700 Main Street, P.O. Box 2138, Santa Monica, CA 90407-2138 RAND URL: http://www.rand.org/ To order RAND documents or to obtain additional information, contact Distribution Services: Telephone: (310) 451-7002; Fax: (310) 451-6915; Internet: [email protected] PREFACE The Global Positioning System (GPS) is a constellation of orbiting satellites op- erated by the U.S.
    [Show full text]
  • The Unscented Kalman Filter for Nonlinear Estimation
    The Unscented Kalman Filter for Nonlinear Estimation Eric A. Wan and Rudolph van der Merwe Oregon Graduate Institute of Science & Technology 20000 NW Walker Rd, Beaverton, Oregon 97006 [email protected], [email protected] Abstract 1. Introduction The Extended Kalman Filter (EKF) has become a standard The EKF has been applied extensively to the field of non- technique used in a number of nonlinear estimation and ma- linear estimation. General application areas may be divided chine learning applications. These include estimating the into state-estimation and machine learning. We further di- state of a nonlinear dynamic system, estimating parame- vide machine learning into parameter estimation and dual ters for nonlinear system identification (e.g., learning the estimation. The framework for these areas are briefly re- weights of a neural network), and dual estimation (e.g., the viewed next. Expectation Maximization (EM) algorithm) where both states and parameters are estimated simultaneously. State-estimation This paper points out the flaws in using the EKF, and The basic framework for the EKF involves estimation of the introduces an improvement, the Unscented Kalman Filter state of a discrete-time nonlinear dynamic system, (UKF), proposed by Julier and Uhlman [5]. A central and (1) vital operation performed in the Kalman Filter is the prop- (2) agation of a Gaussian random variable (GRV) through the system dynamics. In the EKF, the state distribution is ap- where represent the unobserved state of the system and proximated by a GRV, which is then propagated analyti- is the only observed signal. The process noise drives cally through the first-order linearization of the nonlinear the dynamic system, and the observation noise is given by system.
    [Show full text]
  • 1 the Kalman Filter
    Macroeconometrics, Spring, 2019 Bent E. Sørensen August 20, 2019 1 The Kalman Filter We assume that we have a model that concerns a series of vectors αt, which are called \state vectors". These variables are supposed to describe the current state of the system in question. These state variables will typically not be observed and the other main ingredient is therefore the observed variables yt. The first step is to write the model in state space form which is in the form of a linear system which consists of 2 sets of linear equations. The first set of equations describes the evolution of the system and is called the \Transition Equation": αt = Kαt−1 + Rηt ; where K and R are matrices of constants and η is N(0;Q) and serially uncorrelated. (This setup allows for a constant also.) The second set of equations describes the relation between the state of the system and the observations and is called the \Measurement Equation": yt = Zαt + ξt ; where ξt is N(0;H), serially uncorrelated, and E(ξtηt−j) = 0 for all t and j. It turns out that a lot of models can be put in the state space form with a little imagination. The main restriction is of course on the linearity of the model while you may not care about the normality condition as you will still be doing least squares. The state-space model as it is defined here is not the most general possible|it is in principle easy to allow for non-stationary coefficient matrices, see for example Harvey(1989).
    [Show full text]
  • GPS) Fixed Wing Z·Set Testing
    DOT/FAA/CT-81 /201 Navigation System Using Time . I .. I . ·. J / .· (~_\_(. and Ranging (NAVSTAR)/Giobal Positioning System (GPS) Fixed Wing Z·Set Testing Jerome T. Connor March 1982 Project Plan I ' 1. US Deportment of TransportatiOn Federal Aviation Administration Technical Center Atlantic City Airport, N.J. 08405 TABLE OF CONTENTS Page 1. INTRODUCTION 1 1.1 Objective 1 1.2 Background 1 1.3 Related Documentation/Projects 2 1.4 Critical Issues 2 1.5 System Description 3 1.6 Location of Test 7 1.7 Overall Test Schedule 7 2. TEST PROGRAM 7 2.1 Laboratory Test Program 7 2.2 Airborne Test Program 11 3. EQUIPMENT REQUIREMENTS 16 3.1 Installation Data 17 4. DATA REQUIREMENTS 17 4.1 Data Rate 20 4.2 Data Collecting Philosophy 20 4.3 Data Analysis 22 4.4 Post-Flight Analysis 22 5. COORDINATION AND AREAS OF RESPONSIBILITY 24 iii LIST OF ILLUSTRATIONS Figure Page 1 Z-Set Control/Indicator Panel 4 2 Z-Set Test Schedule 8 3 Rectangular Flightpath Sketch 13 4 Typical Block Diagram of Airborne System 18 5 Aero Commander Airborne Instrumentation System 18 6 Test Log Sheet 21 LIST OF TABLES Table Page 1 Z-Set Control/Indicator Display Parameters 5 2 Physical and Performance Details 6 3 System Parameters and Data Rates 19 4 Organizational Responsibility and Activity 25 l_V 1. INTRODUCTION. 1.1 OBJECTIVE. The overall objective of the Federal Aviation Administration (FAA) Global Positioning System (GPS) test program is to define and determine the potential role of GPS as a civil aviation navigation system.
    [Show full text]