Advanced Techniques for Mobile Robotics Camera...

44
Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz Camera Calibration Advanced Techniques for Mobile Robotics

Transcript of Advanced Techniques for Mobile Robotics Camera...

Page 1: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Wolfram Burgard, Cyrill Stachniss,

Kai Arras, Maren Bennewitz

Camera Calibration

Advanced Techniques for Mobile Robotics

Page 2: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

What is Camera Calibration?

§  A camera projects 3D world points onto the 2D image plane

§  Calibration: Find the quantities internal to the camera that affect this imaging process § Image center § Focal length § Lens distortion parameters

Page 3: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Why is Calibration Needed?

§  Camera production errors §  Cheap lenses Precise calibration is required for §  3D interpretation of images §  Construction of world models §  Robot interaction with the world

(hand-eye coordination)

Page 4: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Projective Space

§  Projective space is an extension of the Euclidean space

§  "Parallel lines intersect at infinity"

§  Here, equivalence is defined up to scale:

§  Special case: Projective Plane §  A linear transformation within is called a

homography

Page 5: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Homography

§  has 9-1(scale invariance)=8 DoF §  A pair of points gives us 2 equations §  Therefore, we need at least 4 point

correspondences for calculating a homography

Homography

Page 6: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Simple Pinhole Camera Model

Page 7: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Pinhole Camera Model

§  Perspective transformation using homogeneous coordinates:

Intrinsic camera parameters

Extrinsic camera parameters

Page 8: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Pinhole Camera Model

Page 9: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Pinhole Camera Model

§  Perspective transformation using homogeneous coordinates:

world/scene coordinate system

Page 10: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Pinhole Camera Model

§  Perspective transformation using homogeneous coordinates:

camera coordinate system

Page 11: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Pinhole Camera Model

§  Perspective transformation using homogeneous coordinates:

image coordinate system

Page 12: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Pinhole Camera Model

§  Interpretation of intrinsic camera parameters:

Page 13: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Pinhole Camera Model

§  Interpretation of intrinsic camera parameters:

focal length x-offset

y-offset

Page 14: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Camera Calibration

§  Calculate intrinsic parameters (later: and lens distortion parameters) from a series of images §  2D camera calibration §  3D camera calibration §  Self calibration

Page 15: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Camera Calibration

§  Calculate intrinsic parameters (later: and lens distortion parameters) from a series of images §  2D camera calibration §  3D camera calibration §  Self calibration

needs an external pattern

Page 16: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

2D Camera Calibration §  Use a 2D pattern (e.g., a checkerboard)

§  Size and structure of the pattern is known

Page 17: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Trick for 2D Camera Calibration §  Use a 2D pattern (e.g., a checkerboard)

§  Trick: set the world coordinate system to the corner of the checkerboard

Page 18: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Trick for 2D Camera Calibration §  Use a 2D pattern (e.g., a checkerboard)

§  Trick: set the world coordinate system to the corner of the checkerboard

§  Now: All points on the checkerboard lie on one plane!

Page 19: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

§  Since all points lie on a plane, their component is 0 in world coordinates

Trick for 2D Camera Calibration

Page 20: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Trick for 2D Camera Calibration

§  Since all points lie on a plane, their component is 0 in world coordinates

Page 21: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

§  Since all points lie on a plane, their component is 0 in world coordinates

§  Thus, we can delete the 3rd column of the extrinsic parameter matrix

Trick for 2D Camera Calibration

Page 22: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

§  Since all points lie on a plane, their component is 0 in world coordinates

§  Thus, we can delete the 3rd column of the extrinsic parameter matrix

Simplified Form for 2D Camera Calibration

Page 23: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

§  Since all points lie on a plane, their component is 0 in world coordinates

§  Thus, we can delete the 3rd column of the extrinsic parameter matrix

Simplified Form for 2D Camera Calibration

Homography

Page 24: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Setting Up the Equations

Page 25: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Setting Up the Equations

Page 26: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

§  Note that form an orthonormal basis, thus:

Exploit Constraints

Page 27: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Exploit Constraints

Page 28: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Exploit Constraints

Page 29: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Exploit Constraints

Page 30: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Use Both Equations

Page 31: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

§  is symmetric and positive definite but only defined up to a scale factor

Equations from Constraints

Page 32: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

§  is symmetric and positive definite but only defined up to a scale factor

§  Thus:

Equations from Constraints

Note: K can be calculated from B using Cholesky factorization ( i.e. )

Page 33: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

§  is symmetric and positive definite but only defined up to a scale factor

§  Thus:

§  Define:

Build System of Equations

Note: K can be calculated from B using Cholesky factorization ( i.e. )

Page 34: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

§  is symmetric and positive definite but only defined up to a scale factor

§  Thus:

§  Define: §  can be used to construct a system of

equations in form of

Build System of Equations

Note: K can be calculated from B using Cholesky factorization ( i.e. )

Page 35: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

The Matrix V §  Setting up the matrix

with

§  For one image, we obtain

§  For multiple, we stack the matrices to one 2n x 6 matrix

image 1

image n

Page 36: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Direct Linear Transformation

§  Each plane gives us two equations §  Since has 6 degrees of freedom, we need

at least 3 different views of a plane

§  We need at least 4 points per plane §  Solve

Page 37: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Solving the Linear System

§  The system has a trivial solution §  This system has the trivial solution

which will not lead to a valid matrix §  Solution: impose constraint

Page 38: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

In Reality…

§  Real measurements are corrupted with noise Find the maximum likelihood solution that minimizes the least-squares error with

Page 39: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

In Reality…

§  Real measurements are corrupted with noise Find the maximum likelihood solution that minimizes the least-squares error

§  Minimize §  Compute derivative, set to zero, … §  Results in §  Eigenvalue/eigenvector problem

with

Page 40: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Non-linear effects: §  Radial distortion §  Tangential distortion

§  Compute the corrected image point:

Lens Distortion Model

where : radial distortion coefficients

: tangential distortion coefficients

Page 41: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Error Minimization

§  Lens distortion can be calculated by minimizing a non-linear error function

…linearize to obtain a quadratic function, compute derivative, set it to 0, solve linear system, iterate…

Page 42: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Error Minimization

§  Lens distortion can be calculated by minimizing a non-linear error function

§  In practice: estimation of the lens distortion parameters using techniques such as Levenberg-Marquardt

§  The parameters obtained by the linear function are used as starting values

Page 43: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Results: Webcam

§  Before calibration:

§  After calibration:

Page 44: Advanced Techniques for Mobile Robotics Camera Calibrationais.informatik.uni-freiburg.de/.../rob2-08-camera... · Camera Calibration Advanced Techniques for Mobile Robotics . What

Summary

§  Pinhole camera model §  Non-linear model for lens distortion §  Approach to 2D camera calibration that

§  accurately determines the model parameters §  is easy to realize