Novel approach to nonlinear/non- Gaussian Bayesian state estimation N.J Gordon, D.J. Salmond and A.F.M. Smith Presenter: Tri Tran 7-2005.

Slides:



Advertisements
Similar presentations
State Estimation and Kalman Filtering CS B659 Spring 2013 Kris Hauser.
Advertisements

CSCE643: Computer Vision Bayesian Tracking & Particle Filtering Jinxiang Chai Some slides from Stephen Roth.
(Includes references to Brian Clipp
Observers and Kalman Filters
Visual Recognition Tutorial
Particle Filters.
Particle Filters Pieter Abbeel UC Berkeley EECS Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics TexPoint fonts used in EMF. Read.
Stanford CS223B Computer Vision, Winter 2007 Lecture 12 Tracking Motion Professors Sebastian Thrun and Jana Košecká CAs: Vaibhav Vaish and David Stavens.
CS 547: Sensing and Planning in Robotics Gaurav S. Sukhatme Computer Science Robotic Embedded Systems Laboratory University of Southern California
Adaptive Rao-Blackwellized Particle Filter and It’s Evaluation for Tracking in Surveillance Xinyu Xu and Baoxin Li, Senior Member, IEEE.
A brief Introduction to Particle Filters
Sérgio Pequito Phd Student
Nonlinear and Non-Gaussian Estimation with A Focus on Particle Filters Prasanth Jeevan Mary Knox May 12, 2006.
Prepared By: Kevin Meier Alok Desai
Comparative survey on non linear filtering methods : the quantization and the particle filtering approaches Afef SELLAMI Chang Young Kim.
Probabilistic Robotics Bayes Filter Implementations Particle filters.
Stanford CS223B Computer Vision, Winter 2007 Lecture 12 Tracking Motion Professors Sebastian Thrun and Jana Košecká CAs: Vaibhav Vaish and David Stavens.
Darryl MorrellStochastic Modeling Seminar1 Particle Filtering.
Particle Filtering for Non- Linear/Non-Gaussian System Bohyung Han
Estimation and the Kalman Filter David Johnson. The Mean of a Discrete Distribution “I have more legs than average”
© 2003 by Davi GeigerComputer Vision November 2003 L1.1 Tracking We are given a contour   with coordinates   ={x 1, x 2, …, x N } at the initial frame.
Sampling Methods for Estimation: An Introduction
Tracking with Linear Dynamic Models. Introduction Tracking is the problem of generating an inference about the motion of an object given a sequence of.
An introduction to Particle filtering
Bayesian Filtering for Robot Localization
Muhammad Moeen YaqoobPage 1 Moment-Matching Trackers for Difficult Targets Muhammad Moeen Yaqoob Supervisor: Professor Richard Vinter.
Tracking Pedestrians Using Local Spatio- Temporal Motion Patterns in Extremely Crowded Scenes Louis Kratz and Ko Nishino IEEE TRANSACTIONS ON PATTERN ANALYSIS.
1 Miodrag Bolic ARCHITECTURES FOR EFFICIENT IMPLEMENTATION OF PARTICLE FILTERS Department of Electrical and Computer Engineering Stony Brook University.
1 Mohammed M. Olama Seddik M. Djouadi ECE Department/University of Tennessee Ioannis G. PapageorgiouCharalambos D. Charalambous Ioannis G. Papageorgiou.
Markov Localization & Bayes Filtering
Object Tracking using Particle Filter
Computer vision: models, learning and inference Chapter 19 Temporal models.
System Identification of Nonlinear State-Space Battery Models
From Bayesian Filtering to Particle Filters Dieter Fox University of Washington Joint work with W. Burgard, F. Dellaert, C. Kwok, S. Thrun.
SIS Sequential Importance Sampling Advanced Methods In Simulation Winter 2009 Presented by: Chen Bukay, Ella Pemov, Amit Dvash.
Computer vision: models, learning and inference Chapter 19 Temporal models.
Simultaneous Localization and Mapping Presented by Lihan He Apr. 21, 2006.
Kalman Filter (Thu) Joon Shik Kim Computational Models of Intelligence.
Jamal Saboune - CRV10 Tutorial Day 1 Bayesian state estimation and application to tracking Jamal Saboune VIVA Lab - SITE - University.
Computer Vision - A Modern Approach Set: Tracking Slides by D.A. Forsyth The three main issues in tracking.
Probabilistic Robotics Bayes Filter Implementations.
Computer Science, Software Engineering & Robotics Workshop, FGCU, April 27-28, 2012 Fault Prediction with Particle Filters by David Hatfield mentors: Dr.
Overview Particle filtering is a sequential Monte Carlo methodology in which the relevant probability distributions are iteratively estimated using the.
Karman filter and attitude estimation Lin Zhong ELEC424, Fall 2010.
Mixture Models, Monte Carlo, Bayesian Updating and Dynamic Models Mike West Computing Science and Statistics, Vol. 24, pp , 1993.
Forward-Scan Sonar Tomographic Reconstruction PHD Filter Multiple Target Tracking Bayesian Multiple Target Tracking in Forward Scan Sonar.
Mobile Robot Localization (ch. 7)
Processing Sequential Sensor Data The “John Krumm perspective” Thomas Plötz November 29 th, 2011.
ISOMAP TRACKING WITH PARTICLE FILTER Presented by Nikhil Rane.
An Introduction to Kalman Filtering by Arthur Pece
Boosted Particle Filter: Multitarget Detection and Tracking Fayin Li.
Sequential Monte-Carlo Method -Introduction, implementation and application Fan, Xin
Mixture Kalman Filters by Rong Chen & Jun Liu Presented by Yusong Miao Dec. 10, 2003.
An Introduction To The Kalman Filter By, Santhosh Kumar.
Short Introduction to Particle Filtering by Arthur Pece [ follows my Introduction to Kalman filtering ]
OBJECT TRACKING USING PARTICLE FILTERS. Table of Contents Tracking Tracking Tracking as a probabilistic inference problem Tracking as a probabilistic.
Kalman Filtering And Smoothing
Tracking with dynamics
Nonlinear State Estimation
The Unscented Particle Filter 2000/09/29 이 시은. Introduction Filtering –estimate the states(parameters or hidden variable) as a set of observations becomes.
CS Statistical Machine learning Lecture 25 Yuan (Alan) Qi Purdue CS Nov
Colorado Center for Astrodynamics Research The University of Colorado 1 STATISTICAL ORBIT DETERMINATION Kalman Filter with Process Noise Gauss- Markov.
Probabilistic Robotics Bayes Filter Implementations Gaussian filters.
Tracking We are given a contour G1 with coordinates G1={x1 , x2 , … , xN} at the initial frame t=1, were the image is It=1 . We are interested in tracking.
Probabilistic Robotics
PSG College of Technology
Introduction to particle filter
Filtering and State Estimation: Basic Concepts
Introduction to particle filter
Particle Filtering.
Presentation transcript:

Novel approach to nonlinear/non- Gaussian Bayesian state estimation N.J Gordon, D.J. Salmond and A.F.M. Smith Presenter: Tri Tran

Outline Motivations Recursive Bayesian estimations Bayesian Bootstrap filter algorithms Evaluations of the algorithms Summary

Motivations In many applications of positioning, navigation and tracking, we want to estimate the position of a moving object at discrete times. Positioning: position of an object is to be estimated when an navigation system is used to provide measurements of movement. Navigation: besides the position also velocity, attitude and heading, accelerating and angular rates are included in the problem. Target tracking: another object’s position is to be estimated based on measurement of relative range and angles to one’s own position.

Motivations (cont.) The problems can be described by state space models where the state vector contains the position and derivatives of the position. Bayesian methods is to construct a probability density function (PDF) of the state based on all the available information. For linear/Gaussian models, the required PDF remains Gaussian at every iteration of the filter, Kalman filter can be used to propagate and update the mean and covariance of the distribution. For nonlinear/non-Gaussian models, there is no general analytic expression for the required PDF  a new way of representing and recursively generating an approximation to the state PDF. Central idea: represent the required PDF as a set of random samples, rather than as a function over state space.

Particle Filters Recursive methods to estimate the dynamic state (a set of random samples) of a moving object in a discrete time nonlinear model based on posterior distributions.

Recursive Bayesian estimation System model x k+1 = f k (x k, w k ) where f k : R n xR m  R n the system transition function w k is white noise sequence of known PDF, independent of past and current states. Measurement model (observation equation) y k = h k (x k, v k ) where h k : R n xR r  R p the system transition function v k is another white noise sequence of known PDF, independent of past and current states. Assume that the initial PDF p(x 1 |D 0 ) of the state vector, the functional forms f i and h i for i=1,…, k are known. At time step k, available information is the set of measurements D k = {y k :i=1,…,k} Need to construct the PDF of the current state x k, given all the available information: p(x k |D k )

Bayesian bootstrap filter A set of random samples {x k-1 (i): i=1,…,N} from the PDF p(x k-1 |D k-1 ). Propagate and update the set of random samples to obtain {x k (i): i=1,…,N} which approximates as p(x k |D k ) Prediction: each sample is passed through the system model to obtain samples from the prior at time step k: x * k (i) = f k-1 (x k-1 (i), w k-1 (i)) Update: with the measurement y k, evaluate a normalized weight for each sample Thus define a discrete distribution over {x* k (i): i=1,…,N} with probability q i associated with element i Resample N times from the discrete distribution to generate samples {x k (i): i=1,…,N}, so that for any j, Pr{x k (j)=x* k (i)} =q i

Bootstrap filter Advantages: no restrictions on the functions f k and h k or on the distributions of the system or measurement noise. Requirements: (a) p(x 1 ) is available for sampling (b) the likelihood p(y k |x k ) is a known functional form (c) p(w k ) is available for sampling The number of random samples N depends on: (a) the dimension of the state space (b) the typical ‘overlap’ between the prior and the likelihood (c) the required number of time steps

Evaluations of the bootstrap filter algorithm One-dimensional nonlinear example Consider the following nonlinear model X k = 0.5x k-1 +25x k-1 /(1+x 2 k- 1 )+8cos(1.2(k-1))+w k Y k =x 2 k /20+v k W k and v k are zero-mean Gaussian white noise with variances 10.0 and 1.0, respectively. K=50, x 0 = 0.1, N=500

Evaluations of the bootstrap filter algorithm Bearings-only tracking example Target moves within the x-y plan: A fixed observer at the origin of the plane takes noisy measurements z k of the target bearing k=24, N=4000, initial state x 1 =(-0.05, 0.001, 0.7, )

Evaluations of the bootstrap filter algorithm Bearings-only tracking example (cont.) The actual co-ordinate value is always within the 95% probability region.

Summary A bootstrap filter for implementing recursive Bayesian filters The method is applied for nonlinear models and approximates the posterior distribution as a set of random samples.

References N.J Gordon, D.J. Salmond and A.F.M. Smith, “Novel approach to nonlinear/non-Gaussian Bayesian state estimation”, in IEE Processinds-F, Vol. 140, Fredrik Gustafsson, Fredrik Gunnarsson, Niclas Bergman, Urban Forssell, Jonas Jansson, Rickard karlsson, Per-Johan Nordlund, “Prticle Filters for Positioning, Navigation and Tracking”, IEEE Transactions on Signal Processing, vol. 50, pp , Feb. 2002