UNSCENTED KALMAN FILTERING FOR SPACECRAFT ATTITUDE STATE AND PARAMETER ESTIMATION

Size: px
Start display at page:

Download "UNSCENTED KALMAN FILTERING FOR SPACECRAFT ATTITUDE STATE AND PARAMETER ESTIMATION"

Transcription

1 AAS UNSCENTED KALMAN FILTERING FOR SPACECRAFT ATTITUDE STATE AND PARAMETER ESTIMATION Matthew C. VanDyke, Jana L. Schwartz, Christopher D. Hall An Unscented Kalman Filter (UKF) is derived in an attempt to solve the spacecraft dual estimation problem with greater accuracy than is attainable with an Extended Kalman Filter (EKF). The EKF is an extension of the linear Kalman Filter for nonlinear systems. Although the EKF has been used successfully in many nonlinear applications, the performance is limited, due mostly to the truncation of all but first-order terms. The UKF is able to achieve greater estimation performance than the EKF through the use of the unscented transformation (UT). The UT allows the UKF to capture first and second order terms of the nonlinear system. INTRODUCTION The Kalman Filter is an optimal filter for estimating a linear system.[1] The simplicity, recursive structure, and mathematical rigour of the derivation of the Kalman Filter make it well-suited and attractive for use in many practical applications. However, many real-world systems, especially mechanical systems, are nonlinear in nature. The Extended Kalman Filter (EKF) was developed to help account for these nonlinearities. The EKF accounts for nonlinearities by linearizing the system about its last-known best estimate with the assumption that the error incurred by neglecting the higher-order terms is small in comparison to the first-order terms. The Kalman Filter measurement update equations are then applied to the linear system, resulting in a suboptimal solution. Although the EKF has been used successfully in many applications, it has several shortcomings. The EKF operates by approximating the state distribution as a Gaussian random variable (GRV) and then propagating it through the first-order linearization of the nonlinear system.[2] The EKF is a suboptimal nonlinear filter due to the truncation of the higher-order terms when linearizing the system. The loss of the higher-order terms can be avoided in the propagation of the state of the system by using the full nonlinear equations. However, a complete description of the state conditional probability density requires a potentially unbounded number of parameters.[3] Attempts to address the first-order approximation shortcomings of the EKF which can lead to instability of the filter are not new.[4, 5, 6, 7, 8, 9] More recent proposed improvements to the EKF have branched out into two areas of research. The two branches offer improved performance against different sources of error.[10] One technique seeks to improve the convergence of the first-order filter by iterating at the measurement update step. These Iterated Extended Kalman Filters (IEKF) reduce the effective measurement noise. As such, they Virginia Space Grant Fellow, Graduate Student. Department of Aerospace & Ocean Engineering, Virginia Polytechnic Institute & State University, Blacksburg, Virginia mavandyk@vt.edu. Student Member AIAA, Student Member AAS. National Science Foundation Fellow, NASA Graduate Student Researcher Program Fellow. Department of Aerospace & Ocean Engineering, Virginia Polytechnic Institute & State University, Blacksburg, Virginia jana@vt.edu. Student Member AIAA, Student Member AAS. Professor. Department of Aerospace & Ocean Engineering, Virginia Polytechnic Institute & State University, Blacksburg, Virginia cdhall@vt.edu. Associate Fellow AIAA, Member AAS. Copyright c 2004 by the authors. Permission to publish granted to The American Astronautical Society. 1

