EE 565: Position, Navigation, and Timing
|
|
- Peregrine Barker
- 5 years ago
- Views:
Transcription
1 EE 565: Position, Navigation, and Timing Kalman Filtering Example Aly El-Osery Kevin Wedeward Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA In Collaboration with Stephen Bruder Electrical and Computer Engineering Department Embry-Riddle Aeronautical Univesity Prescott, Arizona, USA April 1, 218 Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
2 Review: System Model x(t) = F (t) x(t) + G(t) w(t) (1) y(t) = H(t) x(t) + v(t) (2) System Discretization Φ k 1 = e F k 1τ s I + F k 1 τ s (3) where F k 1 is the average of F at times t and t τ s, and first order approximation is used. Leading to x k = Φ k 1 x k 1 + w k 1 (4) z k = H k x k + v k (5) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
3 Review: Assumptions w k and v k are drawn from a Gaussian distribution, uncorrelated have zero mean and statistically independent. { E{ w k w i T Q k i = k } = (6) i k { E{ v k v i T R k i = k } = (7) E{ w k v T i } = i k { i, k (8) State covariance matrix Q k 1 1 [ ] Φ k 1 G k 1 Q(t k 1 )Gk 1 T 2 ΦT k 1 + G k 1Q(t k 1 )Gk 1 T τ s (9) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
4 Review: Kalman filter data flow Initial estimate (ˆ x and P) Compute Kalman gain Kk = P k k 1 Hk T (HkP k k 1Hk T + Rk) 1 Project ahead ˆ x k k 1 = Φk 1ˆ x k 1 k 1 P k k 1 = Qk 1 + Φk 1P k 1 k 1 Φ T k 1 Update estimate with measurement zk ˆ x k k = ˆ x k k 1 + Kk( zk Hk ˆ x k k 1 ) k = k + 1 Update error covariance P k k = (I K khk) P k k 1 (I K khk) T + K krkk T k Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
5 Remarks Kalman filter (KF) is optimal under the assumptions that the system is linear and the noise is uncorrelated Under these assumptions KF provides an unbiased and minimum variance estimate. If the Gaussian assumptions is not true, Kalman filter is biased and not minimum variance. If the noise is correlated we can augment the states of the system to maintain the uncorrelated requirement of the system noise. Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
6 Correlated State Noise Given a state space system x 1 (t) = F 1 (t) x 1 (t) + G 1 (t) w 1 (t) y 1 (t) = H 1 (t) x 1 (t) + v 1 (t) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
7 Correlated State Noise Given a state space system x 1 (t) = F 1 (t) x 1 (t) + G 1 (t) w 1 (t) y 1 (t) = H 1 (t) x 1 (t) + v 1 (t) As we have seen the noise w 1 (t) may be non-white, e.g., correlated Gaussian noise, and as such may be modeled as x 2 (t) = F 2 (t) x 2 (t) + G 2 (t) w 2 (t) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
8 Correlated State Noise Given a state space system x 1 (t) = F 1 (t) x 1 (t) + G 1 (t) w 1 (t) y 1 (t) = H 1 (t) x 1 (t) + v 1 (t) As we have seen the noise w 1 (t) may be non-white, e.g., correlated Gaussian noise, and as such may be modeled as x 2 (t) = F 2 (t) x 2 (t) + G 2 (t) w 2 (t) w 1 (t) = H 2 (t) x 2 (t) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
9 Correlated State Noise Define a new augmented state x aug = x 1(t) (1) x 2 (t) therefore, and x aug = x 1 (t) = F 1(t) G 1 H 2 (t) x 1(t) + w 2 (t) (11) x 2 (t) F 2 (t) x 2 (t) G 2 (t) y(t) = ( ) H 1 (t) x 1(t) + v 1 (t) (12) x 2 (t) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
10 Correlated Measurement Noise Given a state space system x 1 (t) = F 1 (t) x 1 (t) + G 1 (t) w(t) y 1 (t) = H 1 (t) x 1 (t) + v 1 (t) In this case the measurement noise v 1 may be correlated x 2 (t) = F 2 (t) x 2 (t) + G 2 (t) v 2 (t) v 1 (t) = H 2 (t) x 2 (t) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
11 Correlated Measurement Noise Define a new augmented state x aug = x 1(t) (13) x 2 (t) therefore, x aug = x 1 (t) = F 1(t) x 1(t) + G 1(t) w(t) (14) x 2 (t) F 2 (t) x 2 (t) G 2 (t) v 2 (t) and y(t) = ( H 1 (1) ) H 2 (t) x 1(t) (15) x 2 (t) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
12 Design Example You are to design a system that estimates the position and velocity of a moving point in a straight line. You have: 1 an accelerometer corrupted with noise 2 an aiding sensor allowing you to measure absolute position that is also corrupted with noise. Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
13 Specification Sampling Rate Fs = 1Hz. Accelerometer specs 1 VRW = 1mg/ Hz. 2 BI = 7mg with correlation time 6s. Position measurement is corrupted with WGN. N (, σ 2 p), where σ p = 2.5m Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
14 Input - Acceleration True Acceleration and Acceleration with Noise m/s Meas Accel Kalman Filter True Accel State Augmentation Example Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
15 Aiding Position Measurement Absolute position measurement corrupted with noise m Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
16 Computed Position and Velocity Using only the acceleration measurement and an integration approach to compute the velocity, then integrate again to get position. Velocity Position m/s 5 m Directly Computed Vel True Vel Directly Computed Pos True Pos Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
17 Different Approaches 1 Clean up the noisy input to the system by filtering 2 Use Kalman filtering techniques with Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
18 Different Approaches 1 Clean up the noisy input to the system by filtering 2 Use Kalman filtering techniques with A model of the system dynamics (too restrictive) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
19 Different Approaches 1 Clean up the noisy input to the system by filtering 2 Use Kalman filtering techniques with A model of the system dynamics (too restrictive) A model of the error dynamics and correct the system output in Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
20 Different Approaches 1 Clean up the noisy input to the system by filtering 2 Use Kalman filtering techniques with A model of the system dynamics (too restrictive) A model of the error dynamics and correct the system output in open-loop configuration, or closed-loop configuration. Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
21 Approach 1 Filtered input Filtered Accel Measurement m/s Accelerometer Measured Filtered Truth Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
22 Approach 1 Filtered input Position and Velocity Velocity Position Directly Computed Vel True Vel Vel (using filtered accel) 2 15 Directly Computed Pos True Pos Pos (using filtered accel) m/s 5 m Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
23 Approach 1 Filtered input Position and Velocity Errors Velocity Error Position Error 2 Using filtered acc Using unfiltered acc 5 Using filtered acc Using unfiltered acc m/s 6 m Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
24 Open-Loop Integration True Pos + errors Aiding sensor errors - INS errors Aiding Pos Sensor + Filter INS + + Inertial errors est. INS PV + errors Correct INS Output Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
25 Closed-Loop Integration If error estimates are fedback to correct the INS mechanization, a reset of the state estimates becomes necessary. Aiding Pos Sensor + Filter INS INS Correction Correct INS Output Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
26 Covariance Matrices State noise covariance matrix (continuous) State noise covariance matrix (discrete) E{ w(t) w T (τ)} = Q(t)δ(t τ) E{ w k w T i } = Measurement noise covariance matrix Initial error covariance matrix E{ v k v T i } = { Q k i = k i k { R k i = k i k P = E{( x ˆ x )( x ˆ x ) T } = E{ e ˆ e T } Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
27 System Modeling The position, velocity and acceleration may be modeled using the following kinematic model. ṗ(t) = v(t) v(t) = a(t) (16) where a(t) is the input. Therefore, our estimate of the position is ˆp(t) that is the double integration of the acceleration. Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
28 Sensor Model Assuming that the accelerometer sensor measurement may be modeled as ã(t) = a(t) + b(t) + w a (t) (17) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
29 Sensor Model Assuming that the accelerometer sensor measurement may be modeled as ã(t) = a(t) + b(t) + w a (t) (17) and the bias is Markov, therefore ḃ(t) = 1 b(t) + w b (t) (18) T c where w a (t) and w b (t) are zero mean WGN with variances, respectively, Fs VRW 2 E{w b (t)w b (t + τ)} = Q b (t)δ(t τ) (19) and T c is the correlation time and σ BI is the bias instability. Q b (t) = 2σ2 BI T c (2) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
30 Sensor Model Assuming that the accelerometer sensor measurement may be modeled as ã(t) = a(t) + b(t) + w a (t) (17) and the bias is Markov, therefore ḃ(t) = 1 b(t) + w b (t) (18) T c where w a (t) and w b (t) are zero mean WGN with variances, respectively, Fs VRW 2 E{w b (t)w b (t + τ)} = Q b (t)δ(t τ) (19) Q b (t) = 2σ2 BI T c (2) and T c is the correlation time and σ BI is the bias instability. Make sure that the VRW and σ BI are converted to have SI units. Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
31 Error Mechanization Define error terms as δp(t) = p(t) ˆp(t), (21) and δṗ(t) = ṗ(t) ˆp(t) = v(t) ˆv(t) = δv(t) δ v(t) = v(t) ˆv(t) = a(t) â(t) = b(t) w a (t) (22) (23) where b(t) is modeled as shown in Eq. 18 Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
32 State Space Formulation δṗ(t) 1 δp(t) x(t) = δ v(t) = 1 δv(t) + 1 w a (t) ḃ(t) 1 T c b(t) 1 w b (t) = F (t) x(t) + G(t) w(t) (24) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
33 Covariance Matrix The continuous state noise covariance matrix Q(t) is Q(t) = VRW 2 2σ 2 BI Tc (25) The measurement noise covariance matrix is R = σ 2 p, where σ p is the standard deviation of the noise of the absolute position sensor. Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
34 Discretization Now we are ready to start the implementation but first we have to discretize the system. x(k + 1) = Φ(k) x(k) + w d (k) (26) where with the measurement equation Φ(k) I + Fdt (27) y(k) = H x + w p (k) = δp(k) + w p (k) (28) where H = [1 ]. The discrete Q d is approximated as Q k [Φ k 1G(t k 1 )Q(t k 1 )G T (t k 1 ))Φ T k 1 + G(t k 1 )Q(t k 1 )G T (t k 1 )]dt (29) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
35 Approach 2 Open-Loop Compensation Position and Velocity Open-loop Correction Best estimate = INS out (pos & vel) + KF est error (pos & vel) Velocity Position 2 15 Directly Computed Vel True Vel Estimated Vel (KF) 2 15 Directly Computed Pos True Pos Estimated Pos (KF) 1 m/s 5 m Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
36 Approach 2 Open-Loop Compensation Position and Velocity Errors Velocity Error Position Error m/s 6 m Error in Estimated Vel (KF) Error in Computed 15 Error in Pos Measurement Error in Computed Pos Error in Estimated Pos (KF) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
37 Approach 2 Open-Loop Compensation Pos Error & Bias Estimate 8 Position Error m 2 2 m Error in Pos Measurement Error in Estimated Pos (KF) Bias Est. Bias True Bias Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
38 Approach 3 Closed-Loop Compensation Position and Velocity Closed-loop Correction Best estimate = INS out (pos,vel, & bias) + KF est error (pos, vel & bias) Use best estimate on next iteration of INS Accel estimate = accel meas - est bias Reset state estimates before next call to KF 2 15 Directly Computed Vel True Vel Estimated Vel (KF) 2 15 Directly Computed Pos True Pos Estimated Pos (KF) 1 m/s 5 m Velocity Position Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
39 Approach 3 Closed-Loop Compensation Position and Velocity Errors Velocity Error Position Error m/s 6 m Error in Estimated Vel (KF) Error in Computed 15 Error in Pos Measurement Error in Computed Pos Error in Estimated Pos (KF) Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
40 Approach 3 Closed-Loop Compensation Pos Error & Bias Estimate 8 Position Error m 2 2 m Error in Pos Measurement Error in Estimated Pos (KF) Bias Est. Bias True Bias Aly El-Osery, Kevin Wedeward (NMT) EE 565: Position, Navigation, and Timing April 1, / 33
EE 570: Location and Navigation
EE 570: Location and Navigation Aided INS Aly El-Osery Kevin Wedeward Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA In Collaboration with Stephen Bruder Electrical and Computer
More informationLecture. Aided INS EE 570: Location and Navigation. 1 Overview. 1.1 ECEF as and Example. 1.2 Inertial Measurements
Lecture Aided EE 570: Location and Navigation Lecture Notes Update on April 13, 2016 Aly El-Osery and Kevin Wedeward, Electrical Engineering Dept., New Mexico Tech In collaoration with Stephen Bruder,
More informationEE 570: Location and Navigation
EE 570: Location and Navigation Sensor Technology Aly El-Osery Kevin Wedeward Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA In Collaboration with Stephen Bruder Electrical
More informationEE 565: Position, Navigation and Timing
EE 565: Position, Navigation and Timing Navigation Mathematics: Angular and Linear Velocity Kevin Wedeward Aly El-Osery Electrical Engineering Department New Mexico Tech Socorro, New Mexico, USA In Collaboration
More informationEE 570: Location and Navigation
EE 570: Location and Navigation Error Mechanization (Tangential) Aly El-Osery 1 Stephen Bruder 2 1 Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA 2 Electrical and Computer
More informationEE 570: Location and Navigation
EE 570: Location and Navigation Sensor Technology Stephen Bruder 1 Aly El-Osery 2 1 Electrical and Computer Engineering Department, Embry-Riddle Aeronautical Univesity Prescott, Arizona, USA 2 Electrical
More informationEE 570: Location and Navigation
EE 570: Location and Navigation Navigation Mathematics: Kinematics (Earth Surface & Gravity Models) Aly El-Osery Kevin Wedeward Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA
More informationEE 570: Location and Navigation
EE 570: Location and Navigation Navigation Mathematics: Coordinate Frames Kevin Wedeward Aly El-Osery Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA In Collaboration with Stephen
More informationEE 570: Location and Navigation
EE 570: Location and Navigation Error Mechanization (ECEF) Aly El-Osery 1 Stephen Bruder 2 1 Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA 2 Electrical and Computer Engineering
More informationEE 570: Location and Navigation
EE 570: Location and Navigation Navigation Equations: Nav Mechanization Aly El-Osery Kevin Wedeward Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA In Collaboration with Stephen
More informationEE 570: Location and Navigation
EE 570: Location and Navigation Error Mechanization (ECEF) Aly El-Osery Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA April 11, 2013 Attitude Velocity Gravity Position Summary
More informationNavigation Mathematics: Kinematics (Earth Surface & Gravity Models) EE 570: Location and Navigation
Lecture Navigation Mathematics: Kinematics (Earth Surface & ) EE 570: Location and Navigation Lecture Notes Update on March 10, 2016 Aly El-Osery and Kevin Wedeward, Electrical Engineering Dept., New Mexico
More informationEE 570: Location and Navigation
EE 570: Location and Navigation Sensor Technology Stephen Bruder 1 Aly El-Osery 2 1 Electrical and Computer Engineering Department, Embry-Riddle Aeronautical Univesity Prescott, Arizona, USA 2 Electrical
More information6.4 Kalman Filter Equations
6.4 Kalman Filter Equations 6.4.1 Recap: Auxiliary variables Recall the definition of the auxiliary random variables x p k) and x m k): Init: x m 0) := x0) S1: x p k) := Ak 1)x m k 1) +uk 1) +vk 1) S2:
More informationEE 570: Location and Navigation
EE 570: Locatio ad Navigatio Error Mechaizatio (NAV) Aly El-Osery Kevi Wedeward Electrical Egieerig Departmet, New Mexico Tech Socorro, New Mexico, USA I Collaboratio with Stephe Bruder Electrical ad Computer
More informationNavigation Mathematics: Kinematics (Coordinate Frame Transformation) EE 570: Location and Navigation
Lecture Navigation Mathematics: Kinematics (Coordinate Frame Transformation) EE 570: Location and Navigation Lecture Notes Update on Feruary 16, 2016 Aly El-Osery and Kevin Wedeward, Electrical Engineering
More informationKalman Filters with Uncompensated Biases
Kalman Filters with Uncompensated Biases Renato Zanetti he Charles Stark Draper Laboratory, Houston, exas, 77058 Robert H. Bishop Marquette University, Milwaukee, WI 53201 I. INRODUCION An underlying assumption
More informationL06. LINEAR KALMAN FILTERS. NA568 Mobile Robotics: Methods & Algorithms
L06. LINEAR KALMAN FILTERS NA568 Mobile Robotics: Methods & Algorithms 2 PS2 is out! Landmark-based Localization: EKF, UKF, PF Today s Lecture Minimum Mean Square Error (MMSE) Linear Kalman Filter Gaussian
More informationAdaptive ensemble Kalman filtering of nonlinear systems
Adaptive ensemble Kalman filtering of nonlinear systems Tyrus Berry George Mason University June 12, 213 : Problem Setup We consider a system of the form: x k+1 = f (x k ) + ω k+1 ω N (, Q) y k+1 = h(x
More informationDeriva'on of The Kalman Filter. Fred DePiero CalPoly State University EE 525 Stochas'c Processes
Deriva'on of The Kalman Filter Fred DePiero CalPoly State University EE 525 Stochas'c Processes KF Uses State Predic'ons KF es'mates the state of a system Example Measure: posi'on State: [ posi'on velocity
More informationKalman Filter and Parameter Identification. Florian Herzog
Kalman Filter and Parameter Identification Florian Herzog 2013 Continuous-time Kalman Filter In this chapter, we shall use stochastic processes with independent increments w 1 (.) and w 2 (.) at the input
More informationSequential State Estimation (Crassidas and Junkins, Chapter 5)
Sequential State Estimation (Crassidas and Junkins, Chapter 5) Please read: 5.1, 5.3-5.6 5.3 The Discrete-Time Kalman Filter The discrete-time Kalman filter is used when the dynamics and measurements are
More informationBaro-INS Integration with Kalman Filter
Baro-INS Integration with Kalman Filter Vivek Dadu c,b.venugopal Reddy a, Brajnish Sitara a, R.S.Chandrasekhar a & G.Satheesh Reddy a c Hindustan Aeronautics Ltd, Korwa, India. a Research Centre Imarat,
More informationTime Series Analysis
Time Series Analysis hm@imm.dtu.dk Informatics and Mathematical Modelling Technical University of Denmark DK-2800 Kgs. Lyngby 1 Outline of the lecture State space models, 1st part: Model: Sec. 10.1 The
More informationA Multiple Target Range and Range-Rate. Tracker Using an Extended Kalman Filter and. a Multilayered Association Scheme
A Multiple Target Range and Range-Rate Tracker Using an Extended Kalman Filter and a Multilayered Association Scheme A thesis submitted by Leah Uftring In partial fufillment of the degree requirements
More informationThe Kalman Filter ImPr Talk
The Kalman Filter ImPr Talk Ged Ridgway Centre for Medical Image Computing November, 2006 Outline What is the Kalman Filter? State Space Models Kalman Filter Overview Bayesian Updating of Estimates Kalman
More informationData assimilation with and without a model
Data assimilation with and without a model Tyrus Berry George Mason University NJIT Feb. 28, 2017 Postdoc supported by NSF This work is in collaboration with: Tim Sauer, GMU Franz Hamilton, Postdoc, NCSU
More informationCS 532: 3D Computer Vision 6 th Set of Notes
1 CS 532: 3D Computer Vision 6 th Set of Notes Instructor: Philippos Mordohai Webpage: www.cs.stevens.edu/~mordohai E-mail: Philippos.Mordohai@stevens.edu Office: Lieb 215 Lecture Outline Intro to Covariance
More informationENGR352 Problem Set 02
engr352/engr352p02 September 13, 2018) ENGR352 Problem Set 02 Transfer function of an estimator 1. Using Eq. (1.1.4-27) from the text, find the correct value of r ss (the result given in the text is incorrect).
More informationSteady State Kalman Filter
Steady State Kalman Filter Infinite Horizon LQ Control: ẋ = Ax + Bu R positive definite, Q = Q T 2Q 1 2. (A, B) stabilizable, (A, Q 1 2) detectable. Solve for the positive (semi-) definite P in the ARE:
More informationStochastic Models, Estimation and Control Peter S. Maybeck Volumes 1, 2 & 3 Tables of Contents
Navtech Part #s Volume 1 #1277 Volume 2 #1278 Volume 3 #1279 3 Volume Set #1280 Stochastic Models, Estimation and Control Peter S. Maybeck Volumes 1, 2 & 3 Tables of Contents Volume 1 Preface Contents
More informationUnbiased Power Prediction of Rayleigh Fading Channels
Unbiased Power Prediction of Rayleigh Fading Channels Torbjörn Ekman UniK PO Box 70, N-2027 Kjeller, Norway Email: torbjorn.ekman@signal.uu.se Mikael Sternad and Anders Ahlén Signals and Systems, Uppsala
More informationData assimilation with and without a model
Data assimilation with and without a model Tim Sauer George Mason University Parameter estimation and UQ U. Pittsburgh Mar. 5, 2017 Partially supported by NSF Most of this work is due to: Tyrus Berry,
More informationState Observers and the Kalman filter
Modelling and Control of Dynamic Systems State Observers and the Kalman filter Prof. Oreste S. Bursi University of Trento Page 1 Feedback System State variable feedback system: Control feedback law:u =
More information4 Derivations of the Discrete-Time Kalman Filter
Technion Israel Institute of Technology, Department of Electrical Engineering Estimation and Identification in Dynamical Systems (048825) Lecture Notes, Fall 2009, Prof N Shimkin 4 Derivations of the Discrete-Time
More informationSYSTEMTEORI - KALMAN FILTER VS LQ CONTROL
SYSTEMTEORI - KALMAN FILTER VS LQ CONTROL 1. Optimal regulator with noisy measurement Consider the following system: ẋ = Ax + Bu + w, x(0) = x 0 where w(t) is white noise with Ew(t) = 0, and x 0 is a stochastic
More informationIntroduction to Unscented Kalman Filter
Introduction to Unscented Kalman Filter 1 Introdution In many scientific fields, we use certain models to describe the dynamics of system, such as mobile robot, vision tracking and so on. The word dynamics
More informationA Comparitive Study Of Kalman Filter, Extended Kalman Filter And Unscented Kalman Filter For Harmonic Analysis Of The Non-Stationary Signals
International Journal of Scientific & Engineering Research, Volume 3, Issue 7, July-2012 1 A Comparitive Study Of Kalman Filter, Extended Kalman Filter And Unscented Kalman Filter For Harmonic Analysis
More informationImage Alignment and Mosaicing Feature Tracking and the Kalman Filter
Image Alignment and Mosaicing Feature Tracking and the Kalman Filter Image Alignment Applications Local alignment: Tracking Stereo Global alignment: Camera jitter elimination Image enhancement Panoramic
More informationExam in Automatic Control II Reglerteknik II 5hp (1RT495)
Exam in Automatic Control II Reglerteknik II 5hp (1RT495) Date: August 4, 018 Venue: Bergsbrunnagatan 15 sal Responsible teacher: Hans Rosth. Aiding material: Calculator, mathematical handbooks, textbooks
More informationKalman Filter. Predict: Update: x k k 1 = F k x k 1 k 1 + B k u k P k k 1 = F k P k 1 k 1 F T k + Q
Kalman Filter Kalman Filter Predict: x k k 1 = F k x k 1 k 1 + B k u k P k k 1 = F k P k 1 k 1 F T k + Q Update: K = P k k 1 Hk T (H k P k k 1 Hk T + R) 1 x k k = x k k 1 + K(z k H k x k k 1 ) P k k =(I
More informationThe Kalman filter. Chapter 6
Chapter 6 The Kalman filter In the last chapter, we saw that in Data Assimilation, we ultimately desire knowledge of the full a posteriori p.d.f., that is the conditional p.d.f. of the state given the
More informationSENSITIVITY ANALYSIS OF MULTIPLE FAULT TEST AND RELIABILITY MEASURES IN INTEGRATED GPS/INS SYSTEMS
Arcves of Photogrammetry, Cartography and Remote Sensing, Vol., 011, pp. 5-37 ISSN 083-14 SENSITIVITY ANALYSIS OF MULTIPLE FAULT TEST AND RELIABILITY MEASURES IN INTEGRATED GPS/INS SYSTEMS Ali Almagbile
More informationKalman Filter. Man-Wai MAK
Kalman Filter Man-Wai MAK Dept. of Electronic and Information Engineering, The Hong Kong Polytechnic University enmwmak@polyu.edu.hk http://www.eie.polyu.edu.hk/ mwmak References: S. Gannot and A. Yeredor,
More informationTowards Real-Time Maneuver Detection: Automatic State and Dynamics Estimation with the Adaptive Optimal Control Based Estimator
owards Real-ime Maneuver Detection: Automatic State and Dynamics Estimation with the Adaptive Optimal Control Based Estimator Daniel P. Lubey and Daniel J. Scheeres University of Colorado, Boulder, United
More informationInertial Navigation and Various Applications of Inertial Data. Yongcai Wang. 9 November 2016
Inertial Navigation and Various Applications of Inertial Data Yongcai Wang 9 November 2016 Types of Gyroscope Mechanical Gyroscope Laser Gyroscope Sagnac Effect Stable Platform IMU and Strapdown IMU In
More informationReal-time Attitude Estimation Techniques Applied to a Four Rotor Helicopter
43rd IEEE Conference on Decision and Control December 14-17, 4 Atlantis, Paradise Island, Bahamas ThC9.3 Real- Attitude Estimation Techniques Applied to a Four Rotor Helicopter Matthew G. Earl and Raffaello
More informationUsing the Kalman Filter to Estimate the State of a Maneuvering Aircraft
1 Using the Kalman Filter to Estimate the State of a Maneuvering Aircraft K. Meier and A. Desai Abstract Using sensors that only measure the bearing angle and range of an aircraft, a Kalman filter is implemented
More informationState Estimation with a Kalman Filter
State Estimation with a Kalman Filter When I drive into a tunnel, my GPS continues to show me moving forward, even though it isn t getting any new position sensing data How does it work? A Kalman filter
More informationÜbersetzungshilfe / Translation aid (English) To be returned at the end of the exam!
Prüfung Regelungstechnik I (Control Systems I) Prof. Dr. Lino Guzzella 3.. 24 Übersetzungshilfe / Translation aid (English) To be returned at the end of the exam! Do not mark up this translation aid -
More informationLecture 5 Least-squares
EE263 Autumn 2008-09 Stephen Boyd Lecture 5 Least-squares least-squares (approximate) solution of overdetermined equations projection and orthogonality principle least-squares estimation BLUE property
More informationLecture 9: Modeling and motion models
Sensor Fusion, 2014 Lecture 9: 1 Lecture 9: Modeling and motion models Whiteboard: Principles and some examples. Slides: Sampling formulas. Noise models. Standard motion models. Position as integrated
More informationFinal Exam Solutions
EE55: Linear Systems Final Exam SIST, ShanghaiTech Final Exam Solutions Course: Linear Systems Teacher: Prof. Boris Houska Duration: 85min YOUR NAME: (type in English letters) I Introduction This exam
More informationHere represents the impulse (or delta) function. is an diagonal matrix of intensities, and is an diagonal matrix of intensities.
19 KALMAN FILTER 19.1 Introduction In the previous section, we derived the linear quadratic regulator as an optimal solution for the fullstate feedback control problem. The inherent assumption was that
More informationEL2520 Control Theory and Practice
EL2520 Control Theory and Practice Lecture 8: Linear quadratic control Mikael Johansson School of Electrical Engineering KTH, Stockholm, Sweden Linear quadratic control Allows to compute the controller
More informationExtension of Farrenkopf Steady-State Solutions with Estimated Angular Rate
Extension of Farrenopf Steady-State Solutions with Estimated Angular Rate Andrew D. Dianetti and John L. Crassidis University at Buffalo, State University of New Yor, Amherst, NY 46-44 Steady-state solutions
More informationFuzzy Adaptive Kalman Filtering for INS/GPS Data Fusion
A99936769 AMA-99-4307 Fuzzy Adaptive Kalman Filtering for INS/GPS Data Fusion J.Z. Sasiadek* and Q. Wang** Dept. of Mechanical & Aerospace Engineering Carleton University 1125 Colonel By Drive, Ottawa,
More informationGEORGIA INSTITUTE OF TECHNOLOGY SCHOOL OF ELECTRICAL AND COMPUTER ENGINEERING Final Examination - Fall 2015 EE 4601: Communication Systems
GEORGIA INSTITUTE OF TECHNOLOGY SCHOOL OF ELECTRICAL AND COMPUTER ENGINEERING Final Examination - Fall 2015 EE 4601: Communication Systems Aids Allowed: 2 8 1/2 X11 crib sheets, calculator DATE: Tuesday
More informationA New Approach to Tune the Vold-Kalman Estimator for Order Tracking
A New Approach to Tune the Vold-Kalman Estimator for Order Tracking Amadou Assoumane, Julien Roussel, Edgard Sekko and Cécile Capdessus Abstract In the purpose to diagnose rotating machines using vibration
More informationQuaternion based Extended Kalman Filter
Quaternion based Extended Kalman Filter, Sergio Montenegro About this lecture General introduction to rotations and quaternions. Introduction to Kalman Filter for Attitude Estimation How to implement and
More informationSimultaneous Localization and Mapping (SLAM) Corso di Robotica Prof. Davide Brugali Università degli Studi di Bergamo
Simultaneous Localization and Mapping (SLAM) Corso di Robotica Prof. Davide Brugali Università degli Studi di Bergamo Introduction SLAM asks the following question: Is it possible for an autonomous vehicle
More informationData Fusion of Dual Foot-Mounted Zero Velocity Update (ZUPT) Aided Inertial Navigation Systems (INSs) using Centroid Method
February 02, 2013 Data Fusion of Dual Foot-Mounted Zero Velocity Update (ZUPT) Aided Inertial Navigation Systems (INSs) using Centroid Method Girisha Under the guidance of Prof. K.V.S. Hari Notations Define
More informationUAV Navigation: Airborne Inertial SLAM
Introduction UAV Navigation: Airborne Inertial SLAM Jonghyuk Kim Faculty of Engineering and Information Technology Australian National University, Australia Salah Sukkarieh ARC Centre of Excellence in
More informationInvestigation of the Attitude Error Vector Reference Frame in the INS EKF
Investigation of the Attitude Error Vector Reference Frame in the INS EKF Stephen Steffes, Jan Philipp Steinbach, and Stephan Theil Abstract The Extended Kalman Filter is used extensively for inertial
More informationX t = a t + r t, (7.1)
Chapter 7 State Space Models 71 Introduction State Space models, developed over the past 10 20 years, are alternative models for time series They include both the ARIMA models of Chapters 3 6 and the Classical
More informationPartitioned Covariance Intersection
Partitioned Covariance Intersection Arne Petersen Christian Albrechts University Kiel, Germany E-Mail: apetersen@mip.informati.uni-iel.de Phone: +49 ()431 88 1418 Marc-André Beyer Raytheon Anschütz GmbH
More informationManipulators. Robotics. Outline. Non-holonomic robots. Sensors. Mobile Robots
Manipulators P obotics Configuration of robot specified by 6 numbers 6 degrees of freedom (DOF) 6 is the minimum number required to position end-effector arbitrarily. For dynamical systems, add velocity
More informationModel-building and parameter estimation
Luleå University of Technology Johan Carlson Last revision: July 27, 2009 Measurement Technology and Uncertainty Analysis - E7021E MATLAB homework assignment Model-building and parameter estimation Introduction
More informationMassachusetts Institute of Technology
Massachusetts Institute of Technology Department of Electrical Engineering and Computer Science 6.011: Introduction to Communication, Control and Signal Processing QUIZ, April 1, 010 QUESTION BOOKLET Your
More informationADAPTIVE FILTE APPLICATIONS TO HEAVE COMPENSATION
ADAPTIVE FILTE APPLICATIONS TO HEAVE COMPENSATION D.G. Lainiotis, K. Plataniotis, and C. Chardamgoas Florida Institute of Technology, Melbourne, FL and University of Patras, Patras, Greece. Abstract -
More informationImproving Adaptive Kalman Estimation in GPS/INS Integration
THE JOURNAL OF NAVIGATION (27), 6, 517 529. f The Royal Institute of Navigation doi:1.117/s373463374316 Printed in the United Kingdom Improving Adaptive Kalman Estimation in GPS/INS Integration Weidong
More informationLINEAR QUADRATIC GAUSSIAN
ECE553: Multivariable Control Systems II. LINEAR QUADRATIC GAUSSIAN.: Deriving LQG via separation principle We will now start to look at the design of controllers for systems Px.t/ D A.t/x.t/ C B u.t/u.t/
More informationEE 521: Instrumentation and Measurements
Aly El-Osery Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA August 30, 2009 1 / 19 1 Course Overview 2 Measurement System 3 Noise 4 Error Analysis 2 / 19 Textbooks C.W. De
More information2D Image Processing. Bayes filter implementation: Kalman filter
2D Image Processing Bayes filter implementation: Kalman filter Prof. Didier Stricker Dr. Gabriele Bleser Kaiserlautern University http://ags.cs.uni-kl.de/ DFKI Deutsches Forschungszentrum für Künstliche
More informationLecture 13 Visual Inertial Fusion
Lecture 13 Visual Inertial Fusion Davide Scaramuzza Outline Introduction IMU model and Camera-IMU system Different paradigms Filtering Maximum a posteriori estimation Fix-lag smoothing 2 What is an IMU?
More informationVN-100 Velocity Compensation
VN-100 Velocity Compensation Velocity / Airspeed Aiding for AHRS Applications Application Note Abstract This application note describes how the VN-100 can be used in non-stationary applications which require
More informationInstitutionen för systemteknik
Institutionen för systemteknik Department of Electrical Engineering Examensarbete Multiple Platform Bias Error Estimation Examensarbete utfört i Reglerteknik vid Tekniska högskolan i Linköping av Åsa Wiklund
More informationCONTROL SYSTEMS, ROBOTICS AND AUTOMATION Vol. VIII Kalman Filters - Mohinder Singh Grewal
KALMAN FILERS Mohinder Singh Grewal California State University, Fullerton, USA Keywords: Bierman, hornton, Cholesky decomposition, continuous time optimal estimator, covariance, estimators, filters, GPS,
More informationFull-covariance model compensation for
compensation transms Presentation Toshiba, 12 Mar 2008 Outline compensation transms compensation transms Outline compensation transms compensation transms Noise model x clean speech; n additive ; h convolutional
More information2D Image Processing. Bayes filter implementation: Kalman filter
2D Image Processing Bayes filter implementation: Kalman filter Prof. Didier Stricker Kaiserlautern University http://ags.cs.uni-kl.de/ DFKI Deutsches Forschungszentrum für Künstliche Intelligenz http://av.dfki.de
More informationSystem Identification & Parameter Estimation
System Identification & Parameter Estimation Wb3: SIPE lecture Correlation functions in time & frequency domain Alfred C. Schouten, Dept. of Biomechanical Engineering (BMechE), Fac. 3mE // Delft University
More informationRESEARCH OBJECTIVES AND SUMMARY OF RESEARCH
XVIII. DETECTION AND ESTIMATION THEORY Academic Research Staff Prof. H. L. Van Trees Prof. A. B. Baggeroer Graduate Students J. P. Albuquerque J. M. F. Moura L. C. Pusey L. S. Metzger S. Orphanoudakis
More informationPosition Control Using Acceleration- Based Identification and Feedback With Unknown Measurement Bias
Position Control Using Acceleration- Based Identification and Feedback With Unknown Measurement Bias Jaganath Chandrasekar e-mail: jchandra@umich.edu Dennis S. Bernstein e-mail: dsbaero@umich.edu Department
More informationStochastic Cloning: A generalized framework for processing relative state measurements
Stochastic Cloning: A generalized framework for processing relative state measurements Stergios I. Roumeliotis and Joel W. Burdick Division of Engineering and Applied Science California Institute of Technology,
More informationIncorporation of Time Delayed Measurements in a. Discrete-time Kalman Filter. Thomas Dall Larsen, Nils A. Andersen & Ole Ravn
Incorporation of Time Delayed Measurements in a Discrete-time Kalman Filter Thomas Dall Larsen, Nils A. Andersen & Ole Ravn Department of Automation, Technical University of Denmark Building 326, DK-2800
More informationNoise Reduction of MEMS Gyroscope Based on Direct Modeling for an Angular Rate Signal
Micromachines 25, 6, 266-28; doi:.339/mi62266 Article OPEN ACCESS micromachines ISSN 272-666X www.mdpi.com/journal/micromachines Noise Reduction of MEMS Gyroscope Based on Direct Modeling for an Angular
More informationESTIMATOR STABILITY ANALYSIS IN SLAM. Teresa Vidal-Calleja, Juan Andrade-Cetto, Alberto Sanfeliu
ESTIMATOR STABILITY ANALYSIS IN SLAM Teresa Vidal-Calleja, Juan Andrade-Cetto, Alberto Sanfeliu Institut de Robtica i Informtica Industrial, UPC-CSIC Llorens Artigas 4-6, Barcelona, 88 Spain {tvidal, cetto,
More informationSummary of lecture 8. FIR Wiener filter: computed by solving a finite number of Wiener-Hopf equations, h(i)r yy (k i) = R sy (k); k = 0; : : : ; m
Summar of lecture 8 FIR Wiener filter: computed b solving a finite number of Wiener-Hopf equations, mx i= h(i)r (k i) = R s (k); k = ; : : : ; m Whitening filter: A filter that removes the correlation
More informationKalman Filtering in a Mass-Spring System
Department of Mathematics Center for Quantitative Sciences in Biomedicine North Carolina State University July 30, 2016 Practical Overview Goal: Implement Kalman filter for linear system 1. Solve a linear
More informationA Low-Cost GPS Aided Inertial Navigation System for Vehicular Applications
A Low-Cost GPS Aided Inertial Navigation System for Vehicular Applications ISAAC SKOG Master of Science Thesis Stockholm, Sweden 2005-03-09 IR-SB-EX-0506 1 Abstract In this report an approach for integration
More informationA Stochastic Observability Test for Discrete-Time Kalman Filters
A Stochastic Observability Test for Discrete-Time Kalman Filters Vibhor L. Bageshwar 1, Demoz Gebre-Egziabher 2, William L. Garrard 3, and Tryphon T. Georgiou 4 University of Minnesota Minneapolis, MN
More informationDual Estimation and the Unscented Transformation
Dual Estimation and the Unscented Transformation Eric A. Wan ericwan@ece.ogi.edu Rudolph van der Merwe rudmerwe@ece.ogi.edu Alex T. Nelson atnelson@ece.ogi.edu Oregon Graduate Institute of Science & Technology
More informationMiscellaneous. Regarding reading materials. Again, ask questions (if you have) and ask them earlier
Miscellaneous Regarding reading materials Reading materials will be provided as needed If no assigned reading, it means I think the material from class is sufficient Should be enough for you to do your
More informationFourier Methods in Digital Signal Processing Final Exam ME 579, Spring 2015 NAME
Fourier Methods in Digital Signal Processing Final Exam ME 579, Instructions for this CLOSED BOOK EXAM 2 hours long. Monday, May 8th, 8-10am in ME1051 Answer FIVE Questions, at LEAST ONE from each section.
More informationComputer Problem 1: SIE Guidance, Navigation, and Control
Computer Problem 1: SIE 39 - Guidance, Navigation, and Control Roger Skjetne March 12, 23 1 Problem 1 (DSRV) We have the model: m Zẇ Z q ẇ Mẇ I y M q q + ẋ U cos θ + w sin θ ż U sin θ + w cos θ θ q Zw
More informationAn Introduction to the Kalman Filter
An Introduction to the Kalman Filter by Greg Welch 1 and Gary Bishop 2 Department of Computer Science University of North Carolina at Chapel Hill Chapel Hill, NC 275993175 Abstract In 1960, R.E. Kalman
More informationCALIFORNIA INSTITUTE OF TECHNOLOGY Control and Dynamical Systems. CDS 110b
CALIFORNIA INSTITUTE OF TECHNOLOGY Control and Dynamical Systems CDS 110b R. M. Murray Kalman Filters 25 January 2006 Reading: This set of lectures provides a brief introduction to Kalman filtering, following
More information1 Kalman Filter Introduction
1 Kalman Filter Introduction You should first read Chapter 1 of Stochastic models, estimation, and control: Volume 1 by Peter S. Maybec (available here). 1.1 Explanation of Equations (1-3) and (1-4) Equation
More informationNOISE ROBUST RELATIVE TRANSFER FUNCTION ESTIMATION. M. Schwab, P. Noll, and T. Sikora. Technical University Berlin, Germany Communication System Group
NOISE ROBUST RELATIVE TRANSFER FUNCTION ESTIMATION M. Schwab, P. Noll, and T. Sikora Technical University Berlin, Germany Communication System Group Einsteinufer 17, 1557 Berlin (Germany) {schwab noll
More informationCOS Lecture 16 Autonomous Robot Navigation
COS 495 - Lecture 16 Autonomous Robot Navigation Instructor: Chris Clark Semester: Fall 011 1 Figures courtesy of Siegwart & Nourbakhsh Control Structure Prior Knowledge Operator Commands Localization
More information