Sparse Surface Adjustment

16
June 13, 2022 Sparse Surface Adjustment M. Ruhnke , R. Kümmerle, G. Grisetti, W. Burgard

description

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 - PowerPoint PPT Presentation

Transcript of Sparse Surface Adjustment

Page 1: Sparse Surface Adjustment

April 22, 2023

Sparse Surface AdjustmentM. Ruhnke, R. Kümmerle, G. Grisetti, W. Burgard

Page 2: Sparse Surface Adjustment

Metric 3D Models

►Essential for tasks like:►Object recognition►Manipulation

Page 3: Sparse Surface Adjustment

Metric 3D Models

►Essential for tasks like:►Object recognition►Manipulation

►Key challenges in model acquisition with mobile robots►Errors in pose estimate►Measurement errors

Page 4: Sparse Surface Adjustment

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

Page 5: Sparse Surface Adjustment

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 g2o

Page 6: Sparse Surface Adjustment

Surface Model

►Range measurements sample surfaces

►Assumption: Piecewise regular surfaces

►Surface sample►3D Position►covariance ►normal (local neighborhood)

Page 7: Sparse Surface Adjustment

►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

Page 8: Sparse Surface Adjustment

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

Page 9: Sparse Surface Adjustment

Optimization

►Iteratively:►Optimize system with g2o ►Re-compute:

►surface point characteristics (covariance, normals)►data association

Page 10: Sparse Surface Adjustment

SSA 2D: Intel Dataset

Page 11: Sparse Surface Adjustment

Object 5mm Resolution

Page 12: Sparse Surface Adjustment

AASS Loop Dataset*

SLAM result (input)

SSA result

*Courtesy of Martin Magnusson, AASS, Örebro, Sweden

Page 13: Sparse Surface Adjustment

SSA 3D: Example Cup

Page 14: Sparse Surface Adjustment

Example: Scan Refinement

►SSA refines scans based on more certain nearby measurements

after optimizationraw scan

Page 15: Sparse Surface Adjustment

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

Page 16: Sparse Surface Adjustment

Summary SSA

►Iterative refinement of ►Sensor poses►Surface points positions

►Considering range & sensor dependent uncertainties

►Re-computation of data association►Uses PCL and FLANN