2 can be more tolerant to process noise and errors in initial conditions. Iterating in the measurement step also provides robustness against the first-order approximations of the derivatives.[11, 10] The second family of modified nonlinear filters improve performance by eliminating the Jacobian representation of the derivatives. These filters can yield drastically improved behavior beyond the convergence of the EKF for the same order of floating point operations (flops). Complete coverage of this class of filters, termed the Linear Regression Kalman Filters (LRKF), is beyond the scope of this paper.[12, 13, 14, 3, 15, 16, 10, 17, 18, 19, 20, 21, 22, 23, 2, 24] Some of these techniques have been further enhanced to capitalize on the improvements obtained through iteration in the IEKF and apply similar techniques to these higher-order filters. The Unscented Kalman Filter (UKF), a member of the LRKF family, attempts to remove some of the short-comings of the EKF in the estimation of nonlinear systems. The UKF is an extension of the traditional Kalman Filter for the estimation of nonlinear systems that implements the unscented transformation. The unscented transformation uses a set of sample, or sigma, points that are determined from the a priori mean and covariance of the state. The sigma points undergo the nonlinear transformation. The the posterior mean and covariance of the state are determined from the transformed sigma points.[14] This approach gives the UKF better convergence characteristics and greater accuracy than the EKF for nonlinear systems.[3] The ability of the UKF to accurately estimate nonlinearities makes it attractive for implementation on spacecraft. The state and observation models for spacecraft are inherently nonlinear. The UKF has recently been documented in its application to spacecraft attitude and orbital dynamics; such applications are unusual in a literature dominated by theory papers and neural network applications.[25, 26] The main contribution of this paper is the development of an UKF for the spacecraft dual estimation problem. The UKF dual estimator is tested through numeric simulation of a fully actuated rigid body with attitude sensors that provide two noisy vector measurements and a noisy angular velocity vector measurement. An EKF dual estimator is also developed and is used to gauge the performance of the UKF dual estimator. THE UNSCENTED KALMAN FILTER The UKF was developed with the underlying assumption that approximating a Gaussian distribution is easier than approximating a nonlinear transformation.[14] The UKF uses deterministic sampling to approximate the state distribution as a GRV. The sigma points are chosen to capture the true mean and covariance of the state distribution. The sigma points are propagated through the nonlinear system. The posterior mean and covariance are then calculated from the propagated sigma points. The UKF determines the mean and covariance accurately to the second order, while the EKF is only able to obtain first-order accuracy.[2] Therefore, the UKF provides better state estimates for nonlinear systems. The proceeding summary of the UKF equations follows the presentation by Wan and van der Merwe[2]. The system and measurement noise are assumed to be zero-mean, or additive. The zero-mean noise implementation of the UKF does not require the augmenting of the state vector with the noise variables, thus decreasing the number of points that are required to be propagated through the nonlinear system from 2(L + q) to 2L. State Estimation The filter is initialized with the predicted mean and covariance of the state. } ˆx(t 0 ) E {ˆx 0 { (x(t0 )( ) } T P x0 E ) ˆx 0 x(t0 ) ˆx 0 (1) (2) 2

3 The sigma points are calculated from the a priori mean and covariance of the state using [ ] χ k 1 ˆx k 1 ˆx k 1 + γ P xk 1 ˆx k 1 γ P xk 1 where, γ L + λ. The sigma points are propagated through the nonlinear system χ k k 1 F ( χ k 1, u k 1 ) (3) (4) The posterior mean, ˆx k, and covariance, P x k, are determined from the statistics of the propagated sigma points as follows The weights, W m i ˆx k P x k Wi c and Wi c, are calculated using W m i χ i,k k 1 (5) ( ) ( ) T χ i,k k 1 ˆx k χ i,k k 1 ˆx k (6) W0 m λ L + λ (7) W0 c λ L + λ + 1 α2 + β (8) Wi c Wi m 1 2 (L + λ) (9) The estimated measurement matrix, Υ k k 1, is calculated by transforming the sigma points using the nonlinear measurement model, ) Υ k k 1 H (χ k k 1 (10) The mean measurement, ŷ k, and the measurement covariance, P y k y k, are calculated based on the statistics of the transformed sigma points. ŷ k P yk y k Wi c The cross-correlation covariance, P xk y k, is calculated using P xk x k W m i Υ i,k k 1 (11) Wi c ( Υi,k k 1 ŷ k ) ( Υi,k k 1 ŷ k ) T + Rxk (12) ( χ i,k k 1 ˆx k ) (Υi,k k 1 ŷ ) T k (13) The Kalman gain matrix is approximated from the cross-correlation and measurement covariances using K xk P xk y k P 1 y k y k (14) The measurement update equations used to determine the mean, ˆx k, and covariance, P xk, of the filtered state are ˆx k ˆx k + K ( k yk ŷ ) k (15) P xk P x k K xk P yk y k K T x k (16) 3

4 Parameter Estimation The parameter estimation equations for the UKF are similar to those for the state estimation. This section expounds upon the differences. The filter is initialized with the predicted mean and covariance of the parameters. } ŵ(t 0 ) E {ŵ 0 { (w(t0 )( ) } T P w0 E ) ŵ 0 w(t0 ) ŵ 0 The time update of the parameter vector and the parameter covariance is performed using (17) (18) ŵ k ŵ k 1 (19) P w k P wk 1 + Q wk (20) where, Q w is the system process noise of the time update. The sigma points are calculated from the a priori mean and covariance of the parameters using [ ] Π k 1 ŵ k 1 ŵ k 1 + γ P wk 1 ŵ k 1 γ P wk 1 (21) where, γ L + λ as in the state filter. The expected measurement matrix, Ψ, is determined using the nonlinear measurement model as follows Ψ k k 1 g (Π k 1, u k 1 ) (22) The mean measurement, ˆd k, and the measurement covariance, P dk d k, are calculated based on the statistics of the expected measurements. ˆd k P dk d k Wi c W m i Ψ i,k k 1 (23) (Ψ i,k k 1 ˆd k ) ( Ψ i,k k 1 ˆd k ) T + Rwk (24) The cross-correlation covariance, P wk d k, is calculated using P wk d k Wi c ( Πi,k k 1 ŵ ) ( k Ψ i,k k 1 ˆd ) T k (25) The Kalman gain matrix is approximated from the cross-correlation and measurement covariances using K wk P wk d k P 1 d k d k (26) The measurement update equations are ŵ + k ŵ k + K w k ( d k ˆd k ) (27) P + w k P w k K wk P dk d k K T w k (28) COUPLED SEQUENTIAL PARAMETER ESTIMATION The simultaneous estimation of states and parameters is not a new problem. Techniques particularly applicable to spacecraft applications capitalize on the work done to couple attitude and parameter 4

5 estimation.[27, 28] However, this work produced time-consuming, batch-estimation techniques not desireable for our application. There are two simple extensions that can be applied to any Kalman Filter. These techniques joint and dual filtering use an analogous filter to estimate the parameters concurrently with the states. The joint method is the simpler of the two to conceptualize: the parameter vector of interest is simply appended onto the true state vector. The time-update for the latter portion of the augmented state vector allows no changes beyond the effects of process noise (i.e., the parameters should be constant) but the entire augmented covariance matrix is propagated as one. [12, 29, 11, 30] The dual filtering technique intertwines a pair of distinct sequential filters, one estimating the true states and the other estimating the parameters. [22, 31, 32, 30, 33, 34, 35, 36, 37] The dual filtering technique is investigated in this work. The primary benefit of dual estimation is the ability to temporarily decouple the parameter filter from the state filter as needed. Decoupling can prevent erratic behavior due to poor measurements or initial estimate of the parameter estimation from causing the state filter to diverge. Spacecraft Attitude Dynamics This section provides a brief review of spacecraft attitude dynamics. The attitude of the spacecraft attitude is represented using quaternions, which are defined q [ â T sin ( ) φ 2 ( ) ] T cos φ 2 (29) where, â is the Euler axis and φ is the Euler angle. A benefit of quaternions is that successive rotations can be represented using quaternion multiplication using q a q b q c (30) R( q a ) R( q b )R( q a ) (31) where, R( q) represents the direction cosine matrix associated with q. The vector operator represents the matrix operation a 4 a 3 a 2 a 1 b 1 a b a 3 a 4 a 1 a 2 b 2 a 2 a 1 a 4 a 3 b 3 (32) a 1 a 2 a 3 a 4 b 4 Another useful quaternion identity is the quaternion inverse, q 1, which represents the equal and opposite rotation represented by q, and is defined as The first time derivative of the quaternion is q 1 [ q 1 q 2 q 3 q 4 ] T (33) q 1 2 ω q (34) where, ω [ ω T 0 ] T is the augmented velocity vector, and ω is the angular velocity vector of the spacecraft. The first time derivative of ω is ω I 1 (g ω Iω) (35) where g is the external torque and I is the moment of inertia matrix. 5

6 Spacecraft Dual Unscented Kalman Filter (SDUKF) In this section the development of the specific equations required for the spacecraft UKF dual estimator is presented. The state and parameter estimators are intertwined by the fact that each requires the information generated by the other. State Estimator The three-element error quaternion is used as the attitude representation for the state UKF. Its use requires the addition of several steps to the UKF equations presented earlier, and those steps are described in this section. The use of the error quaternion is prudent because the UKF determines the time update through a weighted average, which in the case of a full four-element quaternion would not always produce a unit quaternion. The error quaternion does not have this constraint.[26] The state vector used by the dual unscented Kalman Filter is x [ δq T ω T ] T (36) where, δq is the three-element error quaternion, which is defined δ q q ˆ q 1 (37) δq [ ] T δq 1 δq 2 δq 3 (38) The state UKF is initialized with ˆx k 1 [ δˆq k 1 ω T k 1 ] T [ ω T k 1 ] T (39) as in Eq. 1. The sigma points are calculated according to Eq. 3, resulting in χ i,k k 1 [ δq σ (i) T ω σ (i) T ] T for i 1,..., 2n + 1 (40) The δq σ are used to determine the four-element sigma point quaternions, q σ, using q σ i (i) [ δq σ (i) T 1 δqσ (i) T δq σ (i) ] T ˆ q for i 1,..., 2n + 1 (41) The sigma points, q σ and ω σ, are propagated numerically using the state space model, q 1 2 ω q ω I 1 (g ω Iω) The propagated δq σ are calculated using Eqs. 37. The attitude state, q σ and ω σ, are used to calculate the expected measurement of each sigma point as defined by the measurement model, Υ i,k k 1 R( qσ )v1 i R( q σ )v2 i (42) ω σ as in Eq. 10. The direction cosine matrix, R, represents the same rotation as q σ and v i is a vector in the inertial reference frame that can measured by an attitude sensor, such as a sun sensor or magnetometer. The mean expected measurement is calculated using Eq. 12. The measurement update of the state and its covariance follow Eqs. 15 and 16, result in ˆx + k [ δˆq + k ω + ] k. The estimated four-element quaternion can now be determined using ˆ q + k [ δˆq + k 1 [δˆq + k ]T δˆq + k ] ˆ q k 1 (43) 6

7 Parameter Estimator The spacecraft parameter UKF does not require all of the additional intermediate steps required by the state filter. The parameter vector is w [ I 11 I 22 I 33 I 12 I 13 I 23 ] T (44) where I 11, I 22, and I 33 are the second moments of inertia, and I 12, I 13, and I 23 are the products of inertia. The time update is performed using Eqs. 19 and 20. The sigma points are calculated using Eq. 21. The expected measurements are formed by numerically propagating the state space model, Eqs. 34 and 35, using the parameter sigma points, Υ i,k k 1, and the state estimate from the previous iteration provided by the state estimator. The expected measurement is calculated using Eq. 23. The current state estimate from the state estimator is the current measurement, d k ˆx k. The measurement update of the parameters and their covariance is then performed using Eqs. 27 and 28. The updated estimate of the parameters is then feed back into the state estimator for the next iteration of the SDUKF. Figure 1: The percent absolute error of the inertia parameters for the UKF with differing errors in the angular velocity measuremnts. SIMULATION RESULTS The dual UKF developed in the previous section was tested through numeric simulation. The results from a dual EKF are also included to provide a baseline for comparison with the dual UKF. A truth model was created by propagating the state space model for the duration of the simulation. Two vector measurements and three angular rate measurements were calculated based on the truth model. Noise was added to the exact measurements to simulate a real-world sensor. Many simulation 7

8 Figure 2: The percent absolute error of the inertia parameters for the UKF with differing initial inertia errors. runs were performed to determine trends in the performance of the UKF for various initial state and parameter estimates and measurement noise levels. The state estimation results are not presented graphically. However, in all of the simulation runs where the parameters did not diverge the angular velocity and the attitude were determined to within the lowest noise value. The dual UKF did not diverge in any of the simulation runs, while the dual EKF did diverge in several simulation runs. Figure 1 depicts the variation in the performance of the dual UKF in the presence of different angular velocity measurement noise levels. All of the other simulation parameters were held constant. The percent error in the inertia is determine using % Error w estimated w exact w exact 100 (45) As expected, the dual UKF was able to better estimate the parameters when the measurement were less noisy, and the estimates converged in each case. The variation in the performance of the dual UKF using different initial errors in the parameters is shown in Figure 2. The dual UKF was able to converge in each simulation run, which is especially impressive in the case of 69.7% error (the dotted curve). The dual EKF, in stark comparison to the dual UKF, was unable to converge in any case where the initial inertia estimate was more than 11.4% off the actual value. Three families of curves are depicted in Figrue 3. In the bottom two plots, the dual EKF parameter estimate is shown to diverge seriously from the actual value, likely due to the poor initial estimates (32.8% and 69.7%) of the parameters used in those simulation runs. The top plot in the figure shows the simulation runs in which the dual EKF s parameter estimate began to converge to the actual value. The two most successful dual EKF simulation runs are compared to the corresponding dual UKF simulation runs in Figure 4. The solid curves show the performance of the dual UKF and the dotted curves show the performance of the dual EKF. The dual UKF converges to a lower error value than 8

9 Figure 3: The percent absolute error of the inertia parameters for the EKF with differing initial inertia errors. Figure 4: A comparison of the performance of the UKF and the EKF. 9

10 the dual EKF in both cases, although only slightly the simulation using the lowest noise value. The ability of the EKF to keep up with the UKF in that simulation is likely due to the fact that a small initial parameter error and low noise measurements were used. Both conditions would decrease the error caused by truncating the higher order terms as in the EKF. Conclusions A dual unscented Kalman Filter was developed in an attempt to solve the spacecraft dual estimation problem. The theoretical background and motivations of the UKF were briefly discussed. The DUKF was tested through numeric simulation, using simulated noisy measurements. The results from a dual EKF were shown to provide a baseline comparison. The UKF was shown to consistently outperform the EKF. The UKF was able to converge with poor initial estimates of the parameters, while the EKF was shown to have a greater tendency to diverge due to poor initial estimates of the parameters. 10

11 REFERENCES [1] R. E. Kalman, A New Approach to Linear Filtering and Prediction Problems, Transactions of the ASME Journal of Basic Engineering, D, vol. 82, pp , [2] E. A. Wan and R. van der Merwe, Kalman Filtering and Neural Networks, ch. 7, The Unscented Kalman Filter. Wiley, September [3] S. J. Julier and J. K. Uhlmann, A New Extension of the Kalman Filter to Nonlinear Systems, in Proceedings of the SPIE AeroSense International Symposium on Aerospace/Defense Sensing, Simulation and Controls, (Orlando, Florida), April 20 25, [4] R. Kalman and R. Bucy, New Results in Linear Filtering and Prediction Theory, Transactions of the ASME Journal of Basic Engineering, D, vol. 83, pp , March [5] R. Bucy, Nonlinear Filtering Theory, IEEE Transactions on Automatic Control, vol. AC-10, p. 198, April [6] M. Athans, R. P. Wishner, and A. Bertolini, Suboptimal State Estimation for Continuous- Time Nonlinear Systems from Discrete Noisy Measurements, IEEE Transactions on Automatic Control, vol. 13, October [7] R. Bass, V. Norum, and L. Schwartz, Optimal Multichannel Nonlinear Filtering, Journal of Mathematical Analysis and Applications, vol. 16, pp , [8] H. Kushner, Dynamical Equations for Optimal Nonlinear Filtering, Journal of Differential Equations, vol. 3, pp , [9] H. Kushner, Approximations to Optimal Non-Linear Filters, in Proceedings of the IEEE Joint Automatic Control Conference, pp , June [10] T. Lefebvre, H. Bruyninckx, and J. D. Schutter, Kalman Filters for Nonlinear Systems: A Comparison of Performance, Internal Report 01R033, Department of Mechanical Engineering, Katholieke Universiteit, Leuven, Belgium, October Submitted as Regular Paper to IEEE Transactions on Automatic Control, October [11] A. Gelb, ed., Applied Optimal Estimation. The M.I.T. Press, [12] J. L. Crassidis and J. L. Junkins, Optimal Estimation of Dynamic Systems. Boca Raton, Florida: CRC Press, to be published [13] S. J. Julier, J. K. Uhlmann, and H. F. Durrant-Whyte, A New Approach for Filtering Nonlinear Systems, in Proceedings of the American Control Conference, vol. 3, pp , June [14] S. J. Julier and J. K. Uhlmann, A General Method for Approximating Nonlinear Transformations of Probability Distributions, tech. rep., Robotics Research Group, Department of Engineering Science, University of Oxford, [15] S. J. Julier and J. K. Uhlmann, A Non-divergent Estimation Algorithm in the Presence of Unknown Correlations, in Proceedings of the American Control Conference, vol. 4, (Albuquerque, New Mexico), pp , June 4 6, [16] S. J. Julier, The Scaled Unscented Transformation, in Proceedings of the American Control Conference, vol. 6, pp , [17] T. Lefebvre, H. Bruyninckx, and J. D. Schutter, A Non-Minimal State Kalman Filter for Nonlinear Parameter Estimation Applied to Autonomous Compliant Motion, in Proceedings of the IEEE International Conference on Robotics and Automation, (Taipei, Taiwan), May 12 17,

12 [18] M. Nørgaard, N. K. Poulsen, and O. Ravn, Advances in Derivative-Free State Estimation for Nonlinear Systems, Tech. Rep. IMM-REP , Technical University of Denmark, 2800 Lyngby, Denmark, April 7, [19] M. Nørgaard, N. K. Poulsen, and O. Ravn, New Developments in State Estimation for Nonlinear Systems, Automatica, vol. 36, pp , [20] T. S. Schei, A Finite-Difference Method for Linearization in Nonlinear Estimation Algorithms, Automatica, vol. 33, no. 11, pp , [21] E. A. Wan and R. van der Merwe, The Unscented Kalman Filter for Nonlinear Estimation, in Proceedings of the IEEE Symposium 2000: Adaptive Systems for Signal Processing, Communications, and Control, (Lake Louise, Alberta, Canada), October 1 4, [22] E. A. Wan, R. van der Merwe, and A. T. Nelson, Advances in Neural Information Processing Systems 12, ch. Dual Estimation and the Unscented Transformation, pp MIT Press, [23] R. van der Merwe and E. A. Wan, Efficient Derivative-Free Kalman Filters for Online Learning, in Proceedings of European Symposium on Artificial Neural Networks, (Bruges, Belgium), April [24] R. L. Bellaire, E. W. Kamen, and S. M. Zabin, A New Nonlinear Iterated Filter with Applications to Target Tracking, in Proceedings of the International Society for Optical Engineering (SPIE) Conference on Signal and Data Processing of Small Targets, vol. 2561, pp , [25] D.-J. Lee and K. T. Alfriend, Precise Real-Time Orbit Estimation Using the Unscented Kalman Filter, in Proceedings of the 13 th AAS/AIAA Space Flight Mechanics Winter Meeting, no , (Ponce, Puerto Rico), February 9 13, [26] J. L. Crassidis and F. L. Markley, Unscented Filtering for Spacecraft Attitude Estimation, Journal of Guidance, Control, and Dynamics, vol. 26, July August [27] F. L. Markley, Attitude Determination and Parameter Estimation Using Vector Observations: Theory, Journal of the Astronautical Sciences, vol. 37, pp , January March [28] F. L. Markley, Attitude Determination and Parameter Estimation Using Vector Observations: Application, Journal of the Astronautical Sciences, vol. 39, pp , July September [29] R. F. Stengel, Optimal Control and Estimation. Dover Publications, Inc., September [30] A. T. Nelson, Nonlinear Estimation and Modeling of Noisy Time-Series by Dual Kalman Filtering Methods, Doctor of Philosopy, Oregon Graduate Institute of Science and Technology, September [31] E. A. Wan and A. T. Nelson, Kalman Filtering and Neural Networks, ch. 5, Dual Extended Kalman Filter Methods. Wiley, September [32] S. Haykin, ed., Kalman Filtering and Neural Netowrks. John Wiley & Sons, Inc., [33] A. T. Nelson and E. A. Wan, A Two-Observation Kalman Framework for Maximum-Likelihood Modelling of Noisy Time Series, in Proceedings of the IEEE Interational Joint Conference on Neural Networks, pp , [34] L. W. Nelson and E. Stear, The Simultaneous On-Line Estimation fo Parameters and States in Linear Systems, IEEE Transactions on Automatic Control, vol. AC-21, no. 2, pp ,

13 [35] E. A. Wan and A. T. Nelson, Neural Dual Extended Kalman Filtering: Applications in Speech Enhancement and Monaural Blind Signal Separation, in Proceedings of the IEEE Workshop on Neural Networks for Signal Processing VII, (Florida), September [36] E. A. Wan and A. T. Nelson, Advances in Neural Information Processing Systems 9, ch. Dual Kalman Filtering Methods for Nonlinear Prediction, Smoothing, and Estimation, pp MIT Press, [37] J. L. Schwartz and C. D. Hall, Comparison of System Identification Techniques for a Spherical Air-Bearing Spacecraft Simulator, in Proceedings of the AAS/AIAA Astrodynamics Specialist Conference, no , (Big Sky, Montana), August 3 7,

Introduction to Unscented Kalman Filter

Introduction 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 information

Error analysis of dynamics model for satellite attitude estimation in Near Equatorial Orbit

Error analysis of dynamics model for satellite attitude estimation in Near Equatorial Orbit International Journal of Scientific and Research Publications, Volume 4, Issue 10, October 2014 1 Error analysis of dynamics model for satellite attitude estimation in Near Equatorial Orbit Nor HazaduraHamzah

More information

Dual Estimation and the Unscented Transformation

Dual 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 information

Adaptive Unscented Kalman Filter with Multiple Fading Factors for Pico Satellite Attitude Estimation

Adaptive Unscented Kalman Filter with Multiple Fading Factors for Pico Satellite Attitude Estimation Adaptive Unscented Kalman Filter with Multiple Fading Factors for Pico Satellite Attitude Estimation Halil Ersin Söken and Chingiz Hajiyev Aeronautics and Astronautics Faculty Istanbul Technical University

More information

The Scaled Unscented Transformation

The Scaled Unscented Transformation The Scaled Unscented Transformation Simon J. Julier, IDAK Industries, 91 Missouri Blvd., #179 Jefferson City, MO 6519 E-mail:sjulier@idak.com Abstract This paper describes a generalisation of the unscented

More information

ROBUST CONSTRAINED ESTIMATION VIA UNSCENTED TRANSFORMATION. Pramod Vachhani a, Shankar Narasimhan b and Raghunathan Rengaswamy a 1

ROBUST CONSTRAINED ESTIMATION VIA UNSCENTED TRANSFORMATION. Pramod Vachhani a, Shankar Narasimhan b and Raghunathan Rengaswamy a 1 ROUST CONSTRINED ESTIMTION VI UNSCENTED TRNSFORMTION Pramod Vachhani a, Shankar Narasimhan b and Raghunathan Rengaswamy a a Department of Chemical Engineering, Clarkson University, Potsdam, NY -3699, US.

More information

Space Surveillance with Star Trackers. Part II: Orbit Estimation

Space Surveillance with Star Trackers. Part II: Orbit Estimation AAS -3 Space Surveillance with Star Trackers. Part II: Orbit Estimation Ossama Abdelkhalik, Daniele Mortari, and John L. Junkins Texas A&M University, College Station, Texas 7783-3 Abstract The problem

More information

Research Article Extended and Unscented Kalman Filtering Applied to a Flexible-Joint Robot with Jerk Estimation

Research Article Extended and Unscented Kalman Filtering Applied to a Flexible-Joint Robot with Jerk Estimation Hindawi Publishing Corporation Discrete Dynamics in Nature and Society Volume 21, Article ID 482972, 14 pages doi:1.1155/21/482972 Research Article Extended and Unscented Kalman Filtering Applied to a

More information

Constrained State Estimation Using the Unscented Kalman Filter

Constrained State Estimation Using the Unscented Kalman Filter 16th Mediterranean Conference on Control and Automation Congress Centre, Ajaccio, France June 25-27, 28 Constrained State Estimation Using the Unscented Kalman Filter Rambabu Kandepu, Lars Imsland and

More information

Nonlinear State Estimation! Particle, Sigma-Points Filters!

Nonlinear State Estimation! Particle, Sigma-Points Filters! Nonlinear State Estimation! Particle, Sigma-Points Filters! Robert Stengel! Optimal Control and Estimation, MAE 546! Princeton University, 2017!! Particle filter!! Sigma-Points Unscented Kalman ) filter!!

