ViSP
2.9.0
|
#include <vpRotationMatrix.h>
Public Types | |
enum | vpDetMethod { LU_DECOMPOSITION } |
Public Member Functions | |
void | init () |
void | setIdentity () |
void | eye () |
vpRotationMatrix () | |
vpRotationMatrix (const vpRotationMatrix &R) | |
vpRotationMatrix (const vpThetaUVector &r) | |
vpRotationMatrix (const vpRzyzVector &r) | |
vpRotationMatrix (const vpRxyzVector &r) | |
vpRotationMatrix (const vpRzyxVector &r) | |
vpRotationMatrix (const double tux, const double tuy, const double tuz) | |
vpRotationMatrix (const vpQuaternionVector &q) | |
vpRotationMatrix & | operator= (const vpRotationMatrix &R) |
vpRotationMatrix & | operator= (const vpMatrix &m) |
vpTranslationVector | operator* (const vpTranslationVector &mat) const |
vpRotationMatrix | operator* (const vpRotationMatrix &B) const |
vpMatrix | operator* (const vpMatrix &B) const |
vpColVector | operator* (const vpColVector &v) const |
vpRotationMatrix | operator+ (const vpRotationMatrix &B) const |
vpRotationMatrix | operator- (const vpRotationMatrix &B) const |
vpRotationMatrix | t () const |
vpRotationMatrix | inverse () const |
void | inverse (vpRotationMatrix &M) const |
bool | isARotationMatrix () const |
void | printVector () |
vpRotationMatrix | buildFrom (const vpThetaUVector &v) |
vpRotationMatrix | buildFrom (const vpRzyzVector &v) |
vpRotationMatrix | buildFrom (const vpRxyzVector &v) |
vpRotationMatrix | buildFrom (const vpRzyxVector &v) |
vpRotationMatrix | buildFrom (const double tux, const double tuy, const double tuz) |
vpRotationMatrix | buildFrom (const vpQuaternionVector &q) |
void | kill () |
void | eye (unsigned int n) |
void | eye (unsigned int m, unsigned int n) |
void | setIdentity (const double &val=1.0) |
void | insert (const vpMatrix &A, const unsigned int r, const unsigned int c) |
void | stackMatrices (const vpMatrix &A) |
Columns, Rows extraction, Submatrix | |
void | init (const vpMatrix &m, unsigned int r, unsigned int c, unsigned int nrows, unsigned int ncols) |
vpRowVector | row (const unsigned int i) |
vpColVector | column (const unsigned int j) |
Set/get Matrix size | |
unsigned int | getRows () const |
unsigned int | getCols () const |
void | resize (const unsigned int nrows, const unsigned int ncols, const bool nullify=true) |
double | getMinValue () const |
double | getMaxValue () const |
Copy / assignment | |
vpMatrix & | operator<< (double *) |
void | diag (const vpColVector &A) |
Printing | |
int | print (std::ostream &s, unsigned int length, char const *intro=0) |
std::ostream & | matlabPrint (std::ostream &os) const |
std::ostream & | maplePrint (std::ostream &os) const |
std::ostream & | csvPrint (std::ostream &os) const |
std::ostream & | cppPrint (std::ostream &os, const char *matrixName=NULL, bool octet=false) const |
void | printSize () |
Access/modification operators | |
double * | operator[] (unsigned int i) |
double * | operator[] (unsigned int i) const |
Kronecker product | |
void | kron (const vpMatrix &m1, vpMatrix &out) |
vpMatrix | kron (const vpMatrix &m1) |
void | stackColumns (vpColVector &out) |
vpColVector | stackColumns () |
void | stackRows (vpRowVector &out) |
vpRowVector | stackRows () |
Matrix operations | |
vpMatrix & | operator+= (const vpMatrix &B) |
vpMatrix & | operator+= (const double x) |
vpMatrix & | operator-= (const vpMatrix &B) |
vpMatrix & | operator-= (const double x) |
vpMatrix | operator* (const vpHomography &H) const |
vpMatrix | operator* (const double x) const |
vpMatrix | operator+ (const vpMatrix &B) const |
vpMatrix | operator- (const vpMatrix &B) const |
vpMatrix | operator- () const |
vpMatrix & | operator*= (const double x) |
vpMatrix & | operator/= (double x) |
vpMatrix | operator/ (const double x) const |
double | sumSquare () const |
double | det (vpDetMethod method=LU_DECOMPOSITION) const |
vpMatrix | expm () |
Transpose, Identity | |
vpMatrix | transpose () const |
void | transpose (vpMatrix &C) const |
vpMatrix | AAt () const |
void | AAt (vpMatrix &B) const |
vpMatrix | AtA () const |
void | AtA (vpMatrix &B) const |
Matrix inversion | |
vpMatrix | inverseByLU () const |
vpMatrix | inverseByCholesky () const |
vpMatrix | inverseByCholeskyLapack () const |
vpMatrix | inverseByQR () const |
vpMatrix | inverseByQRLapack () const |
vpMatrix | pseudoInverse (double svThreshold=1e-6) const |
unsigned int | pseudoInverse (vpMatrix &Ap, double svThreshold=1e-6) const |
unsigned int | pseudoInverse (vpMatrix &Ap, vpColVector &sv, double svThreshold=1e-6) const |
unsigned int | pseudoInverse (vpMatrix &Ap, vpColVector &sv, double svThreshold, vpMatrix &ImA, vpMatrix &ImAt) const |
unsigned int | pseudoInverse (vpMatrix &Ap, vpColVector &sv, double svThreshold, vpMatrix &ImA, vpMatrix &ImAt, vpMatrix &kerA) const |
SVD decomposition | |
void | svd (vpColVector &w, vpMatrix &v) |
void | solveBySVD (const vpColVector &B, vpColVector &x) const |
vpColVector | solveBySVD (const vpColVector &B) const |
unsigned int | kernel (vpMatrix &KerA, double svThreshold=1e-6) |
double | cond () |
Eigen values | |
vpColVector | eigenValues () |
void | eigenValues (vpColVector &evalue, vpMatrix &evector) |
Norms | |
double | euclideanNorm () const |
double | infinityNorm () const |
Static Public Member Functions | |
static void | add2Matrices (const vpMatrix &A, const vpMatrix &B, vpMatrix &C) |
static void | add2WeightedMatrices (const vpMatrix &A, const double &wA, const vpMatrix &B, const double &wB, vpMatrix &C) |
static vpMatrix | computeCovarianceMatrix (const vpMatrix &A, const vpColVector &x, const vpColVector &b) |
static vpMatrix | computeCovarianceMatrix (const vpMatrix &A, const vpColVector &x, const vpColVector &b, const vpMatrix &w) |
static void | computeHLM (const vpMatrix &H, const double &alpha, vpMatrix &HLM) |
static void | createDiagonalMatrix (const vpColVector &A, vpMatrix &DA) |
static vpMatrix | insert (const vpMatrix &A, const vpMatrix &B, const unsigned int r, const unsigned int c) |
static void | insert (const vpMatrix &A, const vpMatrix &B, vpMatrix &C, const unsigned int r, const unsigned int c) |
static vpMatrix | juxtaposeMatrices (const vpMatrix &A, const vpMatrix &B) |
static void | juxtaposeMatrices (const vpMatrix &A, const vpMatrix &B, vpMatrix &C) |
static void | kron (const vpMatrix &m1, const vpMatrix &m2, vpMatrix &out) |
static vpMatrix | kron (const vpMatrix &m1, const vpMatrix &m2) |
static bool | loadMatrix (std::string filename, vpMatrix &M, const bool binary=false, char *Header=NULL) |
static bool | loadMatrix (const char *filename, vpMatrix &M, const bool binary=false, char *Header=NULL) |
static void | mult2Matrices (const vpMatrix &A, const vpMatrix &B, vpMatrix &C) |
static void | multMatrixVector (const vpMatrix &A, const vpColVector &b, vpColVector &c) |
static void | negateMatrix (const vpMatrix &A, vpMatrix &C) |
static bool | saveMatrix (std::string filename, const vpMatrix &M, const bool binary=false, const char *Header="") |
static bool | saveMatrix (const char *filename, const vpMatrix &M, const bool binary=false, const char *Header="") |
static bool | saveMatrixYAML (std::string filename, const vpMatrix &M, const char *header="") |
static bool | saveMatrixYAML (const char *filename, const vpMatrix &M, const char *header="") |
static bool | loadMatrixYAML (std::string filename, vpMatrix &M, char *header=NULL) |
static bool | loadMatrixYAML (const char *filename, vpMatrix &M, char *header=NULL) |
static vpMatrix | stackMatrices (const vpMatrix &A, const vpMatrix &B) |
static void | stackMatrices (const vpMatrix &A, const vpMatrix &B, vpMatrix &C) |
static void | sub2Matrices (const vpMatrix &A, const vpMatrix &B, vpMatrix &C) |
Public Attributes | |
double * | data |
Protected Attributes | |
unsigned int | rowNum |
unsigned int | colNum |
double ** | rowPtrs |
unsigned int | dsize |
unsigned int | trsize |
Friends | |
class | vpMatrix |
class | vpRxyzVector |
class | vpRzyzVector |
class | vpRzyxVector |
class | vpThetaUVector |
class | vpTranslationVector |
VISP_EXPORT std::ostream & | operator<< (std::ostream &s, const vpRotationMatrix &m) |
Related Functions | |
(Note that these are not member functions.) | |
enum | vpGEMMmethod |
vpMatrix | operator* (const double &x, const vpMatrix &B) |
void | vpGEMM (const vpMatrix &A, const vpMatrix &B, const double &alpha, const vpMatrix &C, const double &beta, vpMatrix &D, const unsigned int &ops=0) |
void | skew (const vpTranslationVector &t, vpMatrix &M) |
The vpRotationMatrix considers the particular case of a rotation matrix.
It is derived from vpMatrix.
Definition at line 72 of file vpRotationMatrix.h.
|
inherited |
Method used to compute the determinant of a square matrix.
Enumerator | |
---|---|
LU_DECOMPOSITION |
LU decomposition method. |
Definition at line 105 of file vpMatrix.h.
vpRotationMatrix::vpRotationMatrix | ( | ) |
basic constructor
initialize a rotation matrix as Identity
Definition at line 353 of file vpRotationMatrix.cpp.
References init().
vpRotationMatrix::vpRotationMatrix | ( | const vpRotationMatrix & | R | ) |
copy constructor
initialize a rotation matrix from another rotation matrix
Definition at line 363 of file vpRotationMatrix.cpp.
References init().
vpRotationMatrix::vpRotationMatrix | ( | const vpThetaUVector & | r | ) |
Construction from rotation (theta U parameterization)
Construction from rotation (Theta U parameterization)
Definition at line 370 of file vpRotationMatrix.cpp.
References buildFrom(), and init().
vpRotationMatrix::vpRotationMatrix | ( | const vpRzyzVector & | r | ) |
Construction from rotation (Euler parameterization)
Construction from rotation (Euler parameterization, ie Rzyz parameterization)
Definition at line 378 of file vpRotationMatrix.cpp.
References buildFrom(), and init().
vpRotationMatrix::vpRotationMatrix | ( | const vpRxyzVector & | r | ) |
Construction from rotation Rxyz.
Definition at line 387 of file vpRotationMatrix.cpp.
References buildFrom(), and init().
vpRotationMatrix::vpRotationMatrix | ( | const vpRzyxVector & | r | ) |
Construction from rotation Rzyx.
Definition at line 394 of file vpRotationMatrix.cpp.
References buildFrom(), and init().
vpRotationMatrix::vpRotationMatrix | ( | const double | tux, |
const double | tuy, | ||
const double | tuz | ||
) |
Construction from rotation (theta U parameterization)
Construction from rotation (Theta U parameterization)
Definition at line 401 of file vpRotationMatrix.cpp.
References buildFrom(), and init().
vpRotationMatrix::vpRotationMatrix | ( | const vpQuaternionVector & | q | ) |
Construct from rotation in quaternion representation.
Definition at line 410 of file vpRotationMatrix.cpp.
References buildFrom(), and init().
|
inherited |
Computes the operation
Definition at line 1297 of file vpMatrix.cpp.
|
inherited |
Compute the AAt operation such as .
The result is placed in the parameter B and not returned.
A new matrix won't be allocated for every use of the function. This results in a speed gain if used many times with the same result matrix size.
Definition at line 1317 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::resize(), vpMatrix::rowNum, vpMatrix::rowPtrs, vpCERROR, and vpERROR_TRACE.
|
staticinherited |
Operation C = A + B.
The result is placed in the third parameter C and not returned. A new matrix won't be allocated for every use of the function (Speed gain if used many times with the same result matrix size).
Definition at line 542 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpMatrix::resize(), vpMatrix::rowNum, vpMatrix::rowPtrs, and vpERROR_TRACE.
Referenced by vpMatrix::operator+().
|
staticinherited |
Operation C = A*wA + B*wB
The result is placed in the third parameter C and not returned. A new matrix won't be allocated for every use of the function (Speed gain if used many times with the same result matrix size).
Definition at line 503 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpMatrix::resize(), vpMatrix::rowNum, vpMatrix::rowPtrs, and vpERROR_TRACE.
|
inherited |
Compute the AtA operation such as
Definition at line 1408 of file vpMatrix.cpp.
Referenced by vpCalibration::calibrationTsai(), vpMbEdgeKltTracker::computeVVS(), vpMbKltTracker::computeVVS(), vpTemplateTrackerWarpHomographySL3::findWarp(), and vpNurbs::globalCurveApprox().
|
inherited |
Compute the AtA operation such as .
The result is placed in the parameter B and not returned.
A new matrix won't be allocated for every use of the function. This results in a speed gain if used many times with the same result matrix size.
Definition at line 1360 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::data, vpMatrix::resize(), vpMatrix::rowNum, vpCERROR, and vpERROR_TRACE.
vpRotationMatrix vpRotationMatrix::buildFrom | ( | const vpThetaUVector & | v | ) |
Transform a vector vpThetaUVector into an rotation matrix.
Definition at line 497 of file vpRotationMatrix.cpp.
References vpMath::mcosc(), and vpMath::sinc().
Referenced by vpVelocityTwistMatrix::buildFrom(), vpForceTwistMatrix::buildFrom(), buildFrom(), vpRzyzVector::buildFrom(), vpRzyxVector::buildFrom(), vpRxyzVector::buildFrom(), vpExponentialMap::direct(), vpRobotAfma6::setPosition(), and vpRotationMatrix().
vpRotationMatrix vpRotationMatrix::buildFrom | ( | const vpRzyzVector & | v | ) |
Transform a vector reprensenting the euler (Rzyz) angle into a rotation matrix
Transform a vector representing the euler angle into a rotation matrix. Rzyz = Rot( ) Rot( ) Rot( )
Definition at line 583 of file vpRotationMatrix.cpp.
vpRotationMatrix vpRotationMatrix::buildFrom | ( | const vpRxyzVector & | v | ) |
Transform a vector reprensenting the Rxyz angle into a rotation matrix.
Transform a vector representing the Rxyz angle into a rotation matrix.
Rxyz( ) = Rot( ) Rot( ) Rot( )
Definition at line 618 of file vpRotationMatrix.cpp.
vpRotationMatrix vpRotationMatrix::buildFrom | ( | const vpRzyxVector & | v | ) |
Transform a vector reprensenting the Rzyx angle into a rotation matrix.
Transform a vector representing the Rzyx angle into a rotation matrix.
Rxyz( ) Rot( ) Rot( )Rot( )
Definition at line 652 of file vpRotationMatrix.cpp.
vpRotationMatrix vpRotationMatrix::buildFrom | ( | const double | tux, |
const double | tuy, | ||
const double | tuz | ||
) |
Construction from rotation (theta U parameterization)
Definition at line 682 of file vpRotationMatrix.cpp.
References buildFrom().
vpRotationMatrix vpRotationMatrix::buildFrom | ( | const vpQuaternionVector & | q | ) |
Construction from rotation (as quaternion)
Definition at line 694 of file vpRotationMatrix.cpp.
References vpQuaternionVector::w(), vpQuaternionVector::x(), vpQuaternionVector::y(), and vpQuaternionVector::z().
|
inherited |
Column extraction.
Return the ith columns of the matrix.
Definition at line 2289 of file vpMatrix.cpp.
References vpMatrix::getRows().
Referenced by vpHomography::DLT(), vpPose::poseDementhonPlan(), and vpPose::poseFromRectangle().
|
staticinherited |
Compute the covariance matrix of the parameters x from a least squares minimisation defined as: Ax = b
A | : Matrix A from Ax = b. |
x | : Vector x from Ax = b corresponding to the parameters to estimate. |
b | : Vector b from Ax = b. |
Definition at line 56 of file vpMatrix_covariance.cpp.
References vpMatrix::pseudoInverse(), vpColVector::t(), and vpMatrix::t().
Referenced by vpMbEdgeKltTracker::computeVVS(), vpMbKltTracker::computeVVS(), vpMbEdgeTracker::computeVVS(), vpPose::poseVirtualVS(), and vpPose::poseVirtualVSrobust().
|
staticinherited |
Compute the covariance matrix of the parameters x from a least squares minimisation defined as: WAx = Wb
A | : Matrix A from WAx = Wb. |
x | : Vector x from WAx = Wb corresponding to the parameters to estimate. |
b | : Vector b from WAx = Wb. |
W | : Diagonal weigths matrix from WAx = Wb. |
Definition at line 74 of file vpMatrix_covariance.cpp.
References vpMatrix::pseudoInverse(), and vpMatrix::t().
|
staticinherited |
Compute
H | : input Matrix . This matrix should be square. |
alpha | : Scalar |
HLM | : Resulting operation. |
Definition at line 4051 of file vpMatrix.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpMatrix::resize(), and vpTRACE.
Referenced by vpTemplateTrackerWarpHomographySL3::findWarp(), vpTemplateTrackerSSDESM::initCompInverse(), vpTemplateTrackerSSDInverseCompositional::initCompInverse(), vpTemplateTrackerZNCCForwardAdditional::initHessienDesired(), vpTemplateTrackerZNCCInverseCompositional::initHessienDesired(), vpTemplateTracker::setHDes(), vpTemplateTrackerSSDForwardCompositional::trackNoPyr(), vpTemplateTrackerSSDESM::trackNoPyr(), and vpTemplateTrackerSSDForwardAdditional::trackNoPyr().
|
inherited |
Definition at line 4026 of file vpMatrix.cpp.
References vpMatrix::getCols(), and vpMatrix::svd().
|
inherited |
Print to be used as part of a C++ code later.
Print under the following form: vpMatrix A(6,4); A[0][0] = 1.4; A[0][1] = 0.6; ...
os | the stream to be printed in. |
matrixName | name of the matrix, "A" by default, to be used for the line vpMatrix A(6,7) (see example). |
octet | if false, print using double, if true, print byte per byte each bytes of the double array. |
Definition at line 2851 of file vpMatrix.cpp.
References vpMatrix::getRows().
|
staticinherited |
Create a diagonal matrix with the element of a vector .
A | : Vector which element will be put in the diagonal. |
DA | : Diagonal matrix DA[i][i] = A[i] |
Definition at line 2600 of file vpMatrix.cpp.
References vpMatrix::getRows(), vpMatrix::resize(), vpCERROR, and vpERROR_TRACE.
|
inherited |
Print matrix in csv format.
Print as comma separated values so that this output can be imported into any program which has a csv data import option: 0.939846, 0.0300754, 0.340272 0.0300788, 0.984961, -0.170136 -0.340272, 0.170136, 0.924807
Definition at line 2818 of file vpMatrix.cpp.
References vpMatrix::getCols(), and vpMatrix::getRows().
|
inherited |
Compute the determinant of a n-by-n matrix.
method | : Method used to compute the determinant. Default LU decomposition methos is faster than the method based on Gaussian elimination. |
Definition at line 3496 of file vpMatrix.cpp.
References vpMatrix::LU_DECOMPOSITION.
|
inherited |
Create a diagonal matrix with the element of a vector.
A | : Vector which element will be put in the diagonal. |
Definition at line 2572 of file vpMatrix.cpp.
References vpMatrix::getRows(), vpMatrix::resize(), vpCERROR, and vpERROR_TRACE.
Referenced by vpMbEdgeKltTracker::computeVVS(), vpMbKltTracker::computeVVS(), and vpMbEdgeTracker::computeVVS().
|
inherited |
Compute the eigenvalues of a n-by-n real symmetric matrix.
vpMatrixException::matrixError | If the matrix is not square or if the matrix is not symmetric. |
vpMatrixException::notImplementedError | If the GSL library is not detected |
Here an example:
Definition at line 3079 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrixException::matrixError, vpMatrixException::notImplementedError, vpMatrix::rowNum, vpMatrix::t(), and vpERROR_TRACE.
|
inherited |
Compute the eigenvalues of a n-by-n real symmetric matrix.
evalue | : Eigenvalues of the matrix. |
evector | : Eigenvector of the matrix. |
vpMatrixException::matrixError | If the matrix is not square or if the matrix is not symmetric. |
vpMatrixException::notImplementedError | If the GSL library is not detected |
Here an example:
Definition at line 3198 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::data, vpMatrixException::matrixError, vpMatrixException::notImplementedError, vpColVector::resize(), vpMatrix::resize(), vpMatrix::rowNum, vpMatrix::t(), and vpERROR_TRACE.
|
inherited |
Compute and return the Euclidean norm .
Definition at line 2899 of file vpMatrix.cpp.
References vpMatrix::data, and vpMatrix::dsize.
Referenced by vpSimulatorAfma6::setPosition().
|
inherited |
Compute the exponential matrix of a square matrix.
Definition at line 3868 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::data, vpMatrixException::incorrectMatrixSizeError, vpMatrix::inverseByLU(), vpMatrix::rowNum, vpMatrix::setIdentity(), and vpTRACE.
Referenced by vpTemplateTrackerWarpHomographySL3::computeCoeff().
void vpRotationMatrix::eye | ( | ) |
Initialize the rotation matrix as identity.
Definition at line 110 of file vpRotationMatrix.cpp.
References init().
|
inherited |
Set an n-by-n matrix to identity.
eye(n) is an n-by-n matrix with ones on the diagonal and zeros else where.
Definition at line 1181 of file vpMatrix.cpp.
References vpCERROR, and vpERROR_TRACE.
Referenced by vpServo::setServo().
|
inherited |
Set an m-by-n matrix to identity.
eye(m,n) is an m-by-n matrix with ones on the diagonal and zeros else where.
Definition at line 1201 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::resize(), vpMatrix::rowNum, vpCERROR, and vpERROR_TRACE.
|
inlineinherited |
Return the number of columns of the matrix.
Definition at line 163 of file vpMatrix.h.
Referenced by vpMatrix::add2Matrices(), vpMatrix::add2WeightedMatrices(), vpSubRowVector::checkParentStatus(), vpSubMatrix::checkParentStatus(), vpServo::computeControlLaw(), vpMatrix::computeHLM(), vpServo::computeInteractionMatrix(), vpMbTracker::computeJTR(), vpMatrix::cond(), vpMatrix::csvPrint(), vpImageSimulator::getImage(), vpSubRowVector::init(), vpSubMatrix::init(), vpCameraParameters::initFromCalibrationMatrix(), vpMatrix::insert(), vpMatrix::inverseByCholeskyLapack(), vpMatrix::inverseByQRLapack(), vpMatrix::juxtaposeMatrices(), vpMatrix::kernel(), vpMatrix::kron(), vpMatrix::maplePrint(), vpRowVector::operator*(), operator*(), vpVelocityTwistMatrix::operator*(), vpForceTwistMatrix::operator*(), vpMatrix::operator*(), vpMatrix::operator+=(), vpMatrix::operator-=(), vpSubRowVector::operator=(), vpRowVector::operator=(), vpSubColVector::operator=(), vpSubMatrix::operator=(), operator=(), vpColVector::operator=(), vpHomography::operator=(), vpPose::poseDementhonPlan(), vpMatrix::print(), vpMatrix::pseudoInverse(), vpIoTools::readConfigVar(), vpRowVector::reshape(), vpColVector::reshape(), vpMatrix::row(), vpMatrix::saveMatrix(), vpMatrix::saveMatrixYAML(), vpServo::secondaryTask(), vpRowVector::size(), vpMatrix::stackMatrices(), vpMatrix::sub2Matrices(), and vpMatrix::svd().
|
inherited |
Definition at line 3969 of file vpMatrix.cpp.
References vpMatrix::data, and vpMatrix::dsize.
|
inherited |
Definition at line 3955 of file vpMatrix.cpp.
References vpMatrix::data, and vpMatrix::dsize.
|
inlineinherited |
Return the number of rows of the matrix.
Definition at line 161 of file vpMatrix.h.
Referenced by vpMatrix::add2Matrices(), vpMatrix::add2WeightedMatrices(), vpLine::changeFrame(), vpSubColVector::checkParentStatus(), vpSubMatrix::checkParentStatus(), vpMatrix::column(), vpServo::computeError(), vpMatrix::computeHLM(), vpServo::computeInteractionMatrix(), vpMbTracker::computeJTR(), vpPtu46::computeMGD(), vpPose::computeResidual(), vpMbEdgeKltTracker::computeVVS(), vpMbKltTracker::computeVVS(), vpMbEdgeTracker::computeVVS(), vpMatrix::cppPrint(), vpMatrix::createDiagonalMatrix(), vpColVector::crossProd(), vpMatrix::csvPrint(), vpDot2::defineDots(), vpMatrix::diag(), vpProjectionDisplay::display(), vpColVector::dotProd(), vpGenericFeature::error(), vpImageFilter::filter(), vpPtu46::get_eJe(), vpBiclops::get_eJe(), vpPtu46::get_fJe(), vpBiclops::get_fJe(), vpBiclops::get_fMe(), vpGenericFeature::get_s(), vpBasicFeature::getDimension(), vpImageSimulator::getImage(), vpAfma6::getInverseKinematics(), vpViper::getInverseKinematicsWrist(), vpSubColVector::init(), vpSubMatrix::init(), vpCameraParameters::initFromCalibrationMatrix(), vpMatrix::insert(), vpFeatureLuminance::interaction(), vpGenericFeature::interaction(), vpMatrix::inverseByCholeskyLapack(), vpMatrix::inverseByLU(), vpMatrix::inverseByQRLapack(), vpColVector::invSort(), vpMatrix::juxtaposeMatrices(), vpMatrix::kernel(), vpScale::KernelDensity(), vpScale::KernelDensityGradient(), vpMatrix::kron(), vpMatrix::maplePrint(), vpMatrix::matlabPrint(), vpColVector::mean(), vpScale::MeanShift(), vpColVector::median(), vpRobust::MEstimator(), vpMatrix::multMatrixVector(), vpRowVector::operator*(), operator*(), vpVelocityTwistMatrix::operator*(), vpForceTwistMatrix::operator*(), vpMatrix::operator*(), vpMatrix::operator+=(), vpMatrix::operator-=(), vpColVector::operator<<(), vpSubColVector::operator=(), vpSubMatrix::operator=(), vpSubRowVector::operator=(), operator=(), vpColVector::operator=(), vpRGBa::operator=(), vpHomography::operator=(), vpPlot::plot(), vpPose::poseDementhonPlan(), vpPose::poseVirtualVSrobust(), vpKalmanFilter::prediction(), vpMatrix::print(), vpLine::projection(), vpMatrix::pseudoInverse(), vpIoTools::readConfigVar(), vpRowVector::reshape(), vpColVector::reshape(), vpMatrix::saveMatrix(), vpMatrix::saveMatrixYAML(), vpGenericFeature::set_s(), vpGenericFeature::setError(), vpGenericFeature::setInteractionMatrix(), vpSimulatorAfma6::setJointLimit(), vpSimulatorViper850::setJointLimit(), vpRobotBiclopsController::setPosition(), vpRobotAfma4::setPosition(), vpRobotBiclopsController::setVelocity(), vpRobotPtu46::setVelocity(), vpRobotBiclops::setVelocity(), vpSimulatorAfma6::setVelocity(), vpSimulatorViper850::setVelocity(), vpRobotAfma4::setVelocity(), vpLine::setWorldCoordinates(), vpRobust::simultMEstimator(), vpColVector::size(), vpColVector::skew(), vpColVector::sort(), vpColVector::stack(), vpMatrix::stackMatrices(), vpMatrix::sub2Matrices(), vpMatrix::svd(), and vpColVector::vpColVector().
|
inherited |
Compute and return the infinity norm with where is the matrix size.
Definition at line 2923 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::rowNum, and vpMatrix::rowPtrs.
void vpRotationMatrix::init | ( | ) |
Basic initialisation (identity)
Initializes a 3x3 rotation matrix as identity
Definition at line 73 of file vpRotationMatrix.cpp.
References vpMatrix::resize(), and vpERROR_TRACE.
Referenced by eye(), setIdentity(), and vpRotationMatrix().
|
inherited |
subvpMatrix extraction
Definition at line 272 of file vpMatrix.cpp.
References vpMatrix::resize(), and vpERROR_TRACE.
|
inherited |
Insert matrix A at the given position in the current matrix.
A | : The matrix to insert. |
r | : The index of the row to begin to insert data. |
c | : The index of the column to begin to insert data. |
Definition at line 3022 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, and vpMatrix::rowNum.
Referenced by vpNurbs::curveKnotIns(), vpMatrix::insert(), vpPioneerPan::set_mMp(), and vpPioneerPan::set_pMe().
|
staticinherited |
Insert matrix B in matrix A at the given position.
A | : Main matrix. |
B | : Matrix to insert. |
r | : Index of the row where to add the matrix. |
c | : Index of the column where to add the matrix. |
Definition at line 2397 of file vpMatrix.cpp.
References vpMatrix::insert(), and vpCERROR.
|
staticinherited |
Insert matrix B in matrix A at the given position.
A | : Main matrix. |
B | : Matrix to insert. |
C | : Result matrix. |
r | : Index of the row where to insert matrix B. |
c | : Index of the column where to insert matrix B. |
Definition at line 2428 of file vpMatrix.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpMatrix::resize(), vpCERROR, and vpERROR_TRACE.
vpRotationMatrix vpRotationMatrix::inverse | ( | ) | const |
invert the rotation matrix
inverse the rotation matrix
Definition at line 439 of file vpRotationMatrix.cpp.
References t().
Referenced by vpViper::get_eJe(), and inverse().
void vpRotationMatrix::inverse | ( | vpRotationMatrix & | M | ) | const |
invert the rotation matrix
inverse the rotation matrix
Definition at line 452 of file vpRotationMatrix.cpp.
References inverse().
|
inherited |
Compute the inverse of a n-by-n matrix using the Cholesky decomposition. The matrix must be real and symmetric. Only available if lapack is installed.
Here an example:
Definition at line 122 of file vpMatrix_cholesky.cpp.
References vpMatrix::colNum, vpMatrix::inverseByCholeskyLapack(), vpMatrixException::matrixError, vpMatrix::rowNum, and vpERROR_TRACE.
|
inherited |
Definition at line 62 of file vpMatrix_cholesky.cpp.
References vpException::badValue, vpMatrix::data, vpMatrix::getCols(), and vpMatrix::getRows().
Referenced by vpMatrix::inverseByCholesky().
|
inherited |
Compute the inverse of a n-by-n matrix using the LU decomposition.
Here an example:
Definition at line 236 of file vpMatrix_lu.cpp.
References vpMatrix::colNum, vpMatrix::getRows(), vpMatrixException::matrixError, vpMatrix::rowNum, and vpERROR_TRACE.
Referenced by vpMatrix::expm(), vpKalmanFilter::filtering(), vpTemplateTrackerWarpHomographySL3::findWarp(), vpTemplateTrackerWarpAffine::getParamInverse(), vpTemplateTrackerTriangle::init(), vpTemplateTrackerSSDInverseCompositional::initCompInverse(), vpTemplateTrackerZNCCForwardAdditional::initHessienDesired(), vpTemplateTrackerZNCCInverseCompositional::initHessienDesired(), vpTemplateTracker::setHDes(), vpTemplateTrackerSSDForwardCompositional::trackNoPyr(), and vpTemplateTrackerSSDForwardAdditional::trackNoPyr().
|
inherited |
Compute the inverse of a n-by-n matrix using the QR decomposition. Only available if lapack is installed.
Here an example:
Definition at line 228 of file vpMatrix_qr.cpp.
References vpMatrix::colNum, vpMatrix::inverseByQRLapack(), vpMatrixException::matrixError, vpMatrix::rowNum, and vpERROR_TRACE.
|
inherited |
Definition at line 76 of file vpMatrix_qr.cpp.
References vpException::badValue, vpMatrix::data, vpMatrix::getCols(), and vpMatrix::getRows().
Referenced by vpMatrix::inverseByQR().
bool vpRotationMatrix::isARotationMatrix | ( | ) | const |
test if the matrix is an rotation matrix
test if the 3x3 rotational part of the rotation matrix is really a rotation matrix
Definition at line 314 of file vpRotationMatrix.cpp.
References vpMath::sqr(), and t().
Referenced by vpHomogeneousMatrix::isAnHomogeneousMatrix(), and operator=().
Juxtapose to matrices C = [ A B ].
A | : Left matrix. |
B | : Right matrix. |
Definition at line 2471 of file vpMatrix.cpp.
References vpCERROR.
Juxtapose to matrices C = [ A B ].
A | : Left matrix. |
B | : Right matrix. |
C | : Juxtaposed matrix C = [ A B ] |
Definition at line 2500 of file vpMatrix.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpMatrix::resize(), vpCERROR, and vpERROR_TRACE.
|
inherited |
Function to compute the null space (the kernel) of the interaction matrix A which is not full rank. The null space ( the kernel ) of a matrix A is defined as Null(A) = Ker(M) ={KerA : A*KerA =0}.
kerA | : The matrix to contain the null space (kernel) of A (A*KerA.t()=0) |
svThreshold | : Specify the used threshold in the svd(...) function (a function to compute the singular value decomposition) |
Definition at line 3300 of file vpMatrix.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), vpMatrix::resize(), vpMatrix::row(), vpMatrix::sumSquare(), and vpMatrix::svd().
|
inherited |
Destruction of the matrix (Memory de-allocation)
Definition at line 295 of file vpMatrix.cpp.
References vpMatrix::data, and vpMatrix::rowPtrs.
Referenced by vpMatrix::~vpMatrix().
Compute Kronecker product matrix.
Definition at line 1492 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpMatrix::rowNum, and vpERROR_TRACE.
Referenced by vpMatrix::kron().
Compute Kronecker product matrix.
Definition at line 1536 of file vpMatrix.cpp.
References vpMatrix::getCols(), and vpMatrix::getRows().
Compute Kronecker product matrix.
m | : vpMatrix. |
out | : If m1.kron(m2) out contains the kronecker product's result : . |
Definition at line 1526 of file vpMatrix.cpp.
References vpMatrix::kron().
Compute Kronecker product matrix.
m | : vpMatrix; |
Definition at line 1567 of file vpMatrix.cpp.
References vpMatrix::kron().
|
inlinestaticinherited |
Load a matrix from a file.
filename | : absolute file name |
M | : matrix to be loaded |
binary | :If true the matrix is loaded from a binary file, else from a text file. |
Header | : Header of the file is loaded in this parameter |
Definition at line 262 of file vpMatrix.h.
Referenced by vpDot2::defineDots().
|
staticinherited |
Load a matrix from a file.
filename | : Absolute file name. |
M | : Matrix to be loaded. |
binary | : If true the matrix is loaded from a binary file, else from a text file. |
header | : header of the file loaded in this parameter. |
Definition at line 3694 of file vpMatrix.cpp.
References vpException::badValue, and vpMatrix::resize().
|
inlinestaticinherited |
Load a matrix from a YAML-formatted file.
filename | : absolute file name. |
M | : matrix to be loaded from the file. |
header | : Header of the file is loaded in this parameter. |
Definition at line 315 of file vpMatrix.h.
|
staticinherited |
Load a matrix from a YAML-formatted file.
filename | : absolute file name. |
M | : matrix to be loaded from the file. |
header | : header of the file is loaded in this parameter. |
Definition at line 3791 of file vpMatrix.cpp.
References vpMatrix::resize().
|
inherited |
Print using MAPLE matrix input format.
Print using the following way so that this output can be directly copied into MAPLE: ([ [0.939846, 0.0300754, 0.340272, ], [0.0300788, 0.984961, -0.170136, ], [-0.340272, 0.170136, 0.924807, ], ])
Definition at line 2792 of file vpMatrix.cpp.
References vpMatrix::getCols(), and vpMatrix::getRows().
|
inherited |
Print using matlab syntax, to be put in matlab later.
Print using the following form: [ a,b,c; d,e,f; g,h,i]
Definition at line 2763 of file vpMatrix.cpp.
References vpMatrix::getRows().
|
staticinherited |
Operation C = A * B.
The result is placed in the third parameter C and not returned. A new matrix won't be allocated for every use of the function (Speed gain if used many times with the same result matrix size).
Definition at line 420 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrixException::incorrectMatrixSizeError, vpMatrix::resize(), vpMatrix::rowNum, vpMatrix::rowPtrs, and vpERROR_TRACE.
Referenced by vpMatrix::operator*().
|
staticinherited |
Operation c = A * b (c and b are vectors).
The result is placed in the second parameter C and not returned. A new matrix won't be allocated for every use of the function (Speed gain if used many times with the same result matrix size).
Definition at line 860 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpColVector::resize(), vpMatrix::rowNum, vpMatrix::rowPtrs, and vpERROR_TRACE.
Referenced by operator*(), and vpMatrix::operator*().
Operation C = -A.
The result is placed in the second parameter C and not returned. A new matrix won't be allocated for every use of the function (Speed gain if used many times with the same result matrix size).
Definition at line 758 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::resize(), vpMatrix::rowNum, vpMatrix::rowPtrs, and vpERROR_TRACE.
Referenced by vpMatrix::operator-().
vpTranslationVector vpRotationMatrix::operator* | ( | const vpTranslationVector & | mat | ) | const |
operation c = A * b (A is unchanged)
Definition at line 292 of file vpRotationMatrix.cpp.
References vpMatrix::rowPtrs.
vpRotationMatrix vpRotationMatrix::operator* | ( | const vpRotationMatrix & | B | ) | const |
operation C = A * B (A is unchanged)
Definition at line 170 of file vpRotationMatrix.cpp.
References vpMatrix::rowPtrs.
operation C = A * B (A is unchanged)
Operation C = A * B (A is unchanged). Allows for example to multiply a rotation matrix by a skew matrix.
vpMatrixException::incorrectMatrixSizeError | : If B is not a 3 by 3 dimension matrix. |
Definition at line 199 of file vpRotationMatrix.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, and vpERROR_TRACE.
vpColVector vpRotationMatrix::operator* | ( | const vpColVector & | v | ) | const |
Operator that allows to multiply a rotation matrix by a 3 dimension column vector.
v | : Three dimension column vector. |
vpMatrixException::incorrectMatrixSizeError | If the column vector v is not a 3 dimension vector. |
The code below shows how to use this operator.
Definition at line 249 of file vpRotationMatrix.cpp.
References vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpMatrix::multMatrixVector(), and vpERROR_TRACE.
|
inherited |
Allows to multiply a matrix by an homography. Operation M = K * H (H is unchanged).
Definition at line 476 of file vpMatrix.cpp.
References vpMatrix::colNum, vpException::dimensionError, and vpMatrix::rowNum.
|
inherited |
Cij = Aij * x (A is unchanged)
Definition at line 979 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::resize(), vpMatrix::rowNum, vpMatrix::rowPtrs, and vpERROR_TRACE.
|
inherited |
Multiply all the element of the matrix by x : Aij = Aij * x.
Definition at line 1107 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::rowNum, and vpMatrix::rowPtrs.
vpRotationMatrix vpRotationMatrix::operator+ | ( | const vpRotationMatrix & | B | ) | const |
overload + operator (to say it forbidden operation, throw exception)
overload + operator (to say it forbidden operation, throw exception)
Cannot | add two rotation matrices !!!!! vpMatrixException::forbiddenOperatorError |
Definition at line 269 of file vpRotationMatrix.cpp.
References vpMatrixException::forbiddenOperatorError, and vpERROR_TRACE.
Operation C = A + B (A is unchanged).
Definition at line 593 of file vpMatrix.cpp.
References vpMatrix::add2Matrices().
Operation A = A + B.
Definition at line 673 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpMatrix::rowNum, vpMatrix::rowPtrs, and vpERROR_TRACE.
|
inherited |
Add x to all the element of the matrix : Aij = Aij + x.
Definition at line 1059 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::rowNum, and vpMatrix::rowPtrs.
vpRotationMatrix vpRotationMatrix::operator- | ( | const vpRotationMatrix & | B | ) | const |
overload - operator (to say it forbidden operation, throw exception)
overload - operator (to say it forbidden operation, throw exception)
Cannot | substract two rotation matrices !!!!! vpMatrixException::forbiddenOperatorError |
Definition at line 283 of file vpRotationMatrix.cpp.
References vpMatrixException::forbiddenOperatorError, and vpERROR_TRACE.
Operation C = A - B (A is unchanged).
Definition at line 664 of file vpMatrix.cpp.
References vpMatrix::sub2Matrices().
|
inherited |
Operation C = -A (A is unchanged).
Definition at line 800 of file vpMatrix.cpp.
References vpMatrix::negateMatrix().
Operation A = A - B.
Definition at line 713 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpMatrix::rowNum, vpMatrix::rowPtrs, and vpERROR_TRACE.
|
inherited |
Substract x to all the element of the matrix : Aij = Aij - x.
Definition at line 1083 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::rowNum, and vpMatrix::rowPtrs.
|
inherited |
Cij = Aij / x (A is unchanged)
Definition at line 1014 of file vpMatrix.cpp.
References vpMatrix::colNum, vpException::divideByZeroError, vpMatrix::resize(), vpMatrix::rowNum, vpMatrix::rowPtrs, vpCERROR, and vpERROR_TRACE.
|
inherited |
Divide all the element of the matrix by x : Aij = Aij / x.
Definition at line 1122 of file vpMatrix.cpp.
References vpMatrix::colNum, vpException::divideByZeroError, vpMatrix::rowNum, and vpMatrix::rowPtrs.
|
inherited |
Assigment from an array of double.
Definition at line 395 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::rowNum, and vpMatrix::rowPtrs.
vpRotationMatrix & vpRotationMatrix::operator= | ( | const vpRotationMatrix & | m | ) |
copy operator from vpRotationMatrix
Affectation of two rotation matrix.
m | : *this = m |
Definition at line 121 of file vpRotationMatrix.cpp.
References vpMatrix::rowPtrs.
vpRotationMatrix & vpRotationMatrix::operator= | ( | const vpMatrix & | m | ) |
copy operator from vpMatrix (handle with care)
Affectation of two rotation matrix
m | : *this = m |
Definition at line 140 of file vpRotationMatrix.cpp.
References vpMatrixException::forbiddenOperatorError, vpMatrix::getCols(), vpMatrix::getRows(), isARotationMatrix(), and vpERROR_TRACE.
|
inlineinherited |
write elements Aij (usage : A[i][j] = x )
Definition at line 218 of file vpMatrix.h.
|
inlineinherited |
read elements Aij (usage : x = A[i][j] )
Definition at line 220 of file vpMatrix.h.
|
inherited |
Pretty print a matrix. The data are tabulated. The common widths before and after the decimal point are set with respect to the parameter maxlen.
s | Stream used for the printing. |
length | The suggested width of each matrix element. The actual width grows in order to accomodate the whole integral part, and shrinks if the whole extent is not needed for all the numbers. |
intro | The introduction which is printed before the matrix. Can be set to zero (or omitted), in which case the introduction is not printed. |
Definition at line 2668 of file vpMatrix.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), and vpMath::maximum().
|
inlineinherited |
Definition at line 188 of file vpMatrix.h.
void vpRotationMatrix::printVector | ( | ) |
Print the matrix as a vector [T thetaU].
Print the matrix as a vector [thetaU].
Definition at line 473 of file vpRotationMatrix.cpp.
|
inherited |
Compute the pseudo inverse of the matrix using the SVD.
Compute and return the pseudo inverse of a n-by-m matrix : .
svThreshold | : Threshold used to test the singular values. |
Here an example to compute the inverse of a n-by-n matrix. If the matrix is n-by-n it is also possible to use inverseByLU().
Definition at line 1861 of file vpMatrix.cpp.
Referenced by vpCalibration::calibrationTsai(), vpSimulatorAfma6::computeArticularVelocity(), vpSimulatorViper850::computeArticularVelocity(), vpServo::computeControlLaw(), vpMatrix::computeCovarianceMatrix(), vpMbEdgeKltTracker::computeVVS(), vpMbKltTracker::computeVVS(), vpMbEdgeTracker::computeVVS(), vpNurbs::globalCurveApprox(), vpNurbs::globalCurveInterp(), vpMeEllipse::initTracking(), vpHomography::inverse(), vpMeLine::leastSquare(), vpPose::poseDementhonNonPlan(), vpPose::poseFromRectangle(), vpPose::poseVirtualVS(), vpMatrix::pseudoInverse(), vpHomography::robust(), and vpMatrix::solveBySVD().
|
inherited |
Compute the pseudo inverse of the matrix .
Compute the pseudo inverse of the matrix using the SVD. return the rank
Ap | : The pseudo inverse . |
svThreshold | : Threshold used to test the singular values. |
Definition at line 1821 of file vpMatrix.cpp.
References vpMatrix::pseudoInverse().
|
inherited |
Compute the pseudo inverse of the matrix .
Compute the pseudo inverse of the matrix using the SVD. return the rank and the singular value
Ap | : The pseudo inverse . |
sv | : Singular values. |
svThreshold | : Threshold used to test the singular values. |
Definition at line 1877 of file vpMatrix.cpp.
References vpMatrix::pseudoInverse().
|
inherited |
Compute the pseudo inverse of the matrix along with Ker A, Ker , Im A and Im .
Compute the pseudo inverse of the matrix using the SVD. return the rank and the singular value, image
Pseudo inverse, kernel and image are computed using the SVD decomposition.
A is an m x n matrix, if m >=n the svd works on A other wise it works on .
Therefore if m>=n we have
where Im(A) is an m x r matrix (r is the rank of A) and Im(A^T) is an r x n matrix
Ap | : The pseudo inverse . |
sv | : Singular values. |
svThreshold | : Threshold used to test the singular values. |
imAt | : Image A^T |
imA | Image A |
Definition at line 1916 of file vpMatrix.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), vpColVector::resize(), vpMatrix::resize(), vpMatrix::svd(), and vpMatrix::t().
|
inherited |
Compute the pseudo inverse of the matrix along with Ker A, Ker , Im A and Im .
Compute the pseudo inverse of the matrix using the SVD. return the rank and the singular value, image, kernel.
Pseudo inverse, kernel and image are computed using the SVD decomposition.
A is an m x n matrix, if m >=n the svd works on A other wise it works on .
Therefore if m>=n we have
where Im(A) is an m x r matrix (r is the rank of A) and Im(A^T) is an r x n matrix
Ap | : The pseudo inverse . |
sv | : Singular values. |
svThreshold | : Threshold used to test the singular values. |
imA | Image A |
imAt | : Image A^T |
kerA | : null space of A |
Definition at line 2094 of file vpMatrix.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), vpColVector::resize(), vpMatrix::resize(), vpMatrix::row(), vpMatrix::sumSquare(), vpMatrix::svd(), and vpMatrix::t().
|
inherited |
Set the size of the matrix and initialize all the values to zero.
nrows | : number of rows |
ncols | : number of column |
flagNullify | : if true, then the matrix is re-initialized to 0 after resize. If false, the initial values from the common part of the matrix (common part between old and new version of the matrix) are kept. Default value is true. |
Definition at line 183 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::data, vpMatrix::dsize, vpException::memoryAllocationError, vpMatrix::rowNum, vpMatrix::rowPtrs, vpMatrix::trsize, vpCDEBUG, vpDEBUG_TRACE, and vpERROR_TRACE.
Referenced by vpMatrix::AAt(), vpMatrix::add2Matrices(), vpMatrix::add2WeightedMatrices(), vpMatrix::AtA(), vpServo::computeControlLaw(), vpMatrix::computeHLM(), vpMbTracker::computeJTR(), vpMbEdgeKltTracker::computeVVS(), vpMbKltTracker::computeVVS(), vpMatrix::createDiagonalMatrix(), vpMatrix::diag(), vpProjectionDisplay::display(), vpHomography::DLT(), vpMatrix::eigenValues(), vpMatrix::eye(), vpPtu46::get_eJe(), vpAfma4::get_eJe(), vpAfma6::get_eJe(), vpBiclops::get_eJe(), vpPtu46::get_fJe(), vpAfma4::get_fJe(), vpAfma6::get_fJe(), vpBiclops::get_fJe(), vpAfma4::get_fJe_inverse(), vpViper::get_fJw(), vpCameraParameters::get_K(), vpCameraParameters::get_K_inverse(), init(), vpProjectionDisplay::init(), vpVelocityTwistMatrix::init(), vpForceTwistMatrix::init(), vpKalmanFilter::init(), vpHomogeneousMatrix::init(), vpMatrix::init(), vpTemplateTrackerSSDInverseCompositional::initCompInverse(), vpMbtDistanceCylinder::initInteractionMatrixError(), vpTemplateTracker::initTracking(), vpMatrix::insert(), vpFeatureEllipse::interaction(), vpFeatureVanishingPoint::interaction(), vpFeatureLuminance::interaction(), vpFeatureSegment::interaction(), vpGenericFeature::interaction(), vpFeatureDepth::interaction(), vpFeaturePoint::interaction(), vpFeatureLine::interaction(), vpFeaturePoint3D::interaction(), vpFeaturePointPolar::interaction(), vpFeatureThetaU::interaction(), vpFeatureTranslation::interaction(), vpMatrix::juxtaposeMatrices(), vpMatrix::kernel(), vpMatrix::loadMatrix(), vpMatrix::loadMatrixYAML(), vpMatrix::mult2Matrices(), vpMatrix::negateMatrix(), vpMatrix::operator*(), vpMatrix::operator/(), vpMatrix::operator=(), vpPose::poseDementhonNonPlan(), vpPose::poseDementhonPlan(), vpPose::poseVirtualVSrobust(), vpMatrix::pseudoInverse(), vpIoTools::readConfigVar(), vpRowVector::reshape(), vpColVector::reshape(), vpRowVector::resize(), vpColVector::resize(), vpServo::secondaryTask(), vpTemplateTrackerWarp::setNbParam(), vpColVector::skew(), vpMatrix::skew(), vpMatrix::stackMatrices(), vpMatrix::sub2Matrices(), vpMatrix::svd(), vpMatrix::t(), vpMatrix::transpose(), vpMatrix::vpMatrix(), vpTemplateTrackerSSD::vpTemplateTrackerSSD(), vpTemplateTrackerSSDESM::vpTemplateTrackerSSDESM(), vpTemplateTrackerSSDInverseCompositional::vpTemplateTrackerSSDInverseCompositional(), vpTemplateTrackerWarpAffine::vpTemplateTrackerWarpAffine(), vpTemplateTrackerWarpHomography::vpTemplateTrackerWarpHomography(), vpTemplateTrackerWarpHomographySL3::vpTemplateTrackerWarpHomographySL3(), vpTemplateTrackerWarpSRT::vpTemplateTrackerWarpSRT(), vpTemplateTrackerWarpTranslation::vpTemplateTrackerWarpTranslation(), and vpTemplateTrackerZNCC::vpTemplateTrackerZNCC().
|
inherited |
Row extraction.
Return the ith rows of the matrix.
Definition at line 2274 of file vpMatrix.cpp.
References vpMatrix::getCols().
Referenced by vpMatrix::kernel(), and vpMatrix::pseudoInverse().
|
inlinestaticinherited |
Save a matrix to a file.
filename | : absolute file name |
M | : matrix to be saved |
binary | :If true the matrix is save in a binary file, else a text file. |
Header | : optional line that will be saved at the beginning of the file |
Warning : If you save the matrix as in a text file the precision is less than if you save it in a binary file.
Definition at line 283 of file vpMatrix.h.
Referenced by vpDot2::defineDots().
|
staticinherited |
Save a matrix to a file.
filename | : Absolute file name. |
M | : Matrix to be saved. |
binary | : If true the matrix is saved in a binary file, else a text file. |
header | : Optional line that will be saved at the beginning of the file. |
Warning : If you save the matrix as in a text file the precision is less than if you save it in a binary file.
Definition at line 3523 of file vpMatrix.cpp.
References vpMatrix::getCols(), and vpMatrix::getRows().
|
inlinestaticinherited |
Save a matrix in a YAML-formatted file.
filename | : absolute file name. |
M | : matrix to be saved in the file. |
header | : optional lines that will be saved at the beginning of the file. Should be YAML-formatted and will adapt to the indentation if any. |
Definition at line 301 of file vpMatrix.h.
|
staticinherited |
Save a matrix in a YAML-formatted file.
filename | : absolute file name. |
M | : matrix to be saved in the file. |
header | : optional lines that will be saved at the beginning of the file. Should be YAML-formatted and will adapt to the indentation if any. |
Here is an example of outputs.
Content of matrix.yml:
Content of matrixIndent.yml:
Definition at line 3623 of file vpMatrix.cpp.
References vpMatrix::getCols(), and vpMatrix::getRows().
void vpRotationMatrix::setIdentity | ( | ) |
Basic initialisation (identity)
Initializes the rotation matrix as identity.
Definition at line 100 of file vpRotationMatrix.cpp.
References init().
Referenced by vpCalibration::calibrationTsai(), and vpHomography::computeDisplacement().
|
inherited |
By default set the matrix to identity. More generally set M[i][i] = val.
Definition at line 1159 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrixException::matrixError, vpMatrix::rowNum, and vpERROR_TRACE.
Referenced by vpServo::computeControlLaw(), vpMatrix::expm(), vpTemplateTrackerWarpHomographySL3::getdW0(), vpTemplateTrackerWarpHomographySL3::getdWdp0(), vpFeatureThetaU::interaction(), vpMeLine::leastSquare(), vpPose::poseFromRectangle(), and vpServo::secondaryTask().
|
inherited |
Solve a linear system using Singular Value Decomposition (SVD).
Non destructive wrt. A and B.
b | : Vector . |
x | : Vector . |
Here an example:
Definition at line 1622 of file vpMatrix.cpp.
References vpMatrix::pseudoInverse().
Referenced by vpMatrix::solveBySVD().
|
inherited |
Solve a linear system using Singular Value Decomposition (SVD).
Non destructive wrt. A and B.
B | : Vector . |
Here an example:
Definition at line 1677 of file vpMatrix.cpp.
References vpMatrix::colNum, and vpMatrix::solveBySVD().
|
inherited |
Stacks columns of a matrix in a vector.
out | : a vpColVector. |
Definition at line 1422 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::data, vpColVector::resize(), vpMatrix::rowNum, vpMatrix::rowPtrs, vpCERROR, and vpERROR_TRACE.
|
inherited |
Stacks columns of a matrix in a vector.
Definition at line 1446 of file vpMatrix.cpp.
References vpMatrix::colNum, and vpMatrix::rowNum.
|
inherited |
Stack A at the end of the current matrix, or copy if the matrix has no dimensions : this = [ this A ]^T
Here an example for a robot velocity log :
Definition at line 3003 of file vpMatrix.cpp.
References vpMatrix::rowNum.
Referenced by vpCalibration::calibrationTsai(), vpMbEdgeKltTracker::computeVVS(), vpFeatureSegment::error(), vpFeatureEllipse::error(), vpFeatureVanishingPoint::error(), vpFeatureMomentAlpha::error(), vpGenericFeature::error(), vpFeaturePoint::error(), vpFeatureLine::error(), vpFeaturePoint3D::error(), vpFeaturePointPolar::error(), vpFeatureThetaU::error(), vpFeatureTranslation::error(), vpBasicFeature::get_s(), vpFeatureEllipse::interaction(), vpFeatureVanishingPoint::interaction(), vpFeatureSegment::interaction(), vpGenericFeature::interaction(), vpFeatureMoment::interaction(), vpFeaturePoint::interaction(), vpFeatureLine::interaction(), vpFeaturePoint3D::interaction(), vpFeaturePointPolar::interaction(), vpFeatureThetaU::interaction(), vpFeatureTranslation::interaction(), and vpMatrix::stackMatrices().
Stack two Matrices C = [ A B ]^T.
Stack matrices. "Stack" two matrices C = [ A B ]^T.
A | : Upper matrix. |
B | : Lower matrix. |
Definition at line 2312 of file vpMatrix.cpp.
References vpMatrix::stackMatrices(), and vpCERROR.
Stack two Matrices C = [ A B ]^T.
stackMatrices. "stack" two matrices C = [ A B ]^T
A | : Upper matrix. |
B | : Lower matrix. |
C | : Stacked matrix C = [ A B ]^T |
Definition at line 2341 of file vpMatrix.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpMatrix::resize(), vpCERROR, and vpERROR_TRACE.
|
inherited |
Stacks rows of a matrix in a vector
out | : a vpRowVector. |
Definition at line 1457 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::data, vpMatrix::dsize, vpRowVector::resize(), vpMatrix::rowNum, vpCERROR, and vpERROR_TRACE.
|
inherited |
Stacks rows of a matrix in a vector.
Definition at line 1479 of file vpMatrix.cpp.
References vpMatrix::colNum, and vpMatrix::rowNum.
|
staticinherited |
Operation C = A - B.
The result is placed in the third parameter C and not returned. A new matrix won't be allocated for every use of the function (Speed gain if used many times with the same result matrix size).
Definition at line 611 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::getCols(), vpMatrix::getRows(), vpMatrixException::incorrectMatrixSizeError, vpMatrix::resize(), vpMatrix::rowNum, vpMatrix::rowPtrs, and vpERROR_TRACE.
Referenced by vpMatrix::operator-().
|
inherited |
return sum of the Aij^2 (for all i, for all j)
Definition at line 809 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::rowNum, and vpMatrix::rowPtrs.
Referenced by vpPose::calculArbreDementhon(), vpCalibration::calibrationTsai(), vpPose::coplanar(), vpFeatureDepth::error(), vpFeatureThetaU::error(), vpFeatureTranslation::error(), vpMbTracker::extractCylinders(), vpFeatureThetaU::interaction(), vpMatrix::kernel(), vpRowVector::normalize(), vpColVector::normalize(), vpPose::poseDementhonNonPlan(), vpPose::poseDementhonPlan(), vpPose::poseFromRectangle(), vpPose::poseLagrangeNonPlan(), vpPose::poseLagrangePlan(), vpPose::poseVirtualVS(), vpPose::poseVirtualVSrobust(), vpMatrix::pseudoInverse(), vpServoData::save(), vpSimulatorAfma6::setPosition(), and vpSimulatorViper850::setPosition().
|
inherited |
Singular value decomposition (SVD).
w | : Vector of singular values. . |
v | : Matrix . |
Here an example of SVD decomposition of a non square Matrix M.
Definition at line 1751 of file vpMatrix.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), vpColVector::resize(), and vpMatrix::resize().
Referenced by vpHomography::computeDisplacement(), vpMatrix::cond(), vpHomography::DLT(), vpMatrix::kernel(), vpPose::poseDementhonPlan(), and vpMatrix::pseudoInverse().
vpRotationMatrix vpRotationMatrix::t | ( | ) | const |
transpose
transpose R^T
Definition at line 421 of file vpRotationMatrix.cpp.
Referenced by vpCalibration::calibrationTsai(), vpHomography::computeDisplacement(), vpVelocityTwistMatrix::extract(), inverse(), vpVelocityTwistMatrix::inverse(), vpHomogeneousMatrix::inverse(), isARotationMatrix(), and vpSimulatorAfma6::setPosition().
|
inherited |
Compute and return the transpose of the matrix.
Definition at line 1255 of file vpMatrix.cpp.
Referenced by vpTemplateTrackerWarpSRT::getParamInverse().
|
inherited |
Compute At the transpose of the matrix.
At | : Resulting transpose matrix. |
Definition at line 1267 of file vpMatrix.cpp.
References vpMatrix::colNum, vpMatrix::resize(), vpMatrix::rowNum, vpMatrix::rowPtrs, vpCERROR, and vpERROR_TRACE.
Multiplication by a scalar Cij = x*Bij.
Definition at line 935 of file vpMatrix.cpp.
References vpMatrix::getCols(), vpMatrix::getRows(), vpMatrix::resize(), and vpERROR_TRACE.
|
friend |
std::cout an rotation matrix [thetaU]
Definition at line 459 of file vpRotationMatrix.cpp.
|
related |
Compute the skew symmetric matrix of translation vector (matrice de pre-produit vectoriel).
t | : Translation vector in input used to compute the skew symmetric matrix M. |
M | : Skew symmetric matrix of translation vector . |
Definition at line 296 of file vpTranslationVector.cpp.
References vpMatrix::resize().
|
related |
This function performs generalized matrix multiplication: D = alpha*op(A)*op(B) + beta*op(C), where op(X) is X or X^T. Operation on A, B and C matrices is described by enumeration vpGEMMmethod.
For example, to compute alpha*A^T*B^T+beta*C we need to call :
If C is not used, vpGEMM must be called using an empty matrix null :
vpMatrixException::incorrectMatrixSizeError | if the sizes of the matrices do not allow the operations. |
A | : a Matrix |
B | : a Matrix |
alpha | : a scalar |
C | : a Matrix |
beta | : a scalar |
D | : a Matrix |
ops | : a scalar describing operation applied on the matrices |
Definition at line 331 of file vpGEMM.h.
References vpMatrixException::incorrectMatrixSizeError, and vpERROR_TRACE.
|
related |
Enumeration of the operations applied on matrices in vpGEMM function.
Operations are :
|
friend |
Definition at line 74 of file vpRotationMatrix.h.
|
friend |
Definition at line 75 of file vpRotationMatrix.h.
|
friend |
Definition at line 77 of file vpRotationMatrix.h.
|
friend |
Definition at line 76 of file vpRotationMatrix.h.
|
friend |
Definition at line 78 of file vpRotationMatrix.h.
|
friend |
Definition at line 79 of file vpRotationMatrix.h.
|
protectedinherited |
number of columns
Definition at line 114 of file vpMatrix.h.
Referenced by vpMatrix::AAt(), vpMatrix::add2Matrices(), vpMatrix::add2WeightedMatrices(), vpMatrix::AtA(), vpMatrix::eigenValues(), vpMatrix::expm(), vpMatrix::eye(), vpMatrix::infinityNorm(), vpSubColVector::init(), vpSubRowVector::init(), vpSubMatrix::init(), vpMatrix::init(), vpMatrix::insert(), vpMatrix::inverseByCholesky(), vpMatrix::inverseByLU(), vpMatrix::inverseByQR(), vpMatrix::kron(), vpMatrix::mult2Matrices(), vpMatrix::multMatrixVector(), vpMatrix::negateMatrix(), vpRowVector::operator*(), vpMatrix::operator*(), vpMatrix::operator*=(), vpMatrix::operator+=(), vpMatrix::operator-=(), vpMatrix::operator/(), vpMatrix::operator/=(), vpColVector::operator<<(), vpMatrix::operator<<(), vpSubRowVector::operator=(), vpRowVector::operator=(), vpSubMatrix::operator=(), vpMatrix::operator=(), vpMatrix::resize(), vpMatrix::setIdentity(), vpMatrix::solveBySVD(), vpMatrix::stackColumns(), vpMatrix::stackRows(), vpMatrix::sub2Matrices(), vpMatrix::sumSquare(), vpRowVector::t(), vpMatrix::t(), vpMatrix::transpose(), and vpMatrix::vpMatrix().
|
inherited |
address of the first element of the data array
Definition at line 118 of file vpMatrix.h.
Referenced by vpMatrix::AtA(), vpSubColVector::checkParentStatus(), vpSubRowVector::checkParentStatus(), vpSubMatrix::checkParentStatus(), vpPose::computeResidual(), vpPose::computeTransformation(), vpColVector::dotProd(), vpMatrix::eigenValues(), vpMatrix::euclideanNorm(), vpMatrix::expm(), vpRobotViper650::getForceTorque(), vpRobotViper850::getForceTorque(), vpMatrix::getMaxValue(), vpMatrix::getMinValue(), vpRobotViper650::getPosition(), vpRobotViper850::getPosition(), vpRobotViper850::getVelocity(), vpRobotViper650::getVelocity(), vpSubColVector::init(), vpSubRowVector::init(), vpSubMatrix::init(), vpMatrix::init(), vpRobotViper650::init(), vpRobotViper850::init(), vpMatrix::inverseByCholeskyLapack(), vpMatrix::inverseByQRLapack(), vpColVector::invSort(), vpMatrix::kill(), vpColVector::mean(), vpColVector::median(), vpRowVector::operator*(), vpColVector::operator*(), vpTranslationVector::operator*(), vpColVector::operator+(), vpTranslationVector::operator-(), vpColVector::operator-(), vpSubColVector::operator=(), vpSubRowVector::operator=(), vpRowVector::operator=(), vpColVector::operator=(), vpTranslationVector::operator=(), vpMatrix::operator=(), vpRowVector::operator[](), vpColVector::operator[](), vpPose::ransac(), vpRowVector::reshape(), vpColVector::reshape(), vpMatrix::resize(), vpRobotAfma4::setPosition(), vpRobotViper650::setPosition(), vpRobotViper850::setPosition(), vpRobotAfma4::setVelocity(), vpRobotAfma6::setVelocity(), vpRobotViper650::setVelocity(), vpRobotViper850::setVelocity(), vpColVector::sort(), vpMatrix::stackColumns(), vpMatrix::stackRows(), vpRowVector::t(), vpColVector::t(), vpColVector::vpColVector(), vpMatrix::vpMatrix(), vpSubColVector::~vpSubColVector(), vpSubMatrix::~vpSubMatrix(), and vpSubRowVector::~vpSubRowVector().
|
protectedinherited |
Current size (rowNum * colNum)
Definition at line 124 of file vpMatrix.h.
Referenced by vpMatrix::euclideanNorm(), vpMatrix::getMaxValue(), vpMatrix::getMinValue(), vpSubColVector::init(), vpSubRowVector::init(), vpSubMatrix::init(), vpMatrix::init(), vpTranslationVector::operator*(), vpTranslationVector::operator-(), vpMatrix::operator=(), vpRowVector::reshape(), vpColVector::reshape(), vpMatrix::resize(), and vpMatrix::stackRows().
|
protectedinherited |
number of rows
Definition at line 112 of file vpMatrix.h.
Referenced by vpMatrix::AAt(), vpMatrix::add2Matrices(), vpMatrix::add2WeightedMatrices(), vpMatrix::AtA(), vpColVector::deg2rad(), vpMatrix::eigenValues(), vpMatrix::expm(), vpMatrix::eye(), vpMatrix::infinityNorm(), vpSubColVector::init(), vpSubRowVector::init(), vpSubMatrix::init(), vpMatrix::init(), vpMatrix::insert(), vpMatrix::inverseByCholesky(), vpMatrix::inverseByLU(), vpMatrix::inverseByQR(), vpMatrix::kron(), vpMatrix::mult2Matrices(), vpMatrix::multMatrixVector(), vpMatrix::negateMatrix(), vpColVector::operator*(), vpHomogeneousMatrix::operator*(), vpMatrix::operator*(), vpMatrix::operator*=(), vpColVector::operator+(), vpMatrix::operator+=(), vpColVector::operator-(), vpMatrix::operator-=(), vpMatrix::operator/(), vpMatrix::operator/=(), vpColVector::operator<<(), vpMatrix::operator<<(), vpSubColVector::operator=(), vpSubRowVector::operator=(), vpRowVector::operator=(), vpSubMatrix::operator=(), vpColVector::operator=(), vpTranslationVector::operator=(), vpMatrix::operator=(), vpColVector::rad2deg(), vpMatrix::resize(), vpMatrix::setIdentity(), vpColVector::stack(), vpMatrix::stackColumns(), vpMatrix::stackMatrices(), vpMatrix::stackRows(), vpMatrix::sub2Matrices(), vpMatrix::sumSquare(), vpColVector::t(), vpMatrix::t(), vpMatrix::transpose(), and vpMatrix::vpMatrix().
|
protectedinherited |
address of the first element of each rows
Definition at line 121 of file vpMatrix.h.
Referenced by vpMatrix::AAt(), vpMatrix::add2Matrices(), vpMatrix::add2WeightedMatrices(), vpMatrix::infinityNorm(), vpSubColVector::init(), vpSubRowVector::init(), vpSubMatrix::init(), vpMatrix::init(), vpMatrix::kill(), vpMatrix::mult2Matrices(), vpMatrix::multMatrixVector(), vpMatrix::negateMatrix(), operator*(), vpVelocityTwistMatrix::operator*(), vpForceTwistMatrix::operator*(), vpHomogeneousMatrix::operator*(), vpMatrix::operator*(), vpMatrix::operator*=(), vpMatrix::operator+=(), vpMatrix::operator-=(), vpMatrix::operator/(), vpMatrix::operator/=(), vpColVector::operator<<(), vpMatrix::operator<<(), vpRowVector::operator=(), vpSubMatrix::operator=(), operator=(), vpVelocityTwistMatrix::operator=(), vpForceTwistMatrix::operator=(), vpHomogeneousMatrix::operator=(), vpMatrix::operator=(), vpMatrix::resize(), vpMatrix::stackColumns(), vpMatrix::sub2Matrices(), vpMatrix::sumSquare(), and vpMatrix::transpose().
|
protectedinherited |
Total row space.
Definition at line 126 of file vpMatrix.h.
Referenced by vpSubColVector::init(), vpSubRowVector::init(), vpSubMatrix::init(), vpMatrix::init(), and vpMatrix::resize().