May 16, 2015 Sparse Surface Adjustment M. Ruhnke, R. Kümmerle, G. Grisetti, W. Burgard.

Slides:



Advertisements
Similar presentations
Brian Peasley and Stan Birchfield
Advertisements

Registration for Robotics Kurt Konolige Willow Garage Stanford University Patrick Mihelich JD Chen James Bowman Helen Oleynikova Freiburg TORO group: Giorgio.
PARTITIONAL CLUSTERING
KinectFusion: Real-Time Dense Surface Mapping and Tracking
Odometry Error Modeling Three noble methods to model random odometry error.
Nikolas Engelhard 1, Felix Endres 1, Jürgen Hess 1, Jürgen Sturm 2, Wolfram Burgard 1 1 University of Freiburg, Germany 2 Technical University Munich,
Probabilistic Robotics
Object Recognition & Model Based Tracking © Danica Kragic Tracking system.
Probabilistic Robotics
(Includes references to Brian Clipp
Kiyoshi Irie, Tomoaki Yoshida, and Masahiro Tomono 2011 IEEE International Conference on Robotics and Automation Shanghai International Conference Center.
Robot Localization Using Bayesian Methods
The GraphSLAM Algorithm Daniel Holman CS 5391: AI Robotics March 12, 2014.
Lab 2 Lab 3 Homework Labs 4-6 Final Project Late No Videos Write up
Probabilistic Robotics
Uncertainty Representation. Gaussian Distribution variance Standard deviation.
Sam Pfister, Stergios Roumeliotis, Joel Burdick
Probabilistic Robotics: Kalman Filters
Active SLAM in Structured Environments Cindy Leung, Shoudong Huang and Gamini Dissanayake Presented by: Arvind Pereira for the CS-599 – Sequential Decision.
Bayesian Image Super-resolution, Continued Lyndsey C. Pickup, David P. Capel, Stephen J. Roberts and Andrew Zisserman, Robotics Research Group, University.
gMapping TexPoint fonts used in EMF.
Lecture Notes for CMPUT 466/551 Nilanjan Ray
Probabilistic Robotics
3D Mapping Robots Intelligent Robotics School of Computer Science Jeremy Wyatt James Walker.
SLAM: Simultaneous Localization and Mapping: Part I Chang Young Kim These slides are based on: Probabilistic Robotics, S. Thrun, W. Burgard, D. Fox, MIT.
Probabilistic Robotics
Optimal Bandwidth Selection for MLS Surfaces
Efficient simplification of point-sampled geometry Mark Pauly Markus Gross Leif Kobbelt ETH Zurich RWTH Aachen.
Multiple Lidar Calibration Surface Registration Aras Akbari Dr.Liam Pedersen.
Weighted Range Sensor Matching Algorithms for Mobile Robot Displacement Estimation Sam Pfister, Kristo Kriechbaum, Stergios Roumeliotis, Joel Burdick Mechanical.
Particle Filters++ TexPoint fonts used in EMF.
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
Gwangju Institute of Science and Technology Intelligent Design and Graphics Laboratory Feature-Aware Filtering for Point-Set Surface Denoising Min Ki Park*Seung.
Gwangju Institute of Science and Technology Intelligent Design and Graphics Laboratory Multi-scale tensor voting for feature extraction from unstructured.
Mining Discriminative Components With Low-Rank and Sparsity Constraints for Face Recognition Qiang Zhang, Baoxin Li Computer Science and Engineering Arizona.
ALIGNMENT OF 3D ARTICULATE SHAPES. Articulated registration Input: Two or more 3d point clouds (possibly with connectivity information) of an articulated.
COMMON EVALUATION FINAL PROJECT Vira Oleksyuk ECE 8110: Introduction to machine Learning and Pattern Recognition.
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.
Automated Reconstruction of Industrial Sites Frank van den Heuvel Tahir Rabbani.
Young Ki Baik, Computer Vision Lab.
Lecture 2d: Performance Comparison. Quality of Measurement Characteristics of a measurement tool (timer) Accuracy: Absolute difference of a measured value.
1 Research Question  Can a vision-based mobile robot  with limited computation and memory,  and rapidly varying camera positions,  operate autonomously.
Real-Time Simultaneous Localization and Mapping with a Single Camera (Mono SLAM) Young Ki Baik Computer Vision Lab. Seoul National University.
EFFICIENT VARIANTS OF THE ICP ALGORITHM
CSE-473 Mobile Robot Mapping. Mapping with Raw Odometry.
Slide 1 NATO UNCLASSIFIEDMeeting title – Location - Date Satellite Inter-calibration of MODIS and VIIRS sensors Preliminary results A. Alvarez, G. Pennucci,
Summarizing Risk Analysis Results To quantify the risk of an output variable, 3 properties must be estimated: A measure of central tendency (e.g. µ ) A.
Bundle Adjustment A Modern Synthesis Bill Triggs, Philip McLauchlan, Richard Hartley and Andrew Fitzgibbon Presentation by Marios Xanthidis 5 th of No.
Extended Kalman Filter
1 Information Content Tristan L’Ecuyer. 2 Degrees of Freedom Using the expression for the state vector that minimizes the cost function it is relatively.
The Unscented Kalman Filter for Nonlinear Estimation Young Ki Baik.
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.
SLAM Techniques -Venkata satya jayanth Vuddagiri 1.
Autonomous Mobile Robots Autonomous Systems Lab Zürich Probabilistic Map Based Localization "Position" Global Map PerceptionMotion Control Cognition Real.
CSE-473 Mobile Robot Mapping.
MECH 373 Instrumentation and Measurement
Sensors for industrial mobile Robots: environment referred laser scanning Need more/better pictures.
Simultaneous Localization and Mapping
Forward & Backward selection in hybrid network
Problem statement Given: a set of unknown parameters
A Short Introduction to the Bayes Filter and Related Models
Probabilistic Map Based Localization
Jose-Luis Blanco, Javier González, Juan-Antonio Fernández-Madrigal
Introduction to Sensor Interpretation
Introduction to Sensor Interpretation
Probabilistic Robotics Bayes Filter Implementations FastSLAM
Presentation transcript:

May 16, 2015 Sparse Surface Adjustment M. Ruhnke, R. Kümmerle, G. Grisetti, W. Burgard

Metric 3D Models ► Essential for tasks like: ► Object recognition ► Manipulation

Metric 3D Models ► Essential for tasks like: ► Object recognition ► Manipulation ► Key challenges in model acquisition with mobile robots ► Errors in pose estimate ► Measurement errors

Model Creation ► Optimize the sensor poses ► Registration / SLAM ► Reduce the impact of measurement errors ► Use optimal sensor distance ► Local noise reduction techniques (Moving Least Squares, Statistical Outlier Removal, …) ► Pose information is mostly not considered ► Sensor pose gives information about normal direction and range of the measurement

Sparse Surface Adjustment ► Goal: Jointly optimize robot poses and surface points positions ► Surface Model ► Model of measurement uncertainties ► Data association: find corresponding points ► Utilize sparse graph optimizer framework g 2 o

Surface Model ► Range measurements sample surfaces ► Assumption: Piecewise regular surfaces ► Surface sample ► 3D Position ► covariance ► normal (local neighborhood)

► Range measurement ► Sensor specific Covariance ► Dependent on range and incidence angle ► Gaussian error distributions Sensor Model front view side view ~ 3.5m ~ 0.7m Kinect RGB-D

Data Association ► Normal shooting as data association heuristic ► Assign surfaces samples of different observations ► Covariance ► Large error weight in direction of the normal ► Small weight for errors in tangential direction

Optimization ► Iteratively: ► Optimize system with g 2 o ► Re-compute: ► surface point characteristics (covariance, normals) ► data association

SSA 2D: Intel Dataset

Object 5mm Resolution

AASS Loop Dataset* SLAM result (input) SSA result *Courtesy of Martin Magnusson, AASS, Örebro, Sweden

SSA 3D: Example Cup

Example: Scan Refinement ► SSA refines scans based on more certain nearby measurements after optimizationraw scan

Comparison SSA / MLS ► Moving Least Squares (MLS) ► Local smoothing method ► No correction of robot poses ► Sparse Surface Adjustment (SSA) ► Robot pose correction & smoother surfaces SSA result MLS result

Summary SSA ► Iterative refinement of ► Sensor poses ► Surface points positions ► Considering range & sensor dependent uncertainties ► Re-computation of data association ► Uses PCL and FLANN