More information

A Comparison of the EKF, SPKF, and the Bayes Filter for Landmark-Based Localization

A Comparison of the EKF, SPKF, and the Bayes Filter for Landmark-Based Localization A Comparison of the EKF, SPKF, and the Bayes Filter for Landmark-Based Localization and Timothy D. Barfoot CRV 2 Outline Background Objective Experimental Setup Results Discussion Conclusion 2 Outline

More information

REAL-TIME ATTITUDE-INDEPENDENT THREE-AXIS MAGNETOMETER CALIBRATION

REAL-TIME ATTITUDE-INDEPENDENT THREE-AXIS MAGNETOMETER CALIBRATION REAL-TIME ATTITUDE-INDEPENDENT THREE-AXIS MAGNETOMETER CALIBRATION John L. Crassidis and Ko-Lam Lai Department of Mechanical & Aerospace Engineering University at Buffalo, State University of New Yor Amherst,

More information

Automated Tuning of the Nonlinear Complementary Filter for an Attitude Heading Reference Observer

Automated Tuning of the Nonlinear Complementary Filter for an Attitude Heading Reference Observer Automated Tuning of the Nonlinear Complementary Filter for an Attitude Heading Reference Observer Oscar De Silva, George K.I. Mann and Raymond G. Gosine Faculty of Engineering and Applied Sciences, Memorial

