Scribd
Upload
126 views

Iterative Closest Point (ICP) Algorithm.: Solution. .

This document discusses the Iterative Closest Point (ICP) algorithm for aligning 3D shapes. ICP finds the closest points between a model and object and iteratively transforms the object to minimize distances until convergence. The document also describes using linear programming to implement an L1 version of ICP, which is more robust to outliers compared to the standard L2 version. Experimental results show the L1 version finds more accurate alignments in the presence of many outliers.

Uploaded by

AashishSethi
Copyright
© © All Rights Reserved
Available Formats
Download as PDF, TXT or read online on Scribd
126 views

Iterative Closest Point (ICP) Algorithm.: Solution. .

This document discusses the Iterative Closest Point (ICP) algorithm for aligning 3D shapes. ICP finds the closest points between a model and object and iteratively transforms the object to minimize distances until convergence. The document also describes using linear programming to implement an L1 version of ICP, which is more robust to outliers compared to the standard L2 version. Experimental results show the L1 version finds more accurate alignments in the presence of many outliers.

Uploaded by

AashishSethi
Copyright
© © All Rights Reserved
Available Formats
Download as PDF, TXT or read online on Scribd
You are on page 1/ 19

Iterative Closest Point (ICP)

Algorithm.
L1 solution. . .
Yaroslav Halchenko
CS @ NJIT

Iterative Closest Point (ICP) Algorithm. p.

Registration

Max= 250 Min= 0

Max= 254 Min= 0


250

250

50

200

50

200

100

150

100

150

150

100

150

100

200

50

200

50

250

250
50

100

150

200

250

50

100

150

200

250

0.1

0.05

Max= 254 Min= 0


250
50

200

100

150

150

100

200

50

250
50

100

150

200

250

0.05

0.1
0.05

0
0
0.05

0.05

Iterative Closest Point (ICP) Algorithm. p.

Registration

0.1

0.05

0.05

0.1
0.05

0
0
0.05

0.05

Iterative Closest Point (ICP) Algorithm. p.

Iterative Closest Point


ICP is a straightforward method [Besl 1992] to align two
free-form shapes (model X, object P ):
Initial transformation
Iterative procedure to converge to local minima
1. p P find closest point x X
2. Transform Pk+1 Q(Pk ) to minimize distances
between each p and x
3. Terminate when change in the error falls below a
preset threshold
Choose the best among found solutions for different
initial positions
Iterative Closest Point (ICP) Algorithm. p.

Specifics of Original ICP


Converges to local minima
Based on minimizing squared-error
Suggests Accelerated ICP

Iterative Closest Point (ICP) Algorithm. p.

ICP Refinements
Different methods/strategies
to speed-up closest point selection
K-d trees, dynamic caching
sampling of model and object points
to avoid local minima
removal of outliers
stochastic ICP, simulated annealing, weighting
use other metrics (point-to-surface vs -point)
use additional information besides geometry
(color, curvature)

Iterative Closest Point (ICP) Algorithm. p.

ICP Refinements
Different methods/strategies
to speed-up closest point selection
K-d trees, dynamic caching
sampling of model and object points
to avoid local minima
removal of outliers
stochastic ICP, simulated annealing, weighting
use other metrics (point-to-surface vs -point)
use additional information besides geometry
(color, curvature)
All closed-form solutions are for squared-error on
distances
Iterative Closest Point (ICP) Algorithm. p.

Found on the Web


Tons of papers/reviews/articles
No publicly available Matlab code
Registration Magic Toolkit
(http://asad.ods.org/RegMagicTKDoc) - full
featured registration toolkit with modified ICP

Iterative Closest Point (ICP) Algorithm. p.

Implemented in This Work

Original ICP Method [Besl 1992]


Choice for caching of computed distances

Iterative Closest Point (ICP) Algorithm. p.

Absolute Distances or L1 norm


Why bother?
More stable to presence of outliers
Better statistical estimator in case of non-gaussian
noise (sparse, high-kurtosis)
might help to avoid local minimas

Iterative Closest Point (ICP) Algorithm. p.

Absolute Distances or L1 norm


Why bother?
More stable to presence of outliers
Better statistical estimator in case of non-gaussian
noise (sparse, high-kurtosis)
might help to avoid local minimas
How?
use some parametric approximation for y = |x| and
do non-linear optimization
present this as a convex linear programming problem
Iterative Closest Point (ICP) Algorithm. p.

LP: Formulation
Absolute Values y = |x|
x y and x y while minimizing y

q
Euclidean Distance k~v k = vx2 + vy2
|rx~v | k~v k, |ry~v | k~v k

1.34
0.00
4.82 4.82

3.54
3.54

~v

1.34
0.00

4.58
2.00

3.54 5.00

Iterative Closest Point (ICP) Algorithm. p. 1

LP: Rigid Transformation


Arguments: rotation matrix R and translation vector ~t
Rigid Transformation:
p~ = R~p + ~t

Iterative Closest Point (ICP) Algorithm. p. 1

LP: Rigid Transformation


Arguments: rotation matrix R and translation vector ~t
Rigid Transformation:
p~ = R~p + ~t
Problem: How to ensure that R is rotation matrix?
Solution: Take a set of support vectors in object
space and specify their length explicitly.
kp~j p~k k kp~j p~k k = 0

p~i , p~j P

Iterative Closest Point (ICP) Algorithm. p. 1

LP
p~ = R~p + ~t
kp~i ~xi k di = 0

i, s.t. p~i P, ~xi X

kp~j p~k k kp~j p~k k = 0


P
Objective: minimize C = i di

p~i , p~j P

Iterative Closest Point (ICP) Algorithm. p. 1

LP: Problems
Contraction (shrinking):
kp~j p~k k kp~j p~k k = 0
is actually
kp~j p~k k kp~j p~k k 0
R matrix needs to be normalized to the nearest
orthonormal matrix due to our kxk LP
approximation even if no contraction occurred.

Iterative Closest Point (ICP) Algorithm. p. 1

LP: Results

1
0.8
0.6
0.4
0.2
0
1
0.5

1
0.5

0
0
0.5
0.5
1

Iterative Closest Point (ICP) Algorithm. p. 1

LP: Results
0.25

Rotation (R)

0.2
0.15
0.1
0.05
0

100

200

300
# of outliers

400

300
# of outliers

400

500

600
nd

2 norm
st
1 norm

Translation (t)

0.4

0.3

0.2

0.1
0

100

200

500

600

Iterative Closest Point (ICP) Algorithm. p. 1

LP: Conclusions
Presented problem is suitable to minimize L1 error
instead of L2 error commonly used.
Using L1 norm improved solution in the presence of
strong outliers.

Iterative Closest Point (ICP) Algorithm. p. 1

You might also like