Improved Particle Filtering Based on Biogeography-based Optimization for UGV Navigation
|
|
- Brittany Reynolds
- 5 years ago
- Views:
Transcription
1 Improved Particle Filtering Based on Biogeography-based Optimization for UGV Navigation A. Kuifeng Su 1,2, B. Zhidong Deng 1, and C. Zhen Huang 1 1 Department of Computer Science, State Key Laboratory of Intelligent Technology and Systems, Tsinghua National Laboratory for Information Science and Technology, Tsinghua University, Beijing, China 2 Academy of Armored Force Engineering, Beijing, China Abstract The main challenge with particle filtering is particle degeneracy and the accurate estimation cannot be achieved generally because of serious impoverishment problem, although resampling operation could solve degeneracy to a certain extent. In this paper, we propose an improved particle filtering approach based on biogeography-based optimization (BBO) algorithm, called BBO-, for state estimation of nonlinear and non-gaussian dynamic system. The novel BBO- significantly reduces the degeneracy. The experimental results obtained by applying the BBO- to estimate the trajectory of unmanned ground vehicle validate the performance of our approach. Keywords: Unmanned ground vehicle; Particle filtering; Particle impoverishment; Biogeography-based optimization. 1. Introduction The location of unmanned ground vehicle (UGV) determined according to various types of measurements is critical to UGV navigation. In fact, a variety of location algorithms have considerable difference in accuracy, robustness, and computational efficiency. Particle filtering, which is a method based on random samplings, has advantage of being applied to nonlinear and non-gaussian dynamic systems. But there exist particle degeneracy and difficulty of selecting proposal distribution. To solve particle impoverishment problem, researchers have presented a lot of algorithms such as unscented Kalman particle filter (UK)[1] and Gaussian mixture sum particle filter (GMS)[2]. Many improved algorithms based on intelligent optimizations are also proposed to solve sample impoverishment problem, including particle swarm optimization-based particle filter (PSO-)[3], annealing particle filter (A)[4], genetic particle filter (G)[5], evolutionary particle filter (E)[5], and so on. They are used to tackle the difficulty of selecting proposal distribution. Additionally, there are other hybrid algorithms such as MCMC particle filter, kernel smoothing particle filter, rejection particle filter.[6]. In this paper, we propose an improved particle filtering approach based on biogeography-based optimization (BBO) algorithm, called BBO-, for state estimation of nonlinear and non-gaussian dynamic system. Based on the concept of resampling, particles with high weights have move probability to be propagated, and in the BBO-, some particles will join in the refining process after calculating the weight of particles, which means that those particles will move to the region with high weights. This process can be regarded as migration to the habitat with high suitability of BBO algorithm. Although the BBO operation increases the computing complexity of algorithm, the optimized weights may make the proposal distribution more closed to the poster distribution and overcome the degeneracy of particles. The proposed BBO- algorithm is compared to other several filtering algorithms. The experimental results show that the BBO- has better performance due to their lower means and variances. 2. Problem Description The state and measurement models of the UGV location are built in this section. Our intelligent vehicle platform THIV-I developed by Tsinghua University, the location of various sensors is shown in Fig.1. The position system consists of many on-board sensors, including four ABS speed sensors and steering angle sensors, global position system (GPS), inertia measurement unit (IMU), and environment perception sensor such as lidar and camera, which provide the data of landmark. The information of speed and steering angle can obtained through the CAN bus of the vehicle itself. Meanwhile, the encoders on the rear transmission shafts can be used to obtain the accurate travelled distance during a sample period. The GPS/IMU integrated navigation system working on RTK differential mode provides accurate position reference for performance comparison of different algorithms. 2.1 System model In this paper, the origin of the vehicle body coordinate frame locates at the center of the rear axle, i.e., the installation position of the IMU, whose position is P k (x k, y k ) at the time of t k, and the heading angle is φ k. In 2D environment, the UGV s pose can be expressed by the state vector χ k = (x k, y k, φ k ). The position relation of UGV is shown in Fig. 2. In this figure, H represents a half of distance between two rear wheels, while L indicates the distance between a front axle and a rear axle of UGV.
2 Four Cameras Velodyne HDL-64E GPS Antenna PDL Receiver 2.2 Observation model The system of autonomous vehicle utilizes odometer and the IMU to achieve the estimation of basic position and orientation. In order to overcome the error accumulation caused by the relative positioning system, the system applies the 64-line HDL lidar, which is mounted in the anterior part of middle top of UGV, and the relative position relations with respect to UGV is shown in Fig.3. IBEO ALASCA XT Encoder Fig. 1: Intelligent vehicle of Tsinghua University. H c c c Laser L L L b y Instantaneous Center of position k 1 R PP k k 1 PP k k 1 R fl R f R fr k 1 k 1 k 1 a L Fig. 3: Installation diagram of UGV sensor. Then the relationship that the rear axle center transforms to the lidar centre is described by: x b y b y k k M r x k k k k k 1 Fig. 2: Schematic diagram of the vehicle s kinematics parameter model. P k P k+1 (R + M r /2) φ k+1 = P k P k+1 2(R + M r /2) sin[ φ k+1 /2] = φ k+1/2 sin[ φ k+1 /2] (1) Thus, the linear distance P k P k+1 between P k and P k+1 is derived below: P k P k+1 = sin[ φ k+1/2] φ k+1 /2 P k P k+1 = sin[ φ k+1/2] D k+1 φ k+1 /2 (2) In this formula, D k+1 refers to the travel distance of the back wheel center measured by an encoder. X(k + 1) = where ω k is system noise. x k + P k P k+1 cos [φ k+1 + φ k+1 /2] y k + P k P k+1 sin [φ k+1 + φ k+1 /2] φ k + φ k+1 x + ω k (3) x L = x c + a cos(φ) + b cos(φ + π/2) y L = y c + a sin(φ) + b sin(φ + π/2) The corresponding measurement equation is given by: [» ] (x z k = h (X, x k, y k ) = k x L ) 2 + (y k y L ) 2 atan Ä (y k y L ) +ν k (x k x L )ä φl + π/2 (5) In this formula, z indicates the measurement vector, i.e., the coordinates of landmark, {x k, y k } represents the location of landmark identified by the 3D lidar, and ν k is the measurement noise. 3. BBO- state estimation algorithm 3.1 Biogeography-based optimization According to the island migration model of biogeography, Dan Simon proposed biogeography-based optimization (BBO) in 28[7]. BBO is an evolutionary algorithm (EA) motivated by the optimality perspective of natural biogeography. Suppose that we have a global optimization problem and a population of candidate solutions, which can be represented by vectors of integers, each integer in the solution vector is considered to be a suitability index variable (SIV). The population consists of NP = n solution vectors. Each individual is considered as a habitat with a habitat suitability index (HSI), which is similar to the fitness of EAs, PSO, etc to evaluate individual effectiveness. A good solution means to be an island with a high HSI, and a poor (4)
3 solution indicates an island with a low HSI. The high HSI solutions tend to share their features with low HSI solutions. The low HSI solutions accept a lot of new features from the high HSI solutions. Just as species migrate back and forth between islands, BBO operates by sharing information between individuals in a population of candidate solutions. In BBO, each individual has its own immigration rate λ and emigration rate µ. A good solution has higher µ and lower λ. The immigration rate and the emigration rate are functions of the number of species in the habitat. They can be calculated as follows: µ k = E k n Å λ k = I 1 k ã n where I denotes the maximum possible immigration rate, E the maximum possible emigration rate, k the number of species of the k t h individual, and n the maximum number of species[8]. (6) (7) Select H i with probability based on λ i If H i is selected Select H j with probability based on µ i ; If H j is selected Randomly select an SIV s from H j Replace a random SIV in H i with s; increase diversity among the population. We model this in BBO as SIV mutation, and use species count probabilities to determine mutation rates. Mutation can be described as follows[9]: For j=1 to length of SIVs Select an SIV in H i with probability based on a priori probability m; If H i is selected Replace SIV (H i ) with Randomly generated SIV; The BBO algorithm can be described below[9]. I E rate immigration S Number of species emigration Smax Fig. 4: Linear migration curves for an island. There are two main operators, the migration and the mutation, in BBO. During migrating, each solution shares the information probabilistically between habitats through the emigration rate λ i and immigration rate µ i. We use the immigration rate to probabilistically decide whether or not to modify each suitability index variable (SIV) in that solution. If a given solution H i is selected to be modified, then we use the emigration rates of the other solutions to probabilistically migrate a randomly selected SIV to solution H i. The migration process can be given by[9]: For mutation, the main idea is deduced from the species count in habitat change drastically for cataclysmic events. A habitat s HSI can, therefore, change suddenly due to apparently random events. This mutation scheme tends to 1) Initialize the BBO parameters, including the maximum species count n, the maximum migration rates E and I, and the mutation rate 2) Initialize the random parameter of habitat. 3) For each habitat, HIS is mapped as the number and mobility (λ k, µ k ) of species k. Calculate and determine whether HIS satisfy the supervision condition. If HIS dose not satisfy the supervision condition 4) Utilize the immigration rate and emigration rate to restore the habitat, and then recalculate each HIS. 5) For each habitat, refresh the probability distribution of species, update the species according to mutation operator, and then recalculate the fitness. if 6) the algorithm cycle according to the termination condition. The BBO is also a species optimization algorithm. It is not related to the problems of regeneration and producing next generation, compared to both GA and evolutionary strategy optimization algorithms. There is also a remarkable difference between ACO and BBO. ACO produces a new set of solutions at each of iterations, while BBO maintains the solution set to the next iteration and adjusts the solution space according to the migration probability. BBO has more in common with PSO and DE. Compared to PSO and DE, BBO directly updates by the migration of the solution. Thus, the solutions of BBO algorithm can share properties (suitability index variable, SIVs) with each other. BBO mainly consists of the two processes, including species migration and species variation[6], [7], [8], [9]. 3.2 Adaptive particle filtering algorithm based on BBO The main disadvantage of is the so-called particle impoverishment problem, which is the main reason to take
4 resampling. This problem appears as the likelihood p ( ) y t x i t is very narrow or likelihood lies in the tail of the proposal distribution q Ä x t x (n) t 1, y 1:tä. As the observation is more accurate and the prior distribution is much boarder than the likelihood (shown in Fig.5), only a few particles have weights of significant importance, which directly leads to the particle impoverishment problem. Prior Fig. 5: Prior and Likelihood. Likelihood The proposal algorithm, called BBO-, incorporate the BBO algorithm into to improve the distribution of samples, speed up the convergence of particle sets, and overcome the impoverishment of particle filtering. The purpose is to take samples to move towards regions of the state space where the posterior probability is significant, which is related to the prior probability and likelihood. Thus, a weighted optimization problem arises to balance the contribution of prior probability and likelihood to the posterior probability. The optimization problem can be described as follows: max F (x) = κ 1F 1 (x) + κ 2 F 2 (x) (8) x S where κ 1 and κ 2 are non-negative weight with κ 1 + κ 2 = 1, S is the search space of particle sampling. Thus, the generated samples x i t, i = 1,, N, are regarded as the initial SIV in the BBO and moved to maximize the objective function F (x). Let ω t and v t be zero-mean Gaussian white noise with variances Q and R, respectively. Considering that (3) and (5) are nonlinear model with additive noise, the first objective consists of the function maximized at high prior regions as follows: F 1 = e 1 2 (x k ˆx k )Q 1 (x k ˆx k ) T (9) The second objective comprises the function maximized at high likelihood regions below: F 2 = e 1 2 (y k ŷ k )Q 1 (y k ŷ k ) T (1) Then the objective function of posterior optimization is given by: F (k) = 1 2 κ 1(x k ˆx k )Q 1 (x k ˆx k ) T 1 2 κ 2(y k ŷ k )Q 1 (y k ŷ k ) T The BBO- algorithm can be summarized below: (11) 1.Initialization the particles X = x (i) N, ω(i) from posterior i=1 distribution p(x ) with associated ω (i) = 1 / N 2.Initialize the BBO parameters, including the maximum species count n, the maximum migration rates E and I, and the mutation rate 3.For time steps t = 1, 2,, T 4.Importance Sampling: for i = 1,, N, draw samples from the importance proposal distribution as follows: x (i) t q Ä x t x (n) t 1, y 1:t 1) Consider each particle as a species of universal habitat. 2) For each habitat, HIS is mapped as the number and mobility (λ k, µ k ) of species k. Calculate and determine whether HIS can satisfy the supervision condition. If HIS dose not satisfy the condition of importance distribution 3) Utilize the immigration rate and emigration rate to restore the habitat, and then recalculate each HIS. 4) For each habitat, refresh the probability distribution of species, update the species according to mutation operator, then recalculate the fitness. 5) Weight update: evaluate the importance weights with (11). if 6) the algorithm cycle according to the termination condition. 5. Normalize the importance weights: ω (i) t = ω (i) t N i=1 ω(i) t 6. Output the statics of the particles. 7. Re-sampling: generate N new particles x (i) t from the set according to the importance weights ω (i) N t i=1 Repeat Step 3 to 7. ä x (i) N t i=1 The BBO moves all particles towards the particles with the best fitness where is the region of having the maximum weight particles. As the best fitness value reaches a certain threshold, the optimal sampling process terminates. 4. Experimental results To verify the effectiveness and efficiency of the proposed BBO- algorithm, this paper carried out experiments on urban road. Ideal two-dimensional environments were chosen as the test sites. In addition, the traffic signs stood on both sides of the road as the landmarks that were detected by the lidar. At first, we measured the accurate position of those landmarks using Span/DGPS integrated navigation system from Novatel. At the same time, the exact location of UGV was recorded during our experiment, i.e., χ (x ref, y ref, θ ref ), in order to compare the state estimation results of various algorithms with such an exact location of UGV. The BBO- algorithm proposed in this paper was compared to both standard particle filtering () and unscented particle filtering (U). The ideal reference trajectory provided by SPAN integrated navigation system and the estimation results are shown in Fig.6. Fig.7 and Fig.8 give
5 the comparison of eastward and northward errors, respectively. The experimental results indicated that the estimation accuracy of the proposed BBO- algorithm was greatly improved, compared to that of and U algorithms. The statistical distribution of position errors is shown in Fig.9 and Fig.1, respectively Reference North error(m) North(m) time(s) Fig. 8: Northward deviation comparison East(m) Fig. 6: Comparison of reference trajectory with estimation using, U, and BBO East error(m) Proportion East error(m) 2 3 Fig. 9: Distribution of eastward error time(s) Fig. 7: Eastward deviation comparsion. 5. Conclusions Particle filtering () is sequential Monte Carlo methods based on the particle representation of probability density. It can be applied to nonlinear/non-gaussian system and generalizes Kalman filtering. One of the main disadvantages of is the particle impoverishment problem, which is caused directly by the resampling process of the algorithm. We propose a BBO optimization algorithm to weight the likelihood and the prior for balancing the contribution of prior and likelihood to the posterior estimation. Our experimental results show that the BBO- algorithm can effectively improve the location accuracy of UGVs. In addition, due to Proportion North error(m) Fig. 1: Distribution of northward error.
6 the inherent characteristics of BBO algorithm, its efficiency is higher than other intelligent optimization algorithms such as PSO in solving high-dimensional optimization problems, which has provided a guarantee for real-time application of BBO-. 6. Acknowledgements This work was supported in part by National Natural Science Foundation of China (NSFC) under Grant Nos and 67754, and by the National High-Tech R & D Program of China under Grant No. 211AA411. References [1] Yi. Y, D A.Grejner-Brzezinska, Tightly-coupled GPS/INS integration using unscented Kalman filter and particle filter, in Proceedings of the 19th International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS 26), 21, pp [2] J.H.Kotecha, P.M.Djuric, Gaussian sum particle filtering, IEEE Transactions on Signal Processing., vol. 51, pp , Oct. 23. [3] Y.Hernane, S.Hernane, M.Benyettou, PSO: An Optimised Filtering Approach Based on Sampling, Journal of Applied Sciences., vol. 1, pp , Jun. 21. [4] J.Gall, J.Potthoff, C. Schnörr, B.Rosenhahn, H.P.Seidel, Interacting and annealing particle filters: Mathematics and a recipe for applications, Journal of Mathematical Imaging and Vision., vol. 28, pp. 1 18, Jan. 27. [5] N.M. Kwok,G. Fang, W.Zhou, Evolutionary particle filter: re-sampling from the genetic algorithm perspective, in Intelligent Robots and Systems, 25.(IROS 25), 25, pp [6] Z. Chen. (23). Bayesian filtering: From Kalman filters to particle filters, and beyond. [Online]. Available: jpg/tfc67/chen_bayesian. pdf [7] S. Zhang, C. Zhu, J. K. O. Sin, and P. K. T. Mok, Biogeographybased optimization, IEEE Transactions on Evolutionary Computation., vol. 12, pp , Jun. 28. [8] W.Gong, Z.Cai, C.X.Ling, DE/BBO: a hybrid differential evolution with biogeography-based optimization for global numerical optimization, Soft Computing-A Fusion of Foundations, Methodologies and Applications., vol. 15, pp , Apr. 21. [9] M.Ovreiu, D.Simon, Biogeography-based optimization of neuro-fuzzy system parameters for diagnosis of cardiac disease, in Proceedings of the 12th Annual Conference on Genetic and Evolutionary Computation, 21, pp
PATTERN RECOGNITION AND MACHINE LEARNING CHAPTER 13: SEQUENTIAL DATA
PATTERN RECOGNITION AND MACHINE LEARNING CHAPTER 13: SEQUENTIAL DATA Contents in latter part Linear Dynamical Systems What is different from HMM? Kalman filter Its strength and limitation Particle Filter
More informationAUTOMOTIVE ENVIRONMENT SENSORS
AUTOMOTIVE ENVIRONMENT SENSORS Lecture 5. Localization BME KÖZLEKEDÉSMÉRNÖKI ÉS JÁRMŰMÉRNÖKI KAR 32708-2/2017/INTFIN SZÁMÚ EMMI ÁLTAL TÁMOGATOTT TANANYAG Related concepts Concepts related to vehicles moving
More informationIntroduction to Mobile Robotics Bayes Filter Particle Filter and Monte Carlo Localization
Introduction to Mobile Robotics Bayes Filter Particle Filter and Monte Carlo Localization Wolfram Burgard, Cyrill Stachniss, Maren Bennewitz, Kai Arras 1 Motivation Recall: Discrete filter Discretize the
More information2D Image Processing (Extended) Kalman and particle filter
2D Image Processing (Extended) Kalman and particle filter Prof. Didier Stricker Dr. Gabriele Bleser Kaiserlautern University http://ags.cs.uni-kl.de/ DFKI Deutsches Forschungszentrum für Künstliche Intelligenz
More informationSensor Fusion: Particle Filter
Sensor Fusion: Particle Filter By: Gordana Stojceska stojcesk@in.tum.de Outline Motivation Applications Fundamentals Tracking People Advantages and disadvantages Summary June 05 JASS '05, St.Petersburg,
More informationSLAM Techniques and Algorithms. Jack Collier. Canada. Recherche et développement pour la défense Canada. Defence Research and Development Canada
SLAM Techniques and Algorithms Jack Collier Defence Research and Development Canada Recherche et développement pour la défense Canada Canada Goals What will we learn Gain an appreciation for what SLAM
More informationA 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 informationK. Valipour 1 E. Dehghan 2 M.H. Shariatkhah 3
International Research Journal of Applied and Basic Sciences 2013 Available online at www.irjabs.com ISSN 21-838X / Vol, 4 (7): 1663-1670 Science Explorer Publications Optimal placement of Capacitor Banks
More informationJoint GPS and Vision Estimation Using an Adaptive Filter
1 Joint GPS and Vision Estimation Using an Adaptive Filter Shubhendra Vikram Singh Chauhan and Grace Xingxin Gao, University of Illinois at Urbana-Champaign Shubhendra Vikram Singh Chauhan received his
More informationConsistent Triangulation for Mobile Robot Localization Using Discontinuous Angular Measurements
Seminar on Mechanical Robotic Systems Centre for Intelligent Machines McGill University Consistent Triangulation for Mobile Robot Localization Using Discontinuous Angular Measurements Josep M. Font Llagunes
More informationRobotics. Mobile Robotics. Marc Toussaint U Stuttgart
Robotics Mobile Robotics State estimation, Bayes filter, odometry, particle filter, Kalman filter, SLAM, joint Bayes filter, EKF SLAM, particle SLAM, graph-based SLAM Marc Toussaint U Stuttgart DARPA Grand
More informationHuman Pose Tracking I: Basics. David Fleet University of Toronto
Human Pose Tracking I: Basics David Fleet University of Toronto CIFAR Summer School, 2009 Looking at People Challenges: Complex pose / motion People have many degrees of freedom, comprising an articulated
More informationContent.
Content Fundamentals of Bayesian Techniques (E. Sucar) Bayesian Filters (O. Aycard) Definition & interests Implementations Hidden Markov models Discrete Bayesian Filters or Markov localization Kalman filters
More informationEVALUATING SYMMETRIC INFORMATION GAP BETWEEN DYNAMICAL SYSTEMS USING PARTICLE FILTER
EVALUATING SYMMETRIC INFORMATION GAP BETWEEN DYNAMICAL SYSTEMS USING PARTICLE FILTER Zhen Zhen 1, Jun Young Lee 2, and Abdus Saboor 3 1 Mingde College, Guizhou University, China zhenz2000@21cn.com 2 Department
More informationLocalización Dinámica de Robots Móviles Basada en Filtrado de Kalman y Triangulación
Universidad Pública de Navarra 13 de Noviembre de 2008 Departamento de Ingeniería Mecánica, Energética y de Materiales Localización Dinámica de Robots Móviles Basada en Filtrado de Kalman y Triangulación
More informationVlad Estivill-Castro. Robots for People --- A project for intelligent integrated systems
1 Vlad Estivill-Castro Robots for People --- A project for intelligent integrated systems V. Estivill-Castro 2 Probabilistic Map-based Localization (Kalman Filter) Chapter 5 (textbook) Based on textbook
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 informationSystem identification and sensor fusion in dynamical systems. Thomas Schön Division of Systems and Control, Uppsala University, Sweden.
System identification and sensor fusion in dynamical systems Thomas Schön Division of Systems and Control, Uppsala University, Sweden. The system identification and sensor fusion problem Inertial sensors
More informationCondensed Table of Contents for Introduction to Stochastic Search and Optimization: Estimation, Simulation, and Control by J. C.
Condensed Table of Contents for Introduction to Stochastic Search and Optimization: Estimation, Simulation, and Control by J. C. Spall John Wiley and Sons, Inc., 2003 Preface... xiii 1. Stochastic Search
More informationMobile Robot Localization
Mobile Robot Localization 1 The Problem of Robot Localization Given a map of the environment, how can a robot determine its pose (planar coordinates + orientation)? Two sources of uncertainty: - observations
More informationA Study of Covariances within Basic and Extended Kalman Filters
A Study of Covariances within Basic and Extended Kalman Filters David Wheeler Kyle Ingersoll December 2, 2013 Abstract This paper explores the role of covariance in the context of Kalman filters. The underlying
More informationCIS 390 Fall 2016 Robotics: Planning and Perception Final Review Questions
CIS 390 Fall 2016 Robotics: Planning and Perception Final Review Questions December 14, 2016 Questions Throughout the following questions we will assume that x t is the state vector at time t, z t is the
More informationMulti-Sensor Fusion for Localization of a Mobile Robot in Outdoor Environments
Multi-Sensor Fusion for Localization of a Mobile Robot in Outdoor Environments Thomas Emter, Arda Saltoğlu and Janko Petereit Introduction AMROS Mobile platform equipped with multiple sensors for navigation
More informationModeling and state estimation Examples State estimation Probabilities Bayes filter Particle filter. Modeling. CSC752 Autonomous Robotic Systems
Modeling CSC752 Autonomous Robotic Systems Ubbo Visser Department of Computer Science University of Miami February 21, 2017 Outline 1 Modeling and state estimation 2 Examples 3 State estimation 4 Probabilities
More informationSensors Fusion for Mobile Robotics localization. M. De Cecco - Robotics Perception and Action
Sensors Fusion for Mobile Robotics localization 1 Until now we ve presented the main principles and features of incremental and absolute (environment referred localization systems) could you summarize
More informationRobotics. Lecture 4: Probabilistic Robotics. See course website for up to date information.
Robotics Lecture 4: Probabilistic Robotics See course website http://www.doc.ic.ac.uk/~ajd/robotics/ for up to date information. Andrew Davison Department of Computing Imperial College London Review: Sensors
More informationRao-Blackwellized Particle Filtering for 6-DOF Estimation of Attitude and Position via GPS and Inertial Sensors
Rao-Blackwellized Particle Filtering for 6-DOF Estimation of Attitude and Position via GPS and Inertial Sensors GRASP Laboratory University of Pennsylvania June 6, 06 Outline Motivation Motivation 3 Problem
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 informationIntroduction to Machine Learning
Introduction to Machine Learning Brown University CSCI 1950-F, Spring 2012 Prof. Erik Sudderth Lecture 25: Markov Chain Monte Carlo (MCMC) Course Review and Advanced Topics Many figures courtesy Kevin
More informationTerrain Navigation Using the Ambient Magnetic Field as a Map
Terrain Navigation Using the Ambient Magnetic Field as a Map Aalto University IndoorAtlas Ltd. August 30, 017 In collaboration with M. Kok, N. Wahlström, T. B. Schön, J. Kannala, E. Rahtu, and S. Särkkä
More informationAutomated 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 informationCONSTRAINT KALMAN FILTER FOR INDOOR BLUETOOTH LOCALIZATION
CONSTRAINT KALMAN FILTER FOR INDOOR BLUETOOTH LOCALIZATION Liang Chen, Heidi Kuusniemi, Yuwei Chen, Jingbin Liu, Ling Pei, Laura Ruotsalainen, and Ruizhi Chen NLS Finnish Geospatial Research Institute
More informationSimultaneous Localization and Map Building Using Natural features in Outdoor Environments
Simultaneous Localization and Map Building Using Natural features in Outdoor Environments Jose Guivant, Eduardo Nebot, Hugh Durrant Whyte Australian Centre for Field Robotics Department of Mechanical and
More informationTuning of Extended Kalman Filter for nonlinear State Estimation
OSR Journal of Computer Engineering (OSR-JCE) e-ssn: 78-0661,p-SSN: 78-877, Volume 18, ssue 5, Ver. V (Sep. - Oct. 016), PP 14-19 www.iosrjournals.org Tuning of Extended Kalman Filter for nonlinear State
More informationParticle lter for mobile robot tracking and localisation
Particle lter for mobile robot tracking and localisation Tinne De Laet K.U.Leuven, Dept. Werktuigkunde 19 oktober 2005 Particle lter 1 Overview Goal Introduction Particle lter Simulations Particle lter
More informationTarget Tracking and Classification using Collaborative Sensor Networks
Target Tracking and Classification using Collaborative Sensor Networks Xiaodong Wang Department of Electrical Engineering Columbia University p.1/3 Talk Outline Background on distributed wireless sensor
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 informationMobile Robot Geometry Initialization from Single Camera
Author manuscript, published in "6th International Conference on Field and Service Robotics - FSR 2007, Chamonix : France (2007)" Mobile Robot Geometry Initialization from Single Camera Daniel Pizarro
More informationArtificial Intelligence
Artificial Intelligence Roman Barták Department of Theoretical Computer Science and Mathematical Logic Summary of last lecture We know how to do probabilistic reasoning over time transition model P(X t
More informationEfficient 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 informationParticle Filters. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics
Particle Filters Pieter Abbeel UC Berkeley EECS Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics Motivation For continuous spaces: often no analytical formulas for Bayes filter updates
More informationL09. PARTICLE FILTERING. NA568 Mobile Robotics: Methods & Algorithms
L09. PARTICLE FILTERING NA568 Mobile Robotics: Methods & Algorithms Particle Filters Different approach to state estimation Instead of parametric description of state (and uncertainty), use a set of state
More informationwith Application to Autonomous Vehicles
Nonlinear with Application to Autonomous Vehicles (Ph.D. Candidate) C. Silvestre (Supervisor) P. Oliveira (Co-supervisor) Institute for s and Robotics Instituto Superior Técnico Portugal January 2010 Presentation
More informationMobile Robot Localization
Mobile Robot Localization 1 The Problem of Robot Localization Given a map of the environment, how can a robot determine its pose (planar coordinates + orientation)? Two sources of uncertainty: - observations
More informationSequential Monte Carlo Samplers for Applications in High Dimensions
Sequential Monte Carlo Samplers for Applications in High Dimensions Alexandros Beskos National University of Singapore KAUST, 26th February 2014 Joint work with: Dan Crisan, Ajay Jasra, Nik Kantas, Alex
More informationProgress In Electromagnetics Research C, Vol. 11, , 2009
Progress In Electromagnetics Research C, Vol. 11, 171 182, 2009 DISTRIBUTED PARTICLE FILTER FOR TARGET TRACKING IN SENSOR NETWORKS H. Q. Liu, H. C. So, F. K. W. Chan, and K. W. K. Lui Department of Electronic
More informationExpectation 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 informationNonlinear 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 informationRobot Localization and Kalman Filters
Robot Localization and Kalman Filters Rudy Negenborn rudy@negenborn.net August 26, 2003 Outline Robot Localization Probabilistic Localization Kalman Filters Kalman Localization Kalman Localization with
More informationStructural estimation for a route choice model with uncertain measurement
Structural estimation for a route choice model with uncertain measurement Yuki Oyama* & Eiji Hato *PhD student Behavior in Networks studies unit Department of Urban Engineering School of Engineering, The
More informationAutonomous Navigation, Guidance and Control of Small 4-wheel Electric Vehicle
Journal of Asian Electric Vehicles, Volume 10, Number 1, June 01 Autonomous Navigation, Guidance and Control of Small 4-wheel Electric Vehicle Satoshi Suzuki International Young Researchers Empowerment
More informationECE276A: Sensing & Estimation in Robotics Lecture 10: Gaussian Mixture and Particle Filtering
ECE276A: Sensing & Estimation in Robotics Lecture 10: Gaussian Mixture and Particle Filtering Lecturer: Nikolay Atanasov: natanasov@ucsd.edu Teaching Assistants: Siwei Guo: s9guo@eng.ucsd.edu Anwesan Pal:
More informationHybrid particle swarm algorithm for solving nonlinear constraint. optimization problem [5].
Hybrid particle swarm algorithm for solving nonlinear constraint optimization problems BINGQIN QIAO, XIAOMING CHANG Computers and Software College Taiyuan University of Technology Department of Economic
More informationCSC487/2503: Foundations of Computer Vision. Visual Tracking. David Fleet
CSC487/2503: Foundations of Computer Vision Visual Tracking David Fleet Introduction What is tracking? Major players: Dynamics (model of temporal variation of target parameters) Measurements (relation
More informationProbability Map Building of Uncertain Dynamic Environments with Indistinguishable Obstacles
Probability Map Building of Uncertain Dynamic Environments with Indistinguishable Obstacles Myungsoo Jun and Raffaello D Andrea Sibley School of Mechanical and Aerospace Engineering Cornell University
More informationA Comparison of Mobile Robot Pose Estimation using Non-linear Filters: Simulation and Experimental Results
1 A Comparison of Mobile Robot Pose Estimation using Non-linear Filters: Simulation and Experimental Results Zongwen Xue and Howard Schwartz Department of System and Computer Engineering Carleton University
More informationELEC4631 s Lecture 2: Dynamic Control Systems 7 March Overview of dynamic control systems
ELEC4631 s Lecture 2: Dynamic Control Systems 7 March 2011 Overview of dynamic control systems Goals of Controller design Autonomous dynamic systems Linear Multi-input multi-output (MIMO) systems Bat flight
More informationVehicle Dynamic Control Allocation for Path Following Moritz Gaiser
Vehicle Dynamic Control Allocation for Path Following Moritz Gaiser INSTITUT FÜR THEORETISCHE ELEKTROTECHNIK UND SYSTEMOPTIMIERUNG (ITE) KIT Die Forschungsuniversität in der Helmholtz-Gemeinschaft www.ite.kit.edu
More informationMarkov chain Monte Carlo methods for visual tracking
Markov chain Monte Carlo methods for visual tracking Ray Luo rluo@cory.eecs.berkeley.edu Department of Electrical Engineering and Computer Sciences University of California, Berkeley Berkeley, CA 94720
More informationEKF and SLAM. McGill COMP 765 Sept 18 th, 2017
EKF and SLAM McGill COMP 765 Sept 18 th, 2017 Outline News and information Instructions for paper presentations Continue on Kalman filter: EKF and extension to mapping Example of a real mapping system:
More informationAdaptive 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 informationApplication Research of Fireworks Algorithm in Parameter Estimation for Chaotic System
Application Research of Fireworks Algorithm in Parameter Estimation for Chaotic System Hao Li 1,3, Ying Tan 2, Jun-Jie Xue 1 and Jie Zhu 1 1 Air Force Engineering University, Xi an, 710051, China 2 Department
More informationPartially Observable Markov Decision Processes (POMDPs)
Partially Observable Markov Decision Processes (POMDPs) Sachin Patil Guest Lecture: CS287 Advanced Robotics Slides adapted from Pieter Abbeel, Alex Lee Outline Introduction to POMDPs Locally Optimal Solutions
More informationParticle Filters; Simultaneous Localization and Mapping (Intelligent Autonomous Robotics) Subramanian Ramamoorthy School of Informatics
Particle Filters; Simultaneous Localization and Mapping (Intelligent Autonomous Robotics) Subramanian Ramamoorthy School of Informatics Recap: State Estimation using Kalman Filter Project state and error
More informationIntroduction to Particle Filters for Data Assimilation
Introduction to Particle Filters for Data Assimilation Mike Dowd Dept of Mathematics & Statistics (and Dept of Oceanography Dalhousie University, Halifax, Canada STATMOS Summer School in Data Assimila5on,
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 informationComputer Intensive Methods in Mathematical Statistics
Computer Intensive Methods in Mathematical Statistics Department of mathematics johawes@kth.se Lecture 16 Advanced topics in computational statistics 18 May 2017 Computer Intensive Methods (1) Plan of
More informationRobot Localisation. Henrik I. Christensen. January 12, 2007
Robot Henrik I. Robotics and Intelligent Machines @ GT College of Computing Georgia Institute of Technology Atlanta, GA hic@cc.gatech.edu January 12, 2007 The Robot Structure Outline 1 2 3 4 Sum of 5 6
More informationLocal Positioning with Parallelepiped Moving Grid
Local Positioning with Parallelepiped Moving Grid, WPNC06 16.3.2006, niilo.sirola@tut.fi p. 1/?? TA M P E R E U N I V E R S I T Y O F T E C H N O L O G Y M a t h e m a t i c s Local Positioning with Parallelepiped
More informationIntroduction to Mobile Robotics Probabilistic Motion Models
Introduction to Mobile Robotics Probabilistic Motion Models Wolfram Burgard 1 Robot Motion Robot motion is inherently uncertain. How can we model this uncertainty? 2 Dynamic Bayesian Network for Controls,
More informationProbabilistic Fundamentals in Robotics. DAUIN Politecnico di Torino July 2010
Probabilistic Fundamentals in Robotics Probabilistic Models of Mobile Robots Robot localization Basilio Bona DAUIN Politecnico di Torino July 2010 Course Outline Basic mathematical framework Probabilistic
More informationFuzzy Logic Based Nonlinear Kalman Filter Applied to Mobile Robots Modelling
Fuzzy Logic Based Nonlinear Kalman Filter Applied to Mobile Robots Modelling Rodrigo Carrasco Sch. Department of Electrical Engineering Pontificia Universidad Católica de Chile, CHILE E-mail: rax@ing.puc.cl
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 informationVehicle Motion Estimation Using an Infrared Camera an Industrial Paper
Vehicle Motion Estimation Using an Infrared Camera an Industrial Paper Emil Nilsson, Christian Lundquist +, Thomas B. Schön +, David Forslund and Jacob Roll * Autoliv Electronics AB, Linköping, Sweden.
More informationThe 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 informationMobile Robots Localization
Mobile Robots Localization Institute for Software Technology 1 Today s Agenda Motivation for Localization Odometry Odometry Calibration Error Model 2 Robotics is Easy control behavior perception modelling
More informationA NOVEL OPTIMAL PROBABILITY DENSITY FUNCTION TRACKING FILTER DESIGN 1
A NOVEL OPTIMAL PROBABILITY DENSITY FUNCTION TRACKING FILTER DESIGN 1 Jinglin Zhou Hong Wang, Donghua Zhou Department of Automation, Tsinghua University, Beijing 100084, P. R. China Control Systems Centre,
More informationA Bayesian Approach to Jointly Estimate Tire Radii and Vehicle Trajectory
A Bayesian Approach to Jointly Estimate Tire Radii and Vehicle Trajectory Emre Özan, Christian Lundquist and Fredri Gustafsson Abstract High-precision estimation of vehicle tire radii is considered, based
More informationProbabilistic Fundamentals in Robotics
Probabilistic Fundamentals in Robotics Probabilistic Models of Mobile Robots Robot localization Basilio Bona DAUIN Politecnico di Torino June 2011 Course Outline Basic mathematical framework Probabilistic
More informationDynamic System Identification using HDMR-Bayesian Technique
Dynamic System Identification using HDMR-Bayesian Technique *Shereena O A 1) and Dr. B N Rao 2) 1), 2) Department of Civil Engineering, IIT Madras, Chennai 600036, Tamil Nadu, India 1) ce14d020@smail.iitm.ac.in
More informationFUNDAMENTAL FILTERING LIMITATIONS IN LINEAR NON-GAUSSIAN SYSTEMS
FUNDAMENTAL FILTERING LIMITATIONS IN LINEAR NON-GAUSSIAN SYSTEMS Gustaf Hendeby Fredrik Gustafsson Division of Automatic Control Department of Electrical Engineering, Linköpings universitet, SE-58 83 Linköping,
More informationExtension 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 information2nd International Conference on Electronic & Mechanical Engineering and Information Technology (EMEIT-2012)
Estimation of Vehicle State and Road Coefficient for Electric Vehicle through Extended Kalman Filter and RS Approaches IN Cheng 1, WANG Gang 1, a, CAO Wan-ke 1 and ZHOU Feng-jun 1, b 1 The National Engineering
More informationNovel spectrum sensing schemes for Cognitive Radio Networks
Novel spectrum sensing schemes for Cognitive Radio Networks Cantabria University Santander, May, 2015 Supélec, SCEE Rennes, France 1 The Advanced Signal Processing Group http://gtas.unican.es The Advanced
More informationOn Motion Models for Target Tracking in Automotive Applications
On Motion Models for Target Tracking in Automotive Applications Markus Bühren and Bin Yang Chair of System Theory and Signal Processing University of Stuttgart, Germany www.lss.uni-stuttgart.de Abstract
More informationResampling from the Niching Genetic Algorithm Applicated in Extended Kalman Particle Filter
Chinese Journal of Electronics Vol.20, No.3, July 2011 Resampling from the Niching Genetic Algorithm Applicated in Extended Kalman Particle Filter QIN Honglei 1,LIZiyu 2 and CONG Li 1 (1.School of Electronic
More informationState-Estimator Design for the KTH Research Concept Vehicle
DEGREE PROJECT IN VEHICLE ENGINEERING, SECOND CYCLE, 30 CREDITS STOCKHOLM, SWEDEN 2016 State-Estimator Design for the KTH Research Concept Vehicle FAN GAO KTH ROYAL INSTITUTE OF TECHNOLOGY SCHOOL OF ENGINEERING
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 informationDesign of Fuzzy Logic Control System for Segway Type Mobile Robots
Original Article International Journal of Fuzzy Logic and Intelligent Systems Vol. 15, No. 2, June 2015, pp. 126-131 http://dx.doi.org/10.5391/ijfis.2015.15.2.126 ISSNPrint) 1598-2645 ISSNOnline) 2093-744X
More informationAutonomous Mobile Robot Design
Autonomous Mobile Robot Design Topic: Particle Filter for Localization Dr. Kostas Alexis (CSE) These slides relied on the lectures from C. Stachniss, and the book Probabilistic Robotics from Thurn et al.
More informationQuadrotor Modeling and Control for DLO Transportation
Quadrotor Modeling and Control for DLO Transportation Thesis dissertation Advisor: Prof. Manuel Graña Computational Intelligence Group University of the Basque Country (UPV/EHU) Donostia Jun 24, 2016 Abstract
More informationApproximate Bayesian computation: an application to weak-lensing peak counts
STATISTICAL CHALLENGES IN MODERN ASTRONOMY VI Approximate Bayesian computation: an application to weak-lensing peak counts Chieh-An Lin & Martin Kilbinger SAp, CEA Saclay Carnegie Mellon University, Pittsburgh
More informationState 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 informationStatistical Techniques in Robotics (16-831, F12) Lecture#21 (Monday November 12) Gaussian Processes
Statistical Techniques in Robotics (16-831, F12) Lecture#21 (Monday November 12) Gaussian Processes Lecturer: Drew Bagnell Scribe: Venkatraman Narayanan 1, M. Koval and P. Parashar 1 Applications of Gaussian
More informationConstrained 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 informationA FEASIBILITY STUDY OF PARTICLE FILTERS FOR MOBILE STATION RECEIVERS. Michael Lunglmayr, Martin Krueger, Mario Huemer
A FEASIBILITY STUDY OF PARTICLE FILTERS FOR MOBILE STATION RECEIVERS Michael Lunglmayr, Martin Krueger, Mario Huemer Michael Lunglmayr and Martin Krueger are with Infineon Technologies AG, Munich email:
More informationPSD Analysis and Optimization of 2500hp Shale Gas Fracturing Truck Chassis Frame
Send Orders for Reprints to reprints@benthamscience.ae The Open Mechanical Engineering Journal, 2014, 8, 533-538 533 Open Access PSD Analysis and Optimization of 2500hp Shale Gas Fracturing Truck Chassis
More informationAutonomous Navigation for Flying Robots
Computer Vision Group Prof. Daniel Cremers Autonomous Navigation for Flying Robots Lecture 6.2: Kalman Filter Jürgen Sturm Technische Universität München Motivation Bayes filter is a useful tool for state
More informationTutorial on Approximate Bayesian Computation
Tutorial on Approximate Bayesian Computation Michael Gutmann https://sites.google.com/site/michaelgutmann University of Helsinki Aalto University Helsinki Institute for Information Technology 16 May 2016
More informationBayesian Networks BY: MOHAMAD ALSABBAGH
Bayesian Networks BY: MOHAMAD ALSABBAGH Outlines Introduction Bayes Rule Bayesian Networks (BN) Representation Size of a Bayesian Network Inference via BN BN Learning Dynamic BN Introduction Conditional
More information