More information

Boost phase tracking with an unscented filter

Boost phase tracking with an unscented filter Boost phase tracking with an unscented filter James R. Van Zandt a a MITRE Corporation, MS-M210, 202 Burlington Road, Bedford MA 01730, USA ABSTRACT Boost phase missile tracking is formulated as a nonlinear

More information

Attitude Determination for NPS Three-Axis Spacecraft Simulator

Attitude Determination for NPS Three-Axis Spacecraft Simulator AIAA/AAS Astrodynamics Specialist Conference and Exhibit 6-9 August 4, Providence, Rhode Island AIAA 4-5386 Attitude Determination for NPS Three-Axis Spacecraft Simulator Jong-Woo Kim, Roberto Cristi and

More information

NONLINEAR BAYESIAN FILTERING FOR STATE AND PARAMETER ESTIMATION

NONLINEAR BAYESIAN FILTERING FOR STATE AND PARAMETER ESTIMATION NONLINEAR BAYESIAN FILTERING FOR STATE AND PARAMETER ESTIMATION Kyle T. Alfriend and Deok-Jin Lee Texas A&M University, College Station, TX, 77843-3141 This paper provides efficient filtering algorithms

More information

Prediction of ESTSP Competition Time Series by Unscented Kalman Filter and RTS Smoother

