Visual Servoing Platform
version 3.4.0
|
#include <vpCameraParameters.h>
Public Types | |
enum | vpCameraParametersProjType { perspectiveProjWithoutDistortion, perspectiveProjWithDistortion, ProjWithKannalaBrandtDistortion } |
Public Member Functions | |
vpCameraParameters () | |
vpCameraParameters (const vpCameraParameters &c) | |
vpCameraParameters (double px, double py, double u0, double v0) | |
vpCameraParameters (double px, double py, double u0, double v0, double kud, double kdu) | |
vpCameraParameters (double px, double py, double u0, double v0, const std::vector< double > &distortion_coefficients) | |
vpCameraParameters & | operator= (const vpCameraParameters &c) |
bool | operator== (const vpCameraParameters &c) const |
bool | operator!= (const vpCameraParameters &c) const |
virtual | ~vpCameraParameters () |
void | init () |
void | init (const vpCameraParameters &c) |
void | initFromCalibrationMatrix (const vpMatrix &_K) |
void | initFromFov (const unsigned int &w, const unsigned int &h, const double &hfov, const double &vfov) |
void | initPersProjWithoutDistortion (double px, double py, double u0, double v0) |
void | initPersProjWithDistortion (double px, double py, double u0, double v0, double kud, double kdu) |
void | initProjWithKannalaBrandtDistortion (double px, double py, double u0, double v0, const std::vector< double > &distortion_coefficients) |
bool | isFovComputed () const |
void | computeFov (const unsigned int &w, const unsigned int &h) |
double | getHorizontalFovAngle () const |
double | getVerticalFovAngle () const |
std::vector< vpColVector > | getFovNormals () const |
double | get_px () const |
double | get_px_inverse () const |
double | get_py_inverse () const |
double | get_py () const |
double | get_u0 () const |
double | get_v0 () const |
double | get_kud () const |
double | get_kdu () const |
std::vector< double > | getKannalaBrandtDistortionCoefficients () const |
vpCameraParametersProjType | get_projModel () const |
vpMatrix | get_K () const |
vpMatrix | get_K_inverse () const |
void | printParameters () |
Friends | |
class | vpMeterPixelConversion |
class | vpPixelMeterConversion |
VISP_EXPORT std::ostream & | operator<< (std::ostream &os, const vpCameraParameters &cam) |
Generic class defining intrinsic camera parameters.
Two camera models are implemented in ViSP.
I. Pinhole camera model
In this model [31], a scene view is formed by projecting 3D points into the image plane using a perspective transformation.
where:
When , the previous equation is equivalent to the following:
Real lenses usually have some radial distortion. So, the above model is extended as:
where is the first order radial distorsion. Higher order distorsion coefficients are not considered in ViSP.
Now in ViSP we consider also the inverse transformation, where from pixel coordinates we want to compute their normalized coordinates in the image plane. Previous equations could be written like:
Considering radial distortion, the above model is extended as:
Finally, in ViSP the main intrinsic camera parameters are the ratio between the focal length and the size of a pixel, and the coordinates of the principal point in pixel. The lens distortion can also be considered by two additional parameters .
From a practical point of view, two kinds of camera modelisation are implemented in this class:
1. Camera parameters for a perspective projection without distortion model
In this modelisation, only parameters are considered.
Initialization of such a model can be done using:
2. Camera parameters for a perspective projection with distortion model
In this modelisation, all the parameters are considered. Initialization of such a model can be done using:
The selection of the camera model (without or with distorsion) is done during vpCameraParameters initialisation.
Here an example of camera initialisation, for a model without distortion. A complete example is given in initPersProjWithoutDistortion().
Here an example of camera initialisation, for a model with distortion. A complete example is given in initPersProjWithDistortion().
The code below shows how to know the currently used projection model:
An XML parser for camera parameters is also provided in vpXmlParserCamera.
II. Kannala-Brandt camera model
This model [21] deals with fish-eye lenses designed to cover the whole hemispherical field in front of the camera and the angle of view is very large. In this case, the inherent distortion of a fish-eye lens should not be considered only as a derivation from the pinhole model.
The following projection in the general form is adapted:
where:
In ViSP, we only consider radially symmetric distortions (caused by fisheye lenses).
Definition at line 258 of file vpCameraParameters.h.
Definition at line 264 of file vpCameraParameters.h.
vpCameraParameters::vpCameraParameters | ( | ) |
Default constructor. By default, a perspective projection without distortion model is set.
Definition at line 72 of file vpCameraParameters.cpp.
References init().
vpCameraParameters::vpCameraParameters | ( | const vpCameraParameters & | c | ) |
vpCameraParameters::vpCameraParameters | ( | double | cam_px, |
double | cam_py, | ||
double | cam_u0, | ||
double | cam_v0 | ||
) |
Constructor for perspective projection without distortion model
cam_px,cam_py | : pixel size |
cam_u0,cam_v0 | : principal points |
Definition at line 100 of file vpCameraParameters.cpp.
References initPersProjWithoutDistortion().
vpCameraParameters::vpCameraParameters | ( | double | cam_px, |
double | cam_py, | ||
double | cam_u0, | ||
double | cam_v0, | ||
double | cam_kud, | ||
double | cam_kdu | ||
) |
Constructor for perspective projection with distortion model
cam_px,cam_py | : pixel size |
cam_u0,cam_v0 | : principal points |
cam_kud | : undistorted to distorted radial distortion |
cam_kdu | : distorted to undistorted radial distortion |
Definition at line 118 of file vpCameraParameters.cpp.
References initPersProjWithDistortion().
vpCameraParameters::vpCameraParameters | ( | double | cam_px, |
double | cam_py, | ||
double | cam_u0, | ||
double | cam_v0, | ||
const std::vector< double > & | coefficients | ||
) |
Constructor for projection with Kannala-Brandt distortion model
cam_px,cam_py | : pixel size |
cam_u0,cam_v0 | : principal points |
coefficients | : distorsion model coefficients |
Definition at line 136 of file vpCameraParameters.cpp.
References initProjWithKannalaBrandtDistortion().
|
virtual |
void vpCameraParameters::computeFov | ( | const unsigned int & | w, |
const unsigned int & | h | ||
) |
Compute angles and normals of the FOV.
w | : Width of the image |
h | : Height of the image. |
Definition at line 477 of file vpCameraParameters.cpp.
References vpColVector::normalize().
Referenced by vpMbTracker::computeProjectionErrorImpl(), vpMbtFaceDepthDense::computeROI(), vpMbtFaceDepthNormal::computeROI(), vpMbtFaceDepthNormal::displayFeature(), vpMbDepthDenseTracker::getModelForDisplay(), vpMbDepthNormalTracker::getModelForDisplay(), vpMbtDistanceLine::getModelForDisplay(), vpMbKltTracker::getModelForDisplay(), vpMbDepthDenseTracker::init(), vpMbDepthNormalTracker::init(), vpMbEdgeTracker::init(), initFromFov(), vpMbtDistanceLine::initMovingEdge(), vpMbtPolygon::isVisible(), vpMbEdgeKltTracker::postTracking(), vpMbKltTracker::reinit(), vpMbEdgeKltTracker::setPose(), vpMbKltTracker::setPose(), vpMbGenericTracker::track(), and vpMbtDistanceLine::updateMovingEdge().
vpMatrix vpCameraParameters::get_K | ( | ) | const |
Return the camera matrix given by:
Definition at line 537 of file vpCameraParameters.cpp.
Referenced by vpMbEdgeTracker::downScale(), vpPose::poseFromRectangle(), and vpMbEdgeTracker::upScale().
vpMatrix vpCameraParameters::get_K_inverse | ( | ) | const |
Return the inverted camera matrix given by:
Definition at line 559 of file vpCameraParameters.cpp.
|
inline |
Definition at line 364 of file vpCameraParameters.h.
Referenced by vpCalibration::computeStdDeviation_dist().
|
inline |
Definition at line 363 of file vpCameraParameters.h.
Referenced by vpCalibration::computeStdDeviation_dist(), vpCalibration::displayGrid(), vpImageTools::initUndistortMap(), and vpImageTools::undistort().
|
inline |
Definition at line 367 of file vpCameraParameters.h.
Referenced by vpImageTools::initUndistortMap().
|
inline |
Definition at line 357 of file vpCameraParameters.h.
Referenced by vpFeatureLuminance::buildFrom(), vpHomography::collineation2homography(), vpCalibration::computeCalibration(), vpCalibration::computeCalibrationMulti(), vpMbtDistanceLine::computeInteractionMatrixError(), vpMbtDistanceCylinder::computeInteractionMatrixError(), vpCircle::computeIntersectionPoint(), vpKeyPoint::computePose(), vpCalibration::computeStdDeviation(), vpCalibration::computeStdDeviation_dist(), vpMbEdgeKltTracker::computeVVS(), vpMbEdgeTracker::computeVVSFirstPhase(), vpMbKltTracker::computeVVSInit(), vpMbEdgeTracker::computeVVSInit(), vpPixelMeterConversion::convertEllipse(), vpMeterPixelConversion::convertEllipse(), vpCalibration::displayGrid(), vpMomentObject::fromImage(), vpHomography::homography2collineation(), vpSimulatorAfma6::initDisplay(), vpSimulatorViper850::initDisplay(), vpImageTools::initUndistortMap(), vpSimulatorAfma6::setCameraParameters(), vpSimulatorViper850::setCameraParameters(), vpSimulator::setExternalCameraParameters(), vpWireFrameSimulator::setExternalCameraParameters(), vpSimulator::setInternalCameraParameters(), vpWireFrameSimulator::setInternalCameraParameters(), vpImageTools::undistort(), and vpAROgre::updateCameraProjection().
|
inline |
Definition at line 358 of file vpCameraParameters.h.
Referenced by vpHomography::collineation2homography(), and vpHomography::homography2collineation().
|
inline |
Definition at line 360 of file vpCameraParameters.h.
Referenced by vpFeatureLuminance::buildFrom(), vpHomography::collineation2homography(), vpCalibration::computeCalibration(), vpCalibration::computeCalibrationMulti(), vpMbtDistanceLine::computeInteractionMatrixError(), vpMbtDistanceCylinder::computeInteractionMatrixError(), vpCircle::computeIntersectionPoint(), vpKeyPoint::computePose(), vpCalibration::computeStdDeviation(), vpCalibration::computeStdDeviation_dist(), vpPixelMeterConversion::convertEllipse(), vpMeterPixelConversion::convertEllipse(), vpCalibration::displayGrid(), vpMomentObject::fromImage(), vpHomography::homography2collineation(), vpSimulatorAfma6::initDisplay(), vpSimulatorViper850::initDisplay(), vpImageTools::initUndistortMap(), vpSimulatorAfma6::setCameraParameters(), vpSimulatorViper850::setCameraParameters(), vpSimulator::setExternalCameraParameters(), vpWireFrameSimulator::setExternalCameraParameters(), vpSimulator::setInternalCameraParameters(), vpWireFrameSimulator::setInternalCameraParameters(), vpImageTools::undistort(), and vpAROgre::updateCameraProjection().
|
inline |
Definition at line 359 of file vpCameraParameters.h.
Referenced by vpHomography::collineation2homography(), and vpHomography::homography2collineation().
|
inline |
Definition at line 361 of file vpCameraParameters.h.
Referenced by vpHomography::collineation2homography(), vpCalibration::computeCalibration(), vpCalibration::computeCalibrationMulti(), vpMbtDistanceLine::computeInteractionMatrixError(), vpMbtDistanceCylinder::computeInteractionMatrixError(), vpCircle::computeIntersectionPoint(), vpKeyPoint::computePose(), vpCalibration::computeStdDeviation(), vpCalibration::computeStdDeviation_dist(), vpCalibration::displayGrid(), vpHomography::homography2collineation(), vpImageTools::initUndistortMap(), vpImageTools::undistort(), and vpAROgre::updateCameraProjection().
|
inline |
Definition at line 362 of file vpCameraParameters.h.
Referenced by vpHomography::collineation2homography(), vpCalibration::computeCalibration(), vpCalibration::computeCalibrationMulti(), vpMbtDistanceLine::computeInteractionMatrixError(), vpMbtDistanceCylinder::computeInteractionMatrixError(), vpCircle::computeIntersectionPoint(), vpKeyPoint::computePose(), vpCalibration::computeStdDeviation(), vpCalibration::computeStdDeviation_dist(), vpCalibration::displayGrid(), vpHomography::homography2collineation(), vpImageTools::initUndistortMap(), vpImageTools::undistort(), and vpAROgre::updateCameraProjection().
|
inline |
Get the list of the normals corresponding to planes describing the field of view.
Definition at line 348 of file vpCameraParameters.h.
References vpTRACE.
Referenced by vpPolygon3D::computePolygonClipped().
|
inline |
Get the horizontal angle in radian of the field of view.
Definition at line 311 of file vpCameraParameters.h.
References vpTRACE.
|
inline |
Definition at line 365 of file vpCameraParameters.h.
Referenced by vpPixelMeterConversion::convertPoint(), vpMeterPixelConversion::convertPoint(), and vpImageTools::initUndistortMap().
|
inline |
Get the vertical angle in radian of the field of view.
Definition at line 327 of file vpCameraParameters.h.
References vpTRACE.
void vpCameraParameters::init | ( | ) |
basic initialization with the default parameters
Definition at line 149 of file vpCameraParameters.cpp.
References vpException::divideByZeroError.
Referenced by vpCameraParameters().
void vpCameraParameters::init | ( | const vpCameraParameters & | c | ) |
initialization from another vpCameraParameters object
Definition at line 322 of file vpCameraParameters.cpp.
void vpCameraParameters::initFromCalibrationMatrix | ( | const vpMatrix & | _K | ) |
initialise the camera from a calibration matrix. Using a calibration matrix leads to a camera without distortion
The K matrix in parameters must be like:
_K | : the 3by3 calibration matrix |
Definition at line 338 of file vpCameraParameters.cpp.
References vpException::badValue, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), and initPersProjWithoutDistortion().
Referenced by vpMbEdgeTracker::downScale(), and vpMbEdgeTracker::upScale().
void vpCameraParameters::initFromFov | ( | const unsigned int & | w, |
const unsigned int & | h, | ||
const double & | hfov, | ||
const double & | vfov | ||
) |
Initialize the camera model without distorsion from the image dimension and the camera field of view.
w | : Image width. |
h | : Image height. |
hfov | : Camera horizontal field of view angle expressed in radians. |
vfov | : Camera vertical field of view angle expressed in radians. |
The following sample code shows how to use this function:
It produces the following output:
Definition at line 382 of file vpCameraParameters.cpp.
References computeFov(), and perspectiveProjWithoutDistortion.
void vpCameraParameters::initPersProjWithDistortion | ( | double | cam_px, |
double | cam_py, | ||
double | cam_u0, | ||
double | cam_v0, | ||
double | cam_kud, | ||
double | cam_kdu | ||
) |
Initialization with specific parameters using perpective projection with distortion model.
cam_px,cam_py | : the ratio between the focal length and the size of a pixel. |
cam_u0,cam_v0 | : principal points coordinates in pixels. |
cam_kud | : undistorted to distorted radial distortion. |
cam_kdu | : distorted to undistorted radial distortion. |
The following sample code shows how to use this function:
It produces the following output:
Definition at line 262 of file vpCameraParameters.cpp.
References vpException::divideByZeroError, and perspectiveProjWithDistortion.
Referenced by vpViper650::getCameraParameters(), vpViper850::getCameraParameters(), vpAfma6::getCameraParameters(), vpRealSense2::getCameraParameters(), vpRealSense::getCameraParameters(), vpKinect::start(), and vpCameraParameters().
void vpCameraParameters::initPersProjWithoutDistortion | ( | double | cam_px, |
double | cam_py, | ||
double | cam_u0, | ||
double | cam_v0 | ||
) |
Initialization with specific parameters using perpective projection without distortion model.
cam_px,cam_py | : the ratio between the focal length and the size of a pixel. |
cam_u0,cam_v0 | : principal point coordinates in pixels. |
The following sample code shows how to use this function:
It produces the following output:
Definition at line 198 of file vpCameraParameters.cpp.
References vpException::divideByZeroError, and perspectiveProjWithoutDistortion.
Referenced by vpServolens::getCameraParameters(), vpViper650::getCameraParameters(), vpViper850::getCameraParameters(), vpAfma6::getCameraParameters(), vpSimulatorAfma6::getCameraParameters(), vpSimulatorViper850::getCameraParameters(), vpRealSense2::getCameraParameters(), vpRealSense::getCameraParameters(), vpSimulatorAfma6::initDisplay(), vpSimulatorViper850::initDisplay(), initFromCalibrationMatrix(), and vpCameraParameters().
void vpCameraParameters::initProjWithKannalaBrandtDistortion | ( | double | cam_px, |
double | cam_py, | ||
double | cam_u0, | ||
double | cam_v0, | ||
const std::vector< double > & | coefficients | ||
) |
Initialization with specific parameters using Kannala-Brandt distortion model
cam_px,cam_py | : The ratio between the focal length and the size of a pixel. |
cam_u0,cam_v0 | : Principal points coordinates in pixels. |
coefficients | : Distorsion coefficients. |
Definition at line 290 of file vpCameraParameters.cpp.
References vpException::divideByZeroError, and ProjWithKannalaBrandtDistortion.
Referenced by vpRealSense2::getCameraParameters(), and vpCameraParameters().
|
inline |
Specify if the fov has been computed.
Definition at line 300 of file vpCameraParameters.h.
Referenced by vpPolygon3D::computePolygonClipped().
bool vpCameraParameters::operator!= | ( | const vpCameraParameters & | c | ) | const |
False if the two objects are absolutely identical.
Definition at line 467 of file vpCameraParameters.cpp.
vpCameraParameters & vpCameraParameters::operator= | ( | const vpCameraParameters & | cam | ) |
copy operator
Definition at line 400 of file vpCameraParameters.cpp.
bool vpCameraParameters::operator== | ( | const vpCameraParameters & | c | ) | const |
True if the two objects are absolutely identical.
Definition at line 427 of file vpCameraParameters.cpp.
References vpMath::equal().
void vpCameraParameters::printParameters | ( | ) |
Print the camera parameters on the standard output
Definition at line 576 of file vpCameraParameters.cpp.
References perspectiveProjWithDistortion, perspectiveProjWithoutDistortion, and ProjWithKannalaBrandtDistortion.
Referenced by vpCalibration::computeCalibration(), and vpCalibration::computeCalibrationMulti().
|
friend |
Print on the output stream os the camera parameters.
os | : Output stream. |
cam | : Camera parameters. |
Definition at line 611 of file vpCameraParameters.cpp.
|
friend |
Definition at line 260 of file vpCameraParameters.h.
|
friend |
Definition at line 261 of file vpCameraParameters.h.