Active SLAM in Structured Environments Cindy Leung, Shoudong Huang and Gamini Dissanayake Presented by: Arvind Pereira for the CS-599 – Sequential Decision.

Slides:



Advertisements
Similar presentations
Mobile Robot Localization and Mapping using the Kalman Filter
Advertisements

Lecture 7: Potential Fields and Model Predictive Control
Introduction to Robotics Lecture One Robotics Club -Arjun Bhasin.
Probabilistic Robotics
Probabilistic Robotics
Probabilistic Robotics SLAM. 2 Given: The robot’s controls Observations of nearby features Estimate: Map of features Path of the robot The SLAM Problem.
(Includes references to Brian Clipp
Robot Localization Using Bayesian Methods
The GraphSLAM Algorithm Daniel Holman CS 5391: AI Robotics March 12, 2014.
IR Lab, 16th Oct 2007 Zeyn Saigol
Introduction to Probabilistic Robot Mapping. What is Robot Mapping? General Definitions for robot mapping.
Lab 2 Lab 3 Homework Labs 4-6 Final Project Late No Videos Write up
Probabilistic Robotics
MATH 685/ CSI 700/ OR 682 Lecture Notes
Simultaneous Localization & Mapping - SLAM
Uncertainty Representation. Gaussian Distribution variance Standard deviation.
Nice, 17/18 December 2001 Adaptive Grids For Bathymetry Mapping And Navigation Michel Chedid and Maria-João Rendas I3S - MAUVE.
Sam Pfister, Stergios Roumeliotis, Joel Burdick
Reliable Range based Localization and SLAM Joseph Djugash Masters Student Presenting work done by: Sanjiv Singh, George Kantor, Peter Corke and Derek Kurth.
Adam Rachmielowski 615 Project: Real-time monocular vision-based SLAM.
Introduction to Kalman Filter and SLAM Ting-Wei Hsu 08/10/30.
Motion Analysis (contd.) Slides are from RPI Registration Class.
CSci 6971: Image Registration Lecture 4: First Examples January 23, 2004 Prof. Chuck Stewart, RPI Dr. Luis Ibanez, Kitware Prof. Chuck Stewart, RPI Dr.
Active Simultaneous Localization and Mapping Stephen Tully, : Robotic Motion Planning This project is to actively control the.
SLAM: Simultaneous Localization and Mapping: Part I Chang Young Kim These slides are based on: Probabilistic Robotics, S. Thrun, W. Burgard, D. Fox, MIT.
SA-1 Probabilistic Robotics Mapping with Known Poses.
Bioinformatics Challenge  Learning in very high dimensions with very few samples  Acute leukemia dataset: 7129 # of gene vs. 72 samples  Colon cancer.
Authors: Joseph Djugash, Sanjiv Singh, George Kantor and Wei Zhang
Grid Maps for Robot Mapping. Features versus Volumetric Maps.
Geometric Rays for Bearing-Only SLAM Joan Solà and Thomas Lemaire LAAS-CNRS Toulouse, France.
Overview and Mathematics Bjoern Griesbach
ROBOT MAPPING AND EKF SLAM
EKF and UKF Day EKF and RoboCup Soccer simulation of localization using EKF and 6 landmarks (with known correspondences) robot travels in a circular.
Kalman filter and SLAM problem
Colorado Center for Astrodynamics Research The University of Colorado STATISTICAL ORBIT DETERMINATION Project Report Unscented kalman Filter Information.
Sven Koenig, Joseph S. B. Mitchell, Apura Mudgal, Craig Tovey A Near-Tight Approximation Algorithm for the Robot Localization Problem Presented by: Mike.
Itamar Kahn, Thomas Lin, Yuval Mazor
오 세 영, 이 진 수 전자전기공학과, 뇌연구센터 포항공과대학교
3D SLAM for Omni-directional Camera
Simultaneous Localization and Mapping Presented by Lihan He Apr. 21, 2006.
Mapping and Localization with RFID Technology Matthai Philipose, Kenneth P Fishkin, Dieter Fox, Dirk Hahnel, Wolfram Burgard Presenter: Aniket Shah.
Kalman Filter (Thu) Joon Shik Kim Computational Models of Intelligence.
Probabilistic Robotics Bayes Filter Implementations Gaussian filters.
Young Ki Baik, Computer Vision Lab.
Visual SLAM Visual SLAM SPL Seminar (Fri) Young Ki Baik Computer Vision Lab.
The “ ” Paige in Kalman Filtering K. E. Schubert.
Real-Time Simultaneous Localization and Mapping with a Single Camera (Mono SLAM) Young Ki Baik Computer Vision Lab. Seoul National University.
1 Energy-Efficient Mobile Robot Exploration Yongguo Mei, Yung-Hsiang Lu Purdue University ICRA06.
Globally Consistent Range Scan Alignment for Environment Mapping F. LU ∗ AND E. MILIOS Department of Computer Science, York University, North York, Ontario,
Extended Kalman Filter
Nonlinear State Estimation
Probabilistic Robotics
Robust Localization Kalman Filter & LADAR Scans
Mobile Robot Localization and Mapping Using Range Sensor Data Dr. Joel Burdick, Dr. Stergios Roumeliotis, Samuel Pfister, Kristo Kriechbaum.
Computacion Inteligente Least-Square Methods for System Identification.
SLAM Techniques -Venkata satya jayanth Vuddagiri 1.
Probabilistic Robotics Bayes Filter Implementations Gaussian filters.
3D Perception and Environment Map Generation for Humanoid Robot Navigation A DISCUSSION OF: -BY ANGELA FILLEY.
SLAM Simultaneous Localization And Mapping 1. SLAM is an Approach Not an Algorithm Different hardware that can be used There are many steps involved in.
Probabilistic Robotics Bayes Filter Implementations Gaussian filters.
Bounded Nonlinear Optimization to Fit a Model of Acoustic Foams
Paper – Stephen Se, David Lowe, Jim Little
PSG College of Technology
Simultaneous Localization and Mapping
A Short Introduction to the Bayes Filter and Related Models
Probabilistic Robotics
CS 416 Artificial Intelligence
Facultad de Ingeniería, Centro de Cálculo
Overview: Chapter 2 Localization and Tracking
Presentation transcript:

Active SLAM in Structured Environments Cindy Leung, Shoudong Huang and Gamini Dissanayake Presented by: Arvind Pereira for the CS-599 – Sequential Decision Making in Robotics

Active SLAM Problem Definition Plan a trajectory for the robot such that : Line features in the environment can be estimated accurately and efficiently Requires an estimation algorithm for line features and robot poses using the observations and process information

Line Representation Active SLAM in this work is performed using “line features” as opposed to “point features” Equation of line used: For each line feature, several line segments may be found, and stored as: Array stored but not included in SLAM state vector

Observation Model General Observation Model is:

Process Model velocityTurn-rate Stabilizing noise added to cov. of robot pose for Unmodelled Process noise

Incremental SLAM Relative Position between observations SLAM as a Least-squares problem

Incremental SLAM contd… The first part is the Process Innovation: Odometry Prediction error Jacobians of Relative position equation Initial guess of the robot poses

iSAM contd… The second part is the Observation Innovation Measurement prediction error Jacobians of Observation Equation Intial guess of the feature observed

Solve a Linearized Least Squares Problem: Noise covariances can be expressed as : A contains the jacobians, b contains the innovations. Repeatedly solve the linearized least squares process until the solution has converged until is < Threshold

Data-Association Performed by extracting EKF state and covariance from iSAM state vector and A To get the covariance P – Find the information matrix – Compute Covariance The EKF state and its covariance are extracted using the current robot pose and all features. Using these values, standard nearest neighbor method is applied for data-association

Trajectory Planning (1)- MPC Primary objective is to minimize the uncertainty of the estimate Cannot use Optimal control with fixed models due to uncertainties! Model Predictive Control (MPC) with an attractor is used as the optimization strategy Multi-step control optimization for MPC uses EKF algorithm while current estimate for MPC comes from iSAM

Trajectory Planning (1) contd… Obstacle avoidance is performed by using the current laser scan and doesn’t rely upon the SLAM output (since not all obstacles are necessarily lines!) Makes sense because the range of the sensor is much larger than the planning horizon of the robot

Line segment prediction The control is based upon Information gain, and hence needs a means of predicting line segments which might be observed Can be done using the predicted robot pose and the line segments If robot is predicted to observe an adequate number of sensor measurements to an estimated line feature, that line is observed! Covariance of the predicted line observation is predicted by simulating noises in range measurements associated with the line feature

Trajectory Planning (2) - Attractor Attractor is a virtual point feature Attractor leads the robot toward a reference point where the robot should be heading to It is placed at the first cell on the occupancy grid which is visible to the robot

Reference Point for Exploration An occupancy grid is also used to determine frontiers for exploration and traversable areas A reference point for localization is one used in the explore state when frontier points are extracted from the occupancy grid The frontier region is selected based upon minimum absolute bearing to the robot – used to minimize turning

Reference Point for Localization and Mapping Reference point for localization is usually a well defined feature Mapping reference points are those with poorly defined features Determined by thresholding covariances of features of interest Once a group of potential reference points are obtained, the distance transform is computed for the occupancy grid map and the reference point is selected based upon minimum traversable distance

Simulation Results

Comparison of MPC+A, MPC and RS

Experimental Results

Loop and Timing characteristics