Prediction of ESTSP Competition Time Series by Unscented Kalman Filter and RTS Smoother Prediction of ESTSP Competition Time Series by Unscented Kalman Filter and RTS Smoother Simo Särkkä, Aki Vehtari and Jouko Lampinen Helsinki University of Technology Department of Electrical and Communications

More information

A NONLINEARITY MEASURE FOR ESTIMATION SYSTEMS

A NONLINEARITY MEASURE FOR ESTIMATION SYSTEMS AAS 6-135 A NONLINEARITY MEASURE FOR ESTIMATION SYSTEMS Andrew J. Sinclair,JohnE.Hurtado, and John L. Junkins The concept of nonlinearity measures for dynamical systems is extended to estimation systems,

More information

On Underweighting Nonlinear Measurements

On Underweighting Nonlinear Measurements On Underweighting Nonlinear Measurements Renato Zanetti The Charles Stark Draper Laboratory, Houston, Texas 7758 Kyle J. DeMars and Robert H. Bishop The University of Texas at Austin, Austin, Texas 78712

More information

Target Localization using Multiple UAVs with Sensor Fusion via Sigma-Point Kalman Filtering

Target Localization using Multiple UAVs with Sensor Fusion via Sigma-Point Kalman Filtering Target Localization using Multiple UAVs with Sensor Fusion via Sigma-Point Kalman Filtering Gregory L Plett, Pedro DeLima, and Daniel J Pack, United States Air Force Academy, USAFA, CO 884, USA This paper

More information

Kalman Filters with Uncompensated Biases

Kalman 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 information

Application of Unscented Transformation for Nonlinear State Smoothing

Application of Unscented Transformation for Nonlinear State Smoothing Application of Unscented Transformation for Nonlinear State Smoothing WANG Xiao-Xu 1 PAN Quan 1 LIANG Yan 1 ZHAO Chun-Hui 1 Abstract Motivated by the well-known fact that the state estimate of a smoother

More information

A comparison of estimation accuracy by the use of KF, EKF & UKF filters

A comparison of estimation accuracy by the use of KF, EKF & UKF filters Computational Methods and Eperimental Measurements XIII 779 A comparison of estimation accurac b the use of KF EKF & UKF filters S. Konatowski & A. T. Pieniężn Department of Electronics Militar Universit

More information

Nonlinear Estimation Techniques for Impact Point Prediction of Ballistic Targets

Nonlinear Estimation Techniques for Impact Point Prediction of Ballistic Targets Nonlinear Estimation Techniques for Impact Point Prediction of Ballistic Targets J. Clayton Kerce a, George C. Brown a, and David F. Hardiman b a Georgia Tech Research Institute, Georgia Institute of Technology,

More information

in a Rao-Blackwellised Unscented Kalman Filter

in a Rao-Blackwellised Unscented Kalman Filter A Rao-Blacwellised Unscented Kalman Filter Mar Briers QinetiQ Ltd. Malvern Technology Centre Malvern, UK. m.briers@signal.qinetiq.com Simon R. Masell QinetiQ Ltd. Malvern Technology Centre Malvern, UK.

More information

Reduced Sigma Point Filters for the Propagation of Means and Covariances Through Nonlinear Transformations

Reduced Sigma Point Filters for the Propagation of Means and Covariances Through Nonlinear Transformations 1 Reduced Sigma Point Filters for the Propagation of Means and Covariances Through Nonlinear Transformations Simon J. Julier Jeffrey K. Uhlmann IDAK Industries 91 Missouri Blvd., #179 Dept. of Computer

More information

Combined Particle and Smooth Variable Structure Filtering for Nonlinear Estimation Problems

Combined Particle and Smooth Variable Structure Filtering for Nonlinear Estimation Problems 14th International Conference on Information Fusion Chicago, Illinois, USA, July 5-8, 2011 Combined Particle and Smooth Variable Structure Filtering for Nonlinear Estimation Problems S. Andrew Gadsden

More information

OPTIMAL ESTIMATION of DYNAMIC SYSTEMS

OPTIMAL ESTIMATION of DYNAMIC SYSTEMS CHAPMAN & HALL/CRC APPLIED MATHEMATICS -. AND NONLINEAR SCIENCE SERIES OPTIMAL ESTIMATION of DYNAMIC SYSTEMS John L Crassidis and John L. Junkins CHAPMAN & HALL/CRC A CRC Press Company Boca Raton London

More information

The Unscented Particle Filter

The Unscented Particle Filter The Unscented Particle Filter Rudolph van der Merwe (OGI) Nando de Freitas (UC Bereley) Arnaud Doucet (Cambridge University) Eric Wan (OGI) Outline Optimal Estimation & Filtering Optimal Recursive Bayesian

More information

Using the Kalman Filter to Estimate the State of a Maneuvering Aircraft

Using 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 information

NON-LINEAR NOISE ADAPTIVE KALMAN FILTERING VIA VARIATIONAL BAYES

NON-LINEAR NOISE ADAPTIVE KALMAN FILTERING VIA VARIATIONAL BAYES 2013 IEEE INTERNATIONAL WORKSHOP ON MACHINE LEARNING FOR SIGNAL PROCESSING NON-LINEAR NOISE ADAPTIVE KALMAN FILTERING VIA VARIATIONAL BAYES Simo Särä Aalto University, 02150 Espoo, Finland Jouni Hartiainen

More information

Linear Feedback Control Using Quasi Velocities

Linear Feedback Control Using Quasi Velocities Linear Feedback Control Using Quasi Velocities Andrew J Sinclair Auburn University, Auburn, Alabama 36849 John E Hurtado and John L Junkins Texas A&M University, College Station, Texas 77843 A novel approach

More information

Extension of the Sparse Grid Quadrature Filter

Extension of the Sparse Grid Quadrature Filter Extension of the Sparse Grid Quadrature Filter Yang Cheng Mississippi State University Mississippi State, MS 39762 Email: cheng@ae.msstate.edu Yang Tian Harbin Institute of Technology Harbin, Heilongjiang

More information

State Estimation of Linear and Nonlinear Dynamic Systems

State Estimation of Linear and Nonlinear Dynamic Systems State Estimation of Linear and Nonlinear Dynamic Systems Part III: Nonlinear Systems: Extended Kalman Filter (EKF) and Unscented Kalman Filter (UKF) James B. Rawlings and Fernando V. Lima Department of

More information

Angular Velocity Determination Directly from Star Tracker Measurements

Angular Velocity Determination Directly from Star Tracker Measurements Angular Velocity Determination Directly from Star Tracker Measurements John L. Crassidis Introduction Star trackers are increasingly used on modern day spacecraft. With the rapid advancement of imaging

More information

Wind-field Reconstruction Using Flight Data

Wind-field Reconstruction Using Flight Data 28 American Control Conference Westin Seattle Hotel, Seattle, Washington, USA June 11-13, 28 WeC18.4 Wind-field Reconstruction Using Flight Data Harish J. Palanthandalam-Madapusi, Anouck Girard, and Dennis

More information

Mixed Control Moment Gyro and Momentum Wheel Attitude Control Strategies

Mixed Control Moment Gyro and Momentum Wheel Attitude Control Strategies AAS03-558 Mixed Control Moment Gyro and Momentum Wheel Attitude Control Strategies C. Eugene Skelton II and Christopher D. Hall Department of Aerospace & Ocean Engineering Virginia Polytechnic Institute

More information

2010 Small Satellite Systems and Services Symposium - Funchal, Madeira, Portugal 1

2010 Small Satellite Systems and Services Symposium - Funchal, Madeira, Portugal 1 INTERACTIONS OF POSE ESTIMATION AND ONLINE DYNAMIC MODELING FOR A SMALL INSPECTOR SPACECRAFT Mishari Alarfaj 1 and Forrest Rogers-Marcovitz 2 1 ECE Dept., Carnegie Mellon University, Pittsburgh, PA, USA,

More information

A Comparitive Study Of Kalman Filter, Extended Kalman Filter And Unscented Kalman Filter For Harmonic Analysis Of The Non-Stationary Signals

A 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 information

Recursive Noise Adaptive Kalman Filtering by Variational Bayesian Approximations

Recursive Noise Adaptive Kalman Filtering by Variational Bayesian Approximations PREPRINT 1 Recursive Noise Adaptive Kalman Filtering by Variational Bayesian Approximations Simo Särä, Member, IEEE and Aapo Nummenmaa Abstract This article considers the application of variational Bayesian

More information

EM-algorithm for Training of State-space Models with Application to Time Series Prediction

EM-algorithm for Training of State-space Models with Application to Time Series Prediction EM-algorithm for Training of State-space Models with Application to Time Series Prediction Elia Liitiäinen, Nima Reyhani and Amaury Lendasse Helsinki University of Technology - Neural Networks Research

More information

Nonlinear and/or Non-normal Filtering. Jesús Fernández-Villaverde University of Pennsylvania

Nonlinear and/or Non-normal Filtering. Jesús Fernández-Villaverde University of Pennsylvania Nonlinear and/or Non-normal Filtering Jesús Fernández-Villaverde University of Pennsylvania 1 Motivation Nonlinear and/or non-gaussian filtering, smoothing, and forecasting (NLGF) problems are pervasive

More information

We are IntechOpen, the world s leading publisher of Open Access books Built by scientists, for scientists. International authors and editors

We are IntechOpen, the world s leading publisher of Open Access books Built by scientists, for scientists. International authors and editors We are IntechOpen, the world s leading publisher of Open Access books Built by scientists, for scientists 3,900 116,000 120M Open access books available International authors and editors Downloads Our

More information

Spacecraft Angular Rate Estimation Algorithms For Star Tracker-Based Attitude Determination

Spacecraft Angular Rate Estimation Algorithms For Star Tracker-Based Attitude Determination AAS 3-191 Spacecraft Angular Rate Estimation Algorithms For Star Tracker-Based Attitude Determination Puneet Singla John L. Crassidis and John L. Junkins Texas A&M University, College Station, TX 77843

More information

Randomized Unscented Kalman Filter in Target Tracking

Randomized Unscented Kalman Filter in Target Tracking Randomized Unscented Kalman Filter in Target Tracking Ondřej Straka, Jindřich Duník and Miroslav Šimandl Department of Cybernetics, Faculty of Applied Sciences, University of West Bohemia, Univerzitní

More information

A New Nonlinear Filtering Method for Ballistic Target Tracking

A New Nonlinear Filtering Method for Ballistic Target Tracking th International Conference on Information Fusion Seattle, WA, USA, July 6-9, 9 A New Nonlinear Filtering Method for Ballistic arget racing Chunling Wu Institute of Electronic & Information Engineering

More information

EKF, UKF. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics

EKF, UKF. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics EKF, UKF Pieter Abbeel UC Berkeley EECS Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics Kalman Filter Kalman Filter = special case of a Bayes filter with dynamics model and sensory

More information

EKF, UKF. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics

EKF, UKF. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics EKF, UKF Pieter Abbeel UC Berkeley EECS Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics Kalman Filter Kalman Filter = special case of a Bayes filter with dynamics model and sensory

More information

Recurrent Neural Network Training with the Extended Kalman Filter

Recurrent Neural Network Training with the Extended Kalman Filter Recurrent Neural Networ raining with the Extended Kalman Filter Peter REBAICKÝ Slova University of echnology Faculty of Informatics and Information echnologies Ilovičova 3, 842 16 Bratislava, Slovaia trebaticy@fiit.stuba.s

More information

SIGMA POINT GAUSSIAN SUM FILTER DESIGN USING SQUARE ROOT UNSCENTED FILTERS

SIGMA POINT GAUSSIAN SUM FILTER DESIGN USING SQUARE ROOT UNSCENTED FILTERS SIGMA POINT GAUSSIAN SUM FILTER DESIGN USING SQUARE ROOT UNSCENTED FILTERS Miroslav Šimandl, Jindřich Duní Department of Cybernetics and Research Centre: Data - Algorithms - Decision University of West

More information

Investigation of the Attitude Error Vector Reference Frame in the INS EKF

Investigation 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 information

Experiment Design for System Identification on Satellite Hardware Demonstrator

Experiment Design for System Identification on Satellite Hardware Demonstrator Experiment Design for System Identification on Satellite Hardware Demonstrator Elias Krantz Space Engineering, master's level 2018 Luleå University of Technology Department of Computer Science, Electrical

More information

A Novel Gaussian Sum Filter Method for Accurate Solution to Nonlinear Filtering Problem

A Novel Gaussian Sum Filter Method for Accurate Solution to Nonlinear Filtering Problem A Novel Gaussian Sum Filter Method for Accurate Solution to Nonlinear Filtering Problem Gabriel Terejanu a Puneet Singla b Tarunraj Singh b Peter D. Scott a Graduate Student Assistant Professor Professor

More information

Tracking an Accelerated Target with a Nonlinear Constant Heading Model

Tracking an Accelerated Target with a Nonlinear Constant Heading Model Tracking an Accelerated Target with a Nonlinear Constant Heading Model Rong Yang, Gee Wah Ng DSO National Laboratories 20 Science Park Drive Singapore 118230 yrong@dsoorgsg ngeewah@dsoorgsg Abstract This

More information

Multiplicative vs. Additive Filtering for Spacecraft Attitude Determination

Multiplicative vs. Additive Filtering for Spacecraft Attitude Determination Multiplicative vs. Additive Filtering for Spacecraft Attitude Determination F. Landis Markley, NASA s Goddard Space Flight Center, Greenbelt, MD, USA Abstract The absence of a globally nonsingular three-parameter

More information

Expectation Propagation in Dynamical Systems

Expectation Propagation in Dynamical Systems Expectation Propagation in Dynamical Systems Marc Peter Deisenroth Joint Work with Shakir Mohamed (UBC) August 10, 2012 Marc Deisenroth (TU Darmstadt) EP in Dynamical Systems 1 Motivation Figure : Complex

More information

AN ADAPTIVE GAUSSIAN SUM FILTER FOR THE SPACECRAFT ATTITUDE ESTIMATION PROBLEM

AN ADAPTIVE GAUSSIAN SUM FILTER FOR THE SPACECRAFT ATTITUDE ESTIMATION PROBLEM AAS 8-262 AN ADAPTIVE GAUSSIAN SUM FILTER FOR THE SPACECRAFT ATTITUDE ESTIMATION PROBLEM Gabriel Terejanu Jemin George and Puneet Singla The present paper is concerned with improving the attitude estimation

More information

A Comparison of Nonlinear Kalman Filtering Applied to Feed forward Neural Networks as Learning Algorithms

A Comparison of Nonlinear Kalman Filtering Applied to Feed forward Neural Networks as Learning Algorithms A Comparison of Nonlinear Kalman Filtering Applied to Feed forward Neural Networs as Learning Algorithms Wieslaw Pietrusziewicz SDART Ltd One Central Par, Northampton Road Manchester M40 5WW, United Kindgom

More information

Autonomous Mobile Robot Design

Autonomous Mobile Robot Design Autonomous Mobile Robot Design Topic: Extended Kalman Filter Dr. Kostas Alexis (CSE) These slides relied on the lectures from C. Stachniss, J. Sturm and the book Probabilistic Robotics from Thurn et al.

More information

Lecture 2: From Linear Regression to Kalman Filter and Beyond

Lecture 2: From Linear Regression to Kalman Filter and Beyond Lecture 2: From Linear Regression to Kalman Filter and Beyond January 18, 2017 Contents 1 Batch and Recursive Estimation 2 Towards Bayesian Filtering 3 Kalman Filter and Bayesian Filtering and Smoothing

More information

Extension of Farrenkopf Steady-State Solutions with Estimated Angular Rate

Extension 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 information

Decentralized Mean Orbit-Element Formation Guidance, Navigation, and Control: Part 1

Decentralized Mean Orbit-Element Formation Guidance, Navigation, and Control: Part 1 Decentralized Mean Orbit-Element Formation Guidance, Navigation, and Control: Part 1 Marcus J. Holzinger and Jay W. McMahon Decentralized relative formation flight about an estimated weighted mean orbit

More information

A Serial Approach to Handling High-Dimensional Measurements in the Sigma-Point Kalman Filter

A Serial Approach to Handling High-Dimensional Measurements in the Sigma-Point Kalman Filter Robotics: Science and Systems 2011 Los Angeles, CA, USA, June 27-30, 2011 A Serial Approach to Handling High-Dimensional Measurements in the Sigma-Point Kalman Filter Colin McManus and Timothy D. Barfoot

More information

Second-Order Divided-Difference Filter Using a Generalized Complex-Step Approximation

Second-Order Divided-Difference Filter Using a Generalized Complex-Step Approximation Second-Order Divided-Difference Filter Using a Generalized Complex-Step Approximation Kok-Lam Lai and John L. Crassidis University at Buffalo, State University of New York, Amherst, NY 46-44 This paper

More information

Using complex numbers for computational purposes is often intentionally avoided because the nonintuitive

Using complex numbers for computational purposes is often intentionally avoided because the nonintuitive Generalizations of the Complex-Step Derivative Approximation Kok-Lam Lai and John L. Crassidis University at Buffalo, State University of New York, Amherst, NY 4-44 This paper presents a general framework

More information

Gaussian Filters for Nonlinear Filtering Problems

Gaussian Filters for Nonlinear Filtering Problems 910 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 45, NO. 5, MAY 2000 Gaussian Filters for Nonlinear Filtering Problems Kazufumi Ito Kaiqi Xiong Abstract In this paper we develop analyze real-time accurate

More information

A new unscented Kalman filter with higher order moment-matching

A new unscented Kalman filter with higher order moment-matching A new unscented Kalman filter with higher order moment-matching KSENIA PONOMAREVA, PARESH DATE AND ZIDONG WANG Department of Mathematical Sciences, Brunel University, Uxbridge, UB8 3PH, UK. Abstract This

More information

Extended Kalman Filter Tutorial

Extended Kalman Filter Tutorial Extended Kalman Filter Tutorial Gabriel A. Terejanu Department of Computer Science and Engineering University at Buffalo, Buffalo, NY 14260 terejanu@buffalo.edu 1 Dynamic process Consider the following

More information

Unscented Filtering for Spacecraft Attitude Estimation

Unscented Filtering for Spacecraft Attitude Estimation See discussions, stats, and author profiles for this publication at: https://www.researchgate.net/publication/874407 Unscented Filtering for Spacecraft Attitude Estimation Article in Journal of Guidance

More information

Lecture 2: From Linear Regression to Kalman Filter and Beyond

Lecture 2: From Linear Regression to Kalman Filter and Beyond Lecture 2: From Linear Regression to Kalman Filter and Beyond Department of Biomedical Engineering and Computational Science Aalto University January 26, 2012 Contents 1 Batch and Recursive Estimation

More information

Thrust acceleration estimation using an on-line non-linear recursive least squares algorithm

Thrust acceleration estimation using an on-line non-linear recursive least squares algorithm 7 Thrust acceleration estimation using an on-line non-linear recursive least squares algorithm N Ghahramani, A Naghash 2, and F Towhidkhah 2 Department of Aerospace Engineering, Amirkabir University of

More information

A KALMAN FILTERING TUTORIAL FOR UNDERGRADUATE STUDENTS

A KALMAN FILTERING TUTORIAL FOR UNDERGRADUATE STUDENTS A KALMAN FILTERING TUTORIAL FOR UNDERGRADUATE STUDENTS Matthew B. Rhudy 1, Roger A. Salguero 1 and Keaton Holappa 2 1 Division of Engineering, Pennsylvania State University, Reading, PA, 19610, USA 2 Bosch

More information

1 Kalman Filter Introduction

1 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 information

Partitioned Update Kalman Filter

Partitioned Update Kalman Filter Partitioned Update Kalman Filter MATTI RAITOHARJU ROBERT PICHÉ JUHA ALA-LUHTALA SIMO ALI-LÖYTTY In this paper we present a new Kalman filter extension for state update called Partitioned Update Kalman

More information

Optimal Fault-Tolerant Configurations of Thrusters

Optimal Fault-Tolerant Configurations of Thrusters Optimal Fault-Tolerant Configurations of Thrusters By Yasuhiro YOSHIMURA ) and Hirohisa KOJIMA, ) ) Aerospace Engineering, Tokyo Metropolitan University, Hino, Japan (Received June st, 7) Fault tolerance

More information

ONLINE PARAMETER ESTIMATION APPLIED TO MIXED CONDUCTION/RADIATION. A Thesis TEJAS JAGDISH SHAH

ONLINE PARAMETER ESTIMATION APPLIED TO MIXED CONDUCTION/RADIATION. A Thesis TEJAS JAGDISH SHAH ONLINE PARAMETER ESTIMATION APPLIED TO MIXED CONDUCTION/RADIATION A Thesis by TEJAS JAGDISH SHAH Submitted to the Office of Graduate Studies of Texas A&M University in partial fulfillment of the requirements

More information

Computers and Chemical Engineering

Computers and Chemical Engineering Computers and Chemical Engineering 33 (2009) 13861401 Contents lists available at ScienceDirect Computers and Chemical Engineering journal homepage: www.elsevier.com/locate/compchemeng Constrained nonlinear

More information

Linear and Nonlinear State Estimation in the Czochralski Process

Linear and Nonlinear State Estimation in the Czochralski Process Linear and Nonlinear State Estimation in the Czochralski Process Parsa Rahmanpour John Atle Bones Morten Hovd Jan Tommy Gravdahl Dept. of Engineering Cybernetics, Norwegian Univ. of Science and Technology

More information

Attitude Determination Methods Using Pseudolite Signal Phase Measurements

Attitude Determination Methods Using Pseudolite Signal Phase Measurements Attitude Determination Methods Using Pseudolite Signal Phase Measurements Keunjoo Park Senior Researcher, Communication Satellite Systems Dept., COMS Program Office Korea Aerospace Research Institute,

More information

RELATIVE ATTITUDE DETERMINATION FROM PLANAR VECTOR OBSERVATIONS

RELATIVE ATTITUDE DETERMINATION FROM PLANAR VECTOR OBSERVATIONS (Preprint) AAS RELATIVE ATTITUDE DETERMINATION FROM PLANAR VECTOR OBSERVATIONS Richard Linares, Yang Cheng, and John L. Crassidis INTRODUCTION A method for relative attitude determination from planar line-of-sight

More information

Simultaneous 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 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 information

RECURSIVE OUTLIER-ROBUST FILTERING AND SMOOTHING FOR NONLINEAR SYSTEMS USING THE MULTIVARIATE STUDENT-T DISTRIBUTION

RECURSIVE OUTLIER-ROBUST FILTERING AND SMOOTHING FOR NONLINEAR SYSTEMS USING THE MULTIVARIATE STUDENT-T DISTRIBUTION 1 IEEE INTERNATIONAL WORKSHOP ON MACHINE LEARNING FOR SIGNAL PROCESSING, SEPT. 3 6, 1, SANTANDER, SPAIN RECURSIVE OUTLIER-ROBUST FILTERING AND SMOOTHING FOR NONLINEAR SYSTEMS USING THE MULTIVARIATE STUDENT-T

More information

Nonlinear State Estimation! Extended Kalman Filters!

Nonlinear State Estimation! Extended Kalman Filters! Nonlinear State Estimation! Extended Kalman Filters! Robert Stengel! Optimal Control and Estimation, MAE 546! Princeton University, 2017!! Deformation of the probability distribution!! Neighboring-optimal

More information

Ground Moving Target Parameter Estimation for Stripmap SAR Using the Unscented Kalman Filter

Ground Moving Target Parameter Estimation for Stripmap SAR Using the Unscented Kalman Filter Ground Moving Target Parameter Estimation for Stripmap SAR Using the Unscented Kalman Filter Bhashyam Balaji, Christoph Gierull and Anthony Damini Radar Sensing and Exploitation Section, Defence Research

More information

Spacecraft Attitude Control with RWs via LPV Control Theory: Comparison of Two Different Methods in One Framework

Spacecraft Attitude Control with RWs via LPV Control Theory: Comparison of Two Different Methods in One Framework Trans. JSASS Aerospace Tech. Japan Vol. 4, No. ists3, pp. Pd_5-Pd_, 6 Spacecraft Attitude Control with RWs via LPV Control Theory: Comparison of Two Different Methods in One Framework y Takahiro SASAKI,),

More information

Information Formulation of the UDU Kalman Filter

Information Formulation of the UDU Kalman Filter Information Formulation of the UDU Kalman Filter Christopher D Souza and Renato Zanetti 1 Abstract A new information formulation of the Kalman filter is presented where the information matrix is parameterized

More information

ROBOTICS 01PEEQW. Basilio Bona DAUIN Politecnico di Torino

ROBOTICS 01PEEQW. Basilio Bona DAUIN Politecnico di Torino ROBOTICS 01PEEQW Basilio Bona DAUIN Politecnico di Torino Probabilistic Fundamentals in Robotics Gaussian Filters Course Outline Basic mathematical framework Probabilistic models of mobile robots Mobile

More information

ON MODEL SELECTION FOR STATE ESTIMATION FOR NONLINEAR SYSTEMS. Robert Bos,1 Xavier Bombois Paul M. J. Van den Hof

ON MODEL SELECTION FOR STATE ESTIMATION FOR NONLINEAR SYSTEMS. Robert Bos,1 Xavier Bombois Paul M. J. Van den Hof ON MODEL SELECTION FOR STATE ESTIMATION FOR NONLINEAR SYSTEMS Robert Bos,1 Xavier Bombois Paul M. J. Van den Hof Delft Center for Systems and Control, Delft University of Technology, Mekelweg 2, 2628 CD

More information

MODELLING ANALYSIS & DESIGN OF DSP BASED NOVEL SPEED SENSORLESS VECTOR CONTROLLER FOR INDUCTION MOTOR DRIVE

MODELLING ANALYSIS & DESIGN OF DSP BASED NOVEL SPEED SENSORLESS VECTOR CONTROLLER FOR INDUCTION MOTOR DRIVE International Journal of Advanced Research in Engineering and Technology (IJARET) Volume 6, Issue 3, March, 2015, pp. 70-81, Article ID: IJARET_06_03_008 Available online at http://www.iaeme.com/ijaret/issues.asp?jtypeijaret&vtype=6&itype=3

More information

Fault Detection and Diagnosis of an Electrohydrostatic Actuator Using a Novel Interacting Multiple Model Approach

Fault Detection and Diagnosis of an Electrohydrostatic Actuator Using a Novel Interacting Multiple Model Approach 2011 American Control Conference on O'Farrell Street, San Francisco, CA, USA June 29 - July 01, 2011 Fault Detection and Diagnosis of an Electrohydrostatic Actuator Using a Novel Interacting Multiple Model

More information

A Close Examination of Multiple Model Adaptive Estimation Vs Extended Kalman Filter for Precision Attitude Determination

A Close Examination of Multiple Model Adaptive Estimation Vs Extended Kalman Filter for Precision Attitude Determination A Close Examination of Multiple Model Adaptive Estimation Vs Extended Kalman Filter for Precision Attitude Determination Quang M. Lam LexerdTek Corporation Clifton, VA 4 John L. Crassidis University at

More information

Unscented Transformation of Vehicle States in SLAM

Unscented Transformation of Vehicle States in SLAM Unscented Transformation of Vehicle States in SLAM Juan Andrade-Cetto, Teresa Vidal-Calleja, and Alberto Sanfeliu Institut de Robòtica i Informàtica Industrial, UPC-CSIC Llorens Artigas 4-6, Barcelona,

More information

ATTITUDE CONTROL INVESTIGATION USING SPACECRAFT HARDWARE-IN-THE-LOOP SIMULATOR

ATTITUDE CONTROL INVESTIGATION USING SPACECRAFT HARDWARE-IN-THE-LOOP SIMULATOR ATTITUDE CONTROL INVESTIGATION USING SPACECRAFT HARDWARE-IN-THE-LOOP SIMULATOR Scott A. Kowalchuk Advisor: Dr. Christopher D. Hall Department of Aerospace and Ocean Engineering Virginia Polytechnic Institute

More information

Efficient Monitoring for Planetary Rovers

Efficient Monitoring for Planetary Rovers International Symposium on Artificial Intelligence and Robotics in Space (isairas), May, 2003 Efficient Monitoring for Planetary Rovers Vandi Verma vandi@ri.cmu.edu Geoff Gordon ggordon@cs.cmu.edu Carnegie

More information

MEETING ORBIT DETERMINATION REQUIREMENTS FOR A SMALL SATELLITE MISSION

MEETING ORBIT DETERMINATION REQUIREMENTS FOR A SMALL SATELLITE MISSION MEETING ORBIT DETERMINATION REQUIREMENTS FOR A SMALL SATELLITE MISSION Adonis Pimienta-Peñalver, Richard Linares, and John L. Crassidis University at Buffalo, State University of New York, Amherst, NY,

More information

9 Multi-Model State Estimation

9 Multi-Model State Estimation Technion Israel Institute of Technology, Department of Electrical Engineering Estimation and Identification in Dynamical Systems (048825) Lecture Notes, Fall 2009, Prof. N. Shimkin 9 Multi-Model State

More information

ZEROS OF MODAL MODELS OF FLEXIBLE STRUCTURES

ZEROS OF MODAL MODELS OF FLEXIBLE STRUCTURES ZEROS OF MODAL MODELS OF FLEXIBLE STRUCTURES by Douglas K. Lindner Bradley Department of Electrical Engineering Virginia Tech Blacksburg, VA 461 (73) 31-458 email:lindner@vtvm1.cc.vt.edu Corresponding

More information

State Estimation for Nonlinear Systems using Restricted Genetic Optimization

State Estimation for Nonlinear Systems using Restricted Genetic Optimization State Estimation for Nonlinear Systems using Restricted Genetic Optimization Santiago Garrido, Luis Moreno, and Carlos Balaguer Universidad Carlos III de Madrid, Leganés 28911, Madrid (Spain) Abstract.

More information

Comparison of Kalman Filter Estimation Approaches for State Space Models with Nonlinear Measurements

Comparison of Kalman Filter Estimation Approaches for State Space Models with Nonlinear Measurements Comparison of Kalman Filter Estimation Approaches for State Space Models with Nonlinear Measurements Fredri Orderud Sem Sælands vei 7-9, NO-7491 Trondheim Abstract The Etended Kalman Filter (EKF) has long

More information

Extended Kalman Filter for Spacecraft Pose Estimation Using Dual Quaternions*

Extended Kalman Filter for Spacecraft Pose Estimation Using Dual Quaternions* Extended Kalman Filter for Spacecraft Pose Estimation Using Dual Quaternions* Nuno Filipe Michail Kontitsis 2 Panagiotis Tsiotras 3 Abstract Based on the highly successful Quaternion Multiplicative Extended

More information