Visual Servoing Platform
version 3.0.1
|
#include <visp3/core/vpMatrix.h>
Public Types | |
enum | vpDetMethod { LU_DECOMPOSITION } |
Public Member Functions | |
vpMatrix () | |
vpMatrix (unsigned int r, unsigned int c) | |
vpMatrix (unsigned int r, unsigned int c, double val) | |
vpMatrix (const vpMatrix &M, unsigned int r, unsigned int c, unsigned int nrows, unsigned int ncols) | |
vpMatrix (const vpArray2D< double > &A) | |
virtual | ~vpMatrix () |
void | clear () |
Setting a diagonal matrix | |
void | diag (const double &val=1.0) |
void | diag (const vpColVector &A) |
void | eye () |
void | eye (unsigned int n) |
void | eye (unsigned int m, unsigned int n) |
Assignment operators | |
vpMatrix & | operator<< (double *) |
vpMatrix & | operator= (const vpArray2D< double > &A) |
vpMatrix & | operator= (const double x) |
Stacking | |
void | stack (const vpMatrix &A) |
void | stack (const vpRowVector &r) |
void | stackColumns (vpColVector &out) |
vpColVector | stackColumns () |
void | stackRows (vpRowVector &out) |
vpRowVector | stackRows () |
Matrix insertion | |
void | insert (const vpMatrix &A, const unsigned int r, const unsigned int c) |
Columns, rows, sub-matrices extraction | |
vpRowVector | getRow (const unsigned int i) const |
vpRowVector | getRow (const unsigned int i, const unsigned int j_begin, const unsigned int size) const |
vpColVector | getCol (const unsigned int j) const |
vpColVector | getCol (const unsigned int j, const unsigned int i_begin, const unsigned int size) const |
void | init (const vpMatrix &M, unsigned int r, unsigned int c, unsigned int nrows, unsigned int ncols) |
Matrix operations | |
vpMatrix & | operator+= (const vpMatrix &B) |
vpMatrix & | operator-= (const vpMatrix &B) |
vpMatrix | operator* (const vpMatrix &B) const |
vpMatrix | operator* (const vpRotationMatrix &R) const |
vpMatrix | operator* (const vpVelocityTwistMatrix &V) const |
vpMatrix | operator* (const vpForceTwistMatrix &V) const |
vpTranslationVector | operator* (const vpTranslationVector &tv) const |
vpColVector | operator* (const vpColVector &v) const |
vpMatrix | operator+ (const vpMatrix &B) const |
vpMatrix | operator- (const vpMatrix &B) const |
vpMatrix | operator- () const |
vpMatrix & | operator+= (const double x) |
vpMatrix & | operator-= (const double x) |
vpMatrix & | operator*= (const double x) |
vpMatrix & | operator/= (double x) |
vpMatrix | operator* (const double x) const |
vpMatrix | operator/ (const double x) const |
double | sum () const |
double | sumSquare () const |
double | det (vpDetMethod method=LU_DECOMPOSITION) const |
vpMatrix | expm () const |
Kronecker product | |
void | kron (const vpMatrix &m1, vpMatrix &out) const |
vpMatrix | kron (const vpMatrix &m1) const |
Transpose | |
vpMatrix | t () const |
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) const |
double | cond () const |
Eigen values | |
vpColVector | eigenValues () const |
void | eigenValues (vpColVector &evalue, vpMatrix &evector) const |
Norms | |
double | euclideanNorm () const |
double | infinityNorm () const |
Printing | |
std::ostream & | cppPrint (std::ostream &os, const std::string &matrixName="A", bool octet=false) const |
std::ostream & | csvPrint (std::ostream &os) const |
std::ostream & | maplePrint (std::ostream &os) const |
std::ostream & | matlabPrint (std::ostream &os) const |
int | print (std::ostream &s, unsigned int length, char const *intro=0) const |
void | printSize () const |
Inherited functionalities from vpArray2D | |
double | getMinValue () const |
double | getMaxValue () const |
unsigned int | getRows () const |
unsigned int | getCols () const |
unsigned int | size () const |
void | resize (const unsigned int nrows, const unsigned int ncols, const bool flagNullify=true) |
double * | operator[] (unsigned int i) |
double * | operator[] (unsigned int i) const |
Static Public Member Functions | |
Setting a diagonal matrix with Static Public Member Functions | |
static void | createDiagonalMatrix (const vpColVector &A, vpMatrix &DA) |
Matrix insertion with Static Public Member Functions | |
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) |
Stacking with Static Public Member Functions | |
static vpMatrix | juxtaposeMatrices (const vpMatrix &A, const vpMatrix &B) |
static void | juxtaposeMatrices (const vpMatrix &A, const vpMatrix &B, vpMatrix &C) |
static vpMatrix | stack (const vpMatrix &A, const vpMatrix &B) |
static vpMatrix | stack (const vpMatrix &A, const vpRowVector &r) |
static void | stack (const vpMatrix &A, const vpMatrix &B, vpMatrix &C) |
static void | stack (const vpMatrix &A, const vpRowVector &r, vpMatrix &C) |
Matrix operations with Static Public Member Functions | |
static void | add2Matrices (const vpMatrix &A, const vpMatrix &B, vpMatrix &C) |
static void | add2Matrices (const vpColVector &A, const vpColVector &B, vpColVector &C) |
static void | add2WeightedMatrices (const vpMatrix &A, const double &wA, const vpMatrix &B, const double &wB, vpMatrix &C) |
static void | computeHLM (const vpMatrix &H, const double &alpha, vpMatrix &HLM) |
static void | mult2Matrices (const vpMatrix &A, const vpMatrix &B, vpMatrix &C) |
static void | mult2Matrices (const vpMatrix &A, const vpMatrix &B, vpRotationMatrix &C) |
static void | mult2Matrices (const vpMatrix &A, const vpMatrix &B, vpHomogeneousMatrix &C) |
static void | mult2Matrices (const vpMatrix &A, const vpColVector &B, vpColVector &C) |
static void | multMatrixVector (const vpMatrix &A, const vpColVector &v, vpColVector &w) |
static void | negateMatrix (const vpMatrix &A, vpMatrix &C) |
static void | sub2Matrices (const vpMatrix &A, const vpMatrix &B, vpMatrix &C) |
static void | sub2Matrices (const vpColVector &A, const vpColVector &B, vpColVector &C) |
Kronecker product with Static Public Member Functions | |
static void | kron (const vpMatrix &m1, const vpMatrix &m2, vpMatrix &out) |
static vpMatrix | kron (const vpMatrix &m1, const vpMatrix &m2) |
Covariance computation with Static Public Member Functions | |
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 vpMatrix | computeCovarianceMatrixVVS (const vpHomogeneousMatrix &cMo, const vpColVector &deltaS, const vpMatrix &Ls, const vpMatrix &W) |
static vpMatrix | computeCovarianceMatrixVVS (const vpHomogeneousMatrix &cMo, const vpColVector &deltaS, const vpMatrix &Ls) |
Matrix I/O with Static Public Member Functions | |
static bool | loadMatrix (const std::string &filename, vpArray2D< double > &M, const bool binary=false, char *header=NULL) |
static bool | loadMatrixYAML (const std::string &filename, vpArray2D< double > &M, char *header=NULL) |
static bool | saveMatrix (const std::string &filename, const vpArray2D< double > &M, const bool binary=false, const char *header="") |
static bool | saveMatrixYAML (const std::string &filename, const vpArray2D< double > &M, const char *header="") |
Inherited I/O from vpArray2D with Static Public Member Functions | |
static bool | load (const std::string &filename, vpArray2D< double > &A, const bool binary=false, char *header=NULL) |
static bool | loadYAML (const std::string &filename, vpArray2D< double > &A, char *header=NULL) |
static bool | save (const std::string &filename, const vpArray2D< double > &A, const bool binary=false, const char *header="") |
static bool | saveYAML (const std::string &filename, const vpArray2D< double > &A, const char *header="") |
Public Attributes | |
double * | data |
Protected Attributes | |
unsigned int | rowNum |
unsigned int | colNum |
double ** | rowPtrs |
unsigned int | dsize |
Related Functions | |
(Note that these are not member functions.) | |
vpMatrix | operator* (const double &x, const vpMatrix &B) |
enum | vpGEMMmethod |
Deprecated functions | |
vp_deprecated void | init () |
vp_deprecated void | stackMatrices (const vpMatrix &A) |
vp_deprecated void | setIdentity (const double &val=1.0) |
vp_deprecated vpRowVector | row (const unsigned int i) |
vp_deprecated vpColVector | column (const unsigned int j) |
static vp_deprecated vpMatrix | stackMatrices (const vpMatrix &A, const vpMatrix &B) |
static vp_deprecated void | stackMatrices (const vpMatrix &A, const vpMatrix &B, vpMatrix &C) |
static vp_deprecated vpMatrix | stackMatrices (const vpMatrix &A, const vpRowVector &B) |
static vp_deprecated void | stackMatrices (const vpMatrix &A, const vpRowVector &B, vpMatrix &C) |
static vp_deprecated vpMatrix | stackMatrices (const vpColVector &A, const vpColVector &B) |
static vp_deprecated void | stackMatrices (const vpColVector &A, const vpColVector &B, vpColVector &C) |
Implementation of a matrix and operations on matrices.
This class may benefit from Lapack or GSL optional 3rd parties that are used especially for pseudo-inverse. Concerning Lapack optional 3rd party, installation instructions are provide here https://visp.inria.fr/3rd_lapack. For optional GSL, installation instructions are provide here https://visp.inria.fr/3rd_gsl.
vpMatrix class provides a data structure for the matrices as well as a set of operations on these matrices.
The vpMatrix class is derived from vpArray2D<double>.
Definition at line 97 of file vpMatrix.h.
Method used to compute the determinant of a square matrix.
Enumerator | |
---|---|
LU_DECOMPOSITION |
LU decomposition method. |
Definition at line 104 of file vpMatrix.h.
|
inline |
Basic constructor of a matrix of double. Number of columns and rows are zero.
Definition at line 112 of file vpMatrix.h.
|
inline |
Constructor that initialize a matrix of double with 0.
r | : Matrix number of rows. |
c | : Matrix number of columns. |
Definition at line 119 of file vpMatrix.h.
|
inline |
Constructor that initialize a matrix of double with val.
r | : Matrix number of rows. |
c | : Matrix number of columns. |
val | : Each element of the matrix is set to val. |
Definition at line 127 of file vpMatrix.h.
vpMatrix::vpMatrix | ( | const vpMatrix & | M, |
unsigned int | r, | ||
unsigned int | c, | ||
unsigned int | nrows, | ||
unsigned int | ncols | ||
) |
Construct a matrix as a sub-matrix of the input matrix M.
Definition at line 78 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpException::dimensionError, init(), and vpArray2D< Type >::rowNum.
|
inline |
Create a matrix from a 2D array that could be one of the following container that inherit from vpArray2D such as vpMatrix, vpRotationMatrix, vpHomogeneousMatrix, vpPoseVector, vpColVector, vpRowVector...
The following example shows how to create a matrix from an homogeneous matrix:
Definition at line 141 of file vpMatrix.h.
|
inlinevirtual |
Destructor (Memory de-allocation)
Definition at line 144 of file vpMatrix.h.
vpMatrix vpMatrix::AAt | ( | ) | const |
Computes the operation
Definition at line 272 of file vpMatrix.cpp.
void vpMatrix::AAt | ( | vpMatrix & | B | ) | const |
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 292 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpArray2D< double >::colNum, vpArray2D< Type >::resize(), vpArray2D< double >::rowNum, vpArray2D< Type >::rowNum, and vpArray2D< double >::rowPtrs.
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 915 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< Type >::resize(), vpArray2D< Type >::rowNum, and vpArray2D< Type >::rowPtrs.
Referenced by operator+().
|
static |
Operation C = A + B.
The result is placed in the third parameter C and not returned. A new vector 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 953 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpColVector::resize(), vpArray2D< Type >::rowNum, and vpArray2D< Type >::rowPtrs.
|
static |
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 882 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< Type >::resize(), vpArray2D< Type >::rowNum, and vpArray2D< Type >::rowPtrs.
vpMatrix vpMatrix::AtA | ( | ) | const |
Compute the AtA operation such as
Definition at line 376 of file vpMatrix.cpp.
Referenced by vpCalibration::calibrationTsai(), vpMbEdgeKltTracker::computeVVS(), vpMbEdgeKltMultiTracker::computeVVS(), vpMbEdgeTracker::computeVVSFirstPhasePoseEstimation(), vpMbKltTracker::computeVVSPoseEstimation(), vpMbEdgeTracker::computeVVSSecondPhasePoseEstimation(), vpTemplateTrackerWarpHomographySL3::findWarp(), and vpNurbs::globalCurveApprox().
void vpMatrix::AtA | ( | vpMatrix & | B | ) | const |
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 331 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< Type >::colNum, vpArray2D< double >::data, vpArray2D< Type >::resize(), vpArray2D< double >::rowNum, and vpArray2D< Type >::rowNum.
|
inline |
Removes all elements from the matrix (which are destroyed), leaving the container with a size of 0.
Definition at line 150 of file vpMatrix.h.
vpColVector vpMatrix::column | ( | const unsigned int | j | ) |
Return the j-th columns of the matrix.
j | : Index of the column to extract. |
Definition at line 3652 of file vpMatrix.cpp.
References vpArray2D< double >::getRows().
|
static |
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 59 of file vpMatrix_covariance.cpp.
References vpException::divideByZeroError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), pseudoInverse(), and t().
Referenced by computeCovarianceMatrixVVS(), and vpPose::poseVirtualVSrobust().
|
static |
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 87 of file vpMatrix_covariance.cpp.
References vpException::divideByZeroError, vpArray2D< Type >::getCols(), and t().
|
static |
Compute the covariance matrix of an image-based virtual visual servoing. This assumes the optimization has been done via v = (W * Ls).pseudoInverse() * W * DeltaS.
cMo | : Pose matrix that has been computed with the v. |
deltaS | : Error vector used in v = (W * Ls).pseudoInverse() * W * DeltaS. |
Ls | : interaction matrix used in v = (W * Ls).pseudoInverse() * W * DeltaS. |
W | : Weight matrix used in v = (W * Ls).pseudoInverse() * W * DeltaS. |
Definition at line 139 of file vpMatrix_covariance.cpp.
References computeCovarianceMatrix().
Referenced by computeCovarianceMatrixVVS(), vpMbEdgeMultiTracker::computeVVS(), vpMbEdgeKltTracker::computeVVS(), vpMbEdgeKltMultiTracker::computeVVS(), vpMbEdgeTracker::computeVVS(), vpMbKltTracker::computeVVSCovariance(), and vpPose::poseVirtualVS().
|
static |
Compute the covariance matrix of an image-based virtual visual servoing. This assumes the optimization has been done via v = Ls.pseudoInverse() * DeltaS.
cMo | : Pose matrix that has been computed with the v. |
deltaS | : Error vector used in v = Ls.pseudoInverse() * DeltaS |
Ls | : interaction matrix used in v = Ls.pseudoInverse() * DeltaS |
Definition at line 117 of file vpMatrix_covariance.cpp.
References computeCovarianceMatrix(), and computeCovarianceMatrixVVS().
Compute
H | : input Matrix . This matrix should be square. |
alpha | : Scalar |
HLM | : Resulting operation. |
Definition at line 3525 of file vpMatrix.cpp.
References vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), and vpArray2D< Type >::resize().
Referenced by vpTemplateTrackerWarpHomographySL3::findWarp(), vpTemplateTrackerSSDESM::initCompInverse(), vpTemplateTrackerSSDInverseCompositional::initCompInverse(), vpTemplateTrackerZNCCForwardAdditional::initHessienDesired(), vpTemplateTrackerMIForwardCompositional::initHessienDesired(), vpTemplateTrackerZNCCInverseCompositional::initHessienDesired(), vpTemplateTrackerMIESM::initHessienDesired(), vpTemplateTrackerMIForwardAdditional::initHessienDesired(), vpTemplateTrackerMIInverseCompositional::initHessienDesired(), vpTemplateTracker::setHDes(), vpTemplateTrackerSSDForwardCompositional::trackNoPyr(), vpTemplateTrackerMIForwardCompositional::trackNoPyr(), vpTemplateTrackerSSDESM::trackNoPyr(), vpTemplateTrackerSSDForwardAdditional::trackNoPyr(), vpTemplateTrackerMIESM::trackNoPyr(), vpTemplateTrackerMIForwardAdditional::trackNoPyr(), and vpTemplateTrackerMIInverseCompositional::trackNoPyr().
double vpMatrix::cond | ( | ) | const |
Definition at line 3500 of file vpMatrix.cpp.
References vpArray2D< Type >::getCols(), and svd().
Referenced by vpTemplateTrackerMIForwardCompositional::trackNoPyr(), vpTemplateTrackerMIESM::trackNoPyr(), vpTemplateTrackerMIForwardAdditional::trackNoPyr(), and vpTemplateTrackerMIInverseCompositional::trackNoPyr().
std::ostream & vpMatrix::cppPrint | ( | std::ostream & | os, |
const std::string & | matrixName = "A" , |
||
bool | octet = false |
||
) | const |
Print to be used as part of a C++ code later.
os | : the stream to be printed in. |
matrixName | : name of the matrix, "A" by default. |
octet | : if false, print using double, if true, print byte per byte each bytes of the double array. |
The following code shows how to use this function:
It produces the following output that could be copy/paste in a C++ code:
Definition at line 2888 of file vpMatrix.cpp.
References vpArray2D< double >::getRows().
|
static |
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 545 of file vpMatrix.cpp.
References vpArray2D< Type >::getRows(), and vpArray2D< Type >::resize().
std::ostream & vpMatrix::csvPrint | ( | std::ostream & | os | ) | const |
Print/save a matrix in csv format.
The following code
produces log.csv file that contains:
Definition at line 2838 of file vpMatrix.cpp.
References vpArray2D< double >::getCols(), and vpArray2D< double >::getRows().
double vpMatrix::det | ( | vpDetMethod | method = LU_DECOMPOSITION | ) | const |
Compute the determinant of a n-by-n matrix.
method | : Method used to compute the determinant. Default LU decomposition method is faster than the method based on Gaussian elimination. |
Definition at line 3352 of file vpMatrix.cpp.
References LU_DECOMPOSITION.
Referenced by vpTemplateTrackerTriangle::init().
void vpMatrix::diag | ( | const double & | val = 1.0 | ) |
Set the matrix as a diagonal matrix where each element on the diagonal is set to val. Elements that are not on the diagonal are set to 0.
val | : Value to set. |
Matrix A is now equal to:
Definition at line 524 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, and vpArray2D< double >::rowNum.
Referenced by vpMbEdgeMultiTracker::computeVVS(), vpMbEdgeKltTracker::computeVVS(), vpMbEdgeKltMultiTracker::computeVVS(), vpMbEdgeTracker::computeVVS(), and vpMbKltTracker::computeVVSCovariance().
void vpMatrix::diag | ( | const vpColVector & | A | ) |
Create a diagonal matrix with the element of a vector.
A | : Vector which element will be put in the diagonal. |
Matrix A is now equal to:
Definition at line 478 of file vpMatrix.cpp.
References vpArray2D< Type >::getRows(), and vpArray2D< double >::resize().
vpColVector vpMatrix::eigenValues | ( | ) | const |
Compute the eigenvalues of a n-by-n real symmetric matrix.
vpException::dimensionError | If the matrix is not square. |
vpException::fatalError | If the matrix is not symmetric. |
vpException::functionNotImplementedError | If the GSL library is not detected. |
Here an example:
Definition at line 3067 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpException::dimensionError, vpException::fatalError, vpException::functionNotImplementedError, vpArray2D< double >::rowNum, and t().
void vpMatrix::eigenValues | ( | vpColVector & | evalue, |
vpMatrix & | evector | ||
) | const |
Compute the eigenvalues of a n-by-n real symmetric matrix.
evalue | : Eigenvalues of the matrix. |
evector | : Eigenvector of the matrix. |
vpException::dimensionError | If the matrix is not square. |
vpException::fatalError | If the matrix is not symmetric. |
vpException::functionNotImplementedError | If the GSL library is not detected. |
Here an example:
Definition at line 3179 of file vpMatrix.cpp.
References vpException::dimensionError, vpException::fatalError, vpException::functionNotImplementedError, vpArray2D< Type >::resize(), and t().
double vpMatrix::euclideanNorm | ( | ) | const |
Compute and return the Euclidean norm .
Definition at line 3552 of file vpMatrix.cpp.
References vpArray2D< double >::data, and vpArray2D< double >::dsize.
vpMatrix vpMatrix::expm | ( | ) | const |
Compute the exponential matrix of a square matrix.
Definition at line 3372 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< double >::data, vpArray2D< Type >::data, vpException::dimensionError, eye(), inverseByLU(), vpArray2D< double >::rowNum, and sum().
Referenced by vpTemplateTrackerWarpHomographySL3::computeCoeff().
void vpMatrix::eye | ( | ) |
Set an m-by-n matrix to identity with ones on the diagonal and zeros else where.
Definition at line 194 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, and vpArray2D< double >::rowNum.
Referenced by vpServo::computeControlLaw(), vpServo::computeProjectionOperators(), vpMbEdgeKltTracker::computeVVS(), vpMbEdgeKltMultiTracker::computeVVS(), vpMbEdgeTracker::computeVVS(), vpMbEdgeTracker::computeVVSFirstPhasePoseEstimation(), vpMbKltTracker::computeVVSPoseEstimation(), vpMbEdgeTracker::computeVVSSecondPhasePoseEstimation(), expm(), eye(), vpTemplateTrackerWarpHomographySL3::getdW0(), vpTemplateTrackerWarpHomographySL3::getdWdp0(), vpFeatureThetaU::interaction(), vpMeLine::leastSquare(), vpPose::poseFromRectangle(), vpServo::setServo(), vpMbTracker::vpMbTracker(), and vpServo::vpServo().
void vpMatrix::eye | ( | unsigned int | n | ) |
Set an n-by-n matrix to identity with ones on the diagonal and zeros else where.
Definition at line 162 of file vpMatrix.cpp.
References eye().
void vpMatrix::eye | ( | unsigned int | m, |
unsigned int | n | ||
) |
Set an m-by-n matrix to identity with ones on the diagonal and zeros else where.
Definition at line 177 of file vpMatrix.cpp.
References eye(), and vpArray2D< double >::resize().
vpColVector vpMatrix::getCol | ( | const unsigned int | j | ) | const |
Extract a column vector from a matrix.
j | : Index of the column to extract. If j=0, the first column is extracted. |
The following example shows how to use this function:
It produces the following output:
Definition at line 2235 of file vpMatrix.cpp.
References vpException::dimensionError, vpArray2D< double >::getCols(), and vpArray2D< double >::getRows().
Referenced by vpHomography::DLT(), kernel(), vpPose::poseDementhonPlan(), vpPose::poseFromRectangle(), and vpServo::secondaryTaskJointLimitAvoidance().
vpColVector vpMatrix::getCol | ( | const unsigned int | j, |
const unsigned int | i_begin, | ||
const unsigned int | column_size | ||
) | const |
Extract a column vector from a matrix.
j | : Index of the column to extract. If col=0, the first column is extracted. |
i_begin | : Index of the row that gives the location of the first element of the column vector to extract. |
column_size | : Size of the column vector to extract. |
The following example shows how to use this function:
It produces the following output:
Definition at line 2185 of file vpMatrix.cpp.
References vpException::dimensionError, vpArray2D< double >::getCols(), and vpArray2D< double >::getRows().
|
inlineinherited |
Return the number of columns of the 2D array.
Definition at line 154 of file vpArray2D.h.
References vpArray2D< Type >::colNum.
Referenced by vpRowVector::csvPrint(), csvPrint(), vpRotationMatrix::getCol(), vpHomogeneousMatrix::getCol(), getCol(), getRow(), inverseByQRLapack(), kernel(), vpRowVector::maplePrint(), maplePrint(), vpRowVector::operator*(), vpRowVector::operator+(), vpRowVector::operator+=(), vpRowVector::operator-(), vpRowVector::operator-=(), vpForceTwistMatrix::print(), vpVelocityTwistMatrix::print(), vpRowVector::print(), print(), pseudoInverse(), row(), and svd().
|
inherited |
Return the array max value.
|
inherited |
Return the array min value.
vpRowVector vpMatrix::getRow | ( | const unsigned int | i | ) | const |
Extract a row vector from a matrix.
i | : Index of the row to extract. If i=0, the first row is extracted. |
The following example shows how to use this function:
It produces the following output:
Definition at line 2282 of file vpMatrix.cpp.
References vpException::dimensionError, vpArray2D< double >::getCols(), and vpArray2D< double >::getRows().
Referenced by pseudoInverse().
vpRowVector vpMatrix::getRow | ( | const unsigned int | i, |
const unsigned int | j_begin, | ||
const unsigned int | row_size | ||
) | const |
Extract a row vector from a matrix.
i | : Index of the row to extract. If i=0, the first row is extracted. |
j_begin | : Index of the column that gives the location of the first element of the row vector to extract. |
row_size | : Size of the row vector to extract. |
The following example shows how to use this function:
It produces the following output:
Definition at line 2331 of file vpMatrix.cpp.
References vpException::dimensionError, vpArray2D< double >::getCols(), and vpArray2D< double >::getRows().
|
inlineinherited |
Return the number of rows of the 2D array.
Definition at line 152 of file vpArray2D.h.
References vpArray2D< Type >::rowNum.
Referenced by column(), vpColVector::cppPrint(), cppPrint(), vpColVector::csvPrint(), csvPrint(), vpRotationMatrix::getCol(), vpHomogeneousMatrix::getCol(), getCol(), getRow(), inverseByCholeskyLapack(), inverseByQRLapack(), kernel(), vpColVector::maplePrint(), maplePrint(), vpColVector::matlabPrint(), matlabPrint(), vpColVector::operator+(), vpColVector::operator+=(), vpColVector::operator-(), vpColVector::operator-=(), vpForceTwistMatrix::print(), vpVelocityTwistMatrix::print(), vpPoseVector::print(), vpColVector::print(), print(), and pseudoInverse().
double vpMatrix::infinityNorm | ( | ) | const |
Compute and return the infinity norm with where is the matrix size.
Definition at line 3573 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
void vpMatrix::init | ( | const vpMatrix & | M, |
unsigned int | r, | ||
unsigned int | c, | ||
unsigned int | nrows, | ||
unsigned int | ncols | ||
) |
Initialize the matrix from a part of an input matrix M.
M | : Input matrix used for initialization. |
r | : row index in matrix M. |
c | : column index in matrix M. |
nrows | : Number of rows of the matrix that should be initialized. |
ncols | : Number of columns of the matrix that should be initialized. |
The sub-matrix starting from M[r][c] element and ending on M[r+nrows-1][c+ncols-1] element is used to initialize the matrix.
The following code shows how to use this function:
It produces the following output:
Definition at line 137 of file vpMatrix.cpp.
References vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< double >::resize(), and vpArray2D< double >::rowPtrs.
|
inline |
Definition at line 587 of file vpMatrix.h.
Referenced by vpMatrix(), and vpSubMatrix::vpSubMatrix().
void vpMatrix::insert | ( | const vpMatrix & | A, |
const unsigned int | r, | ||
const unsigned int | c | ||
) |
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 3011 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), and vpArray2D< double >::rowNum.
Referenced by vpNurbs::curveKnotIns(), and insert().
|
static |
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 2482 of file vpMatrix.cpp.
References insert().
|
static |
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 2511 of file vpMatrix.cpp.
References vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), and vpArray2D< Type >::resize().
vpMatrix vpMatrix::inverseByCholesky | ( | ) | const |
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 113 of file vpMatrix_cholesky.cpp.
References vpArray2D< double >::colNum, inverseByCholeskyLapack(), vpMatrixException::matrixError, vpArray2D< double >::rowNum, and vpERROR_TRACE.
vpMatrix vpMatrix::inverseByCholeskyLapack | ( | ) | const |
Definition at line 55 of file vpMatrix_cholesky.cpp.
References vpException::badValue, vpArray2D< Type >::data, vpArray2D< Type >::getCols(), vpArray2D< double >::getRows(), and vpArray2D< Type >::getRows().
Referenced by inverseByCholesky().
vpMatrix vpMatrix::inverseByLU | ( | ) | const |
Compute the inverse of a n-by-n matrix using the LU decomposition.
Here an example:
Definition at line 231 of file vpMatrix_lu.cpp.
References vpArray2D< double >::colNum, vpArray2D< Type >::getRows(), vpMatrixException::matrixError, vpArray2D< double >::rowNum, and vpERROR_TRACE.
Referenced by expm(), vpKalmanFilter::filtering(), vpTemplateTrackerWarpHomographySL3::findWarp(), vpTemplateTrackerWarpAffine::getParamInverse(), vpTemplateTrackerTriangle::init(), vpTemplateTrackerSSDInverseCompositional::initCompInverse(), vpTemplateTrackerZNCCForwardAdditional::initHessienDesired(), vpTemplateTrackerMIForwardCompositional::initHessienDesired(), vpTemplateTrackerZNCCInverseCompositional::initHessienDesired(), vpTemplateTrackerMIESM::initHessienDesired(), vpTemplateTrackerMIForwardAdditional::initHessienDesired(), vpTemplateTrackerMIInverseCompositional::initHessienDesired(), vpTemplateTrackerSSDForwardCompositional::trackNoPyr(), vpTemplateTrackerMIForwardCompositional::trackNoPyr(), vpTemplateTrackerSSDForwardAdditional::trackNoPyr(), vpTemplateTrackerMIESM::trackNoPyr(), vpTemplateTrackerMIForwardAdditional::trackNoPyr(), and vpTemplateTrackerMIInverseCompositional::trackNoPyr().
vpMatrix vpMatrix::inverseByQR | ( | ) | const |
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 224 of file vpMatrix_qr.cpp.
References vpArray2D< double >::colNum, inverseByQRLapack(), vpMatrixException::matrixError, vpArray2D< double >::rowNum, and vpERROR_TRACE.
vpMatrix vpMatrix::inverseByQRLapack | ( | ) | const |
Definition at line 72 of file vpMatrix_qr.cpp.
References vpException::badValue, vpArray2D< Type >::data, vpArray2D< double >::getCols(), vpArray2D< double >::getRows(), and vpArray2D< Type >::getRows().
Referenced by inverseByQR().
Juxtapose to matrices C = [ A B ].
A | : Left matrix. |
B | : Right matrix. |
Definition at line 2552 of file vpMatrix.cpp.
Juxtapose to matrices C = [ A B ].
A | : Left matrix. |
B | : Right matrix. |
C | : Juxtaposed matrix C = [ A B ] |
Definition at line 2579 of file vpMatrix.cpp.
References vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), and vpArray2D< Type >::resize().
unsigned int vpMatrix::kernel | ( | vpMatrix & | kerA, |
double | svThreshold = 1e-6 |
||
) | const |
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(A) = {X : A*X =0}.
kerA | : The matrix to contain the null space (kernel) of A defined by the row vectors (A*KerA.t()=0) |
svThreshold | : Specify the used threshold in the svd(...) function (a function to compute the singular value decomposition) |
Definition at line 3260 of file vpMatrix.cpp.
References getCol(), vpArray2D< double >::getCols(), vpArray2D< double >::getRows(), vpArray2D< Type >::getRows(), vpArray2D< Type >::resize(), vpColVector::sumSquare(), and svd().
Compute Kronecker product matrix.
m | : vpMatrix. |
out | : If m1.kron(m2) out contains the kronecker product's result : . |
Definition at line 1404 of file vpMatrix.cpp.
Referenced by kron().
Compute Kronecker product matrix.
m | : vpMatrix; |
Definition at line 1446 of file vpMatrix.cpp.
References kron().
Compute Kronecker product matrix.
Definition at line 1369 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< Type >::rowNum, and vpERROR_TRACE.
Compute Kronecker product matrix.
Definition at line 1415 of file vpMatrix.cpp.
References vpArray2D< Type >::getCols(), and vpArray2D< Type >::getRows().
|
inlinestaticinherited |
Load a matrix from a file.
filename | : Absolute file name. |
A | : Array 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 308 of file vpArray2D.h.
References vpException::badValue, and vpArray2D< Type >::resize().
|
inlinestatic |
Load a matrix from a file. This function overloads vpArray2D::load().
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 523 of file vpMatrix.h.
References vpArray2D< Type >::load().
Referenced by vpDot2::defineDots().
|
inlinestatic |
Load a matrix from a YAML-formatted file. This function overloads vpArray2D::loadYAML().
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 538 of file vpMatrix.h.
References vpArray2D< Type >::loadYAML().
|
inlinestaticinherited |
Load an array from a YAML-formatted file.
filename | : absolute file name. |
A | : array to be loaded from the file. |
header | : header of the file is loaded in this parameter. |
Definition at line 417 of file vpArray2D.h.
References vpArray2D< Type >::resize().
std::ostream & vpMatrix::maplePrint | ( | std::ostream & | os | ) | const |
Print using Maple syntax, to copy/paste in Maple later.
The following code
produces this output:
that could be copy/paste in Maple.
Definition at line 2797 of file vpMatrix.cpp.
References vpArray2D< double >::getCols(), and vpArray2D< double >::getRows().
std::ostream & vpMatrix::matlabPrint | ( | std::ostream & | os | ) | const |
Print using Matlab syntax, to copy/paste in Matlab later.
The following code
produces this output:
that could be copy/paste in Matlab:
Definition at line 2756 of file vpMatrix.cpp.
References vpArray2D< double >::getRows().
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 643 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< Type >::resize(), vpArray2D< Type >::rowNum, and vpArray2D< Type >::rowPtrs.
Referenced by operator*().
|
static |
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).
vpException::dimensionError | If matrices are not 3-by-3 dimension. |
Definition at line 689 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< Type >::rowNum, and vpArray2D< Type >::rowPtrs.
|
static |
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).
vpException::dimensionError | If matrices are not 4-by-4 dimension. |
Definition at line 728 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< Type >::rowNum, and vpArray2D< Type >::rowPtrs.
|
static |
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 766 of file vpMatrix.cpp.
References multMatrixVector().
|
static |
Operation w = A * v (v and w are vectors).
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 606 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpColVector::resize(), vpArray2D< Type >::rowNum, and vpArray2D< Type >::rowPtrs.
Referenced by mult2Matrices(), and 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 1124 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpArray2D< Type >::resize(), vpArray2D< Type >::rowNum, and vpArray2D< Type >::rowPtrs.
Referenced by operator-().
Operation C = A * B (A is unchanged).
Definition at line 775 of file vpMatrix.cpp.
References mult2Matrices().
vpMatrix vpMatrix::operator* | ( | const vpRotationMatrix & | R | ) | const |
Operator that allow to multiply a matrix by a rotation matrix. The matrix should be of dimension m-by-3.
Definition at line 788 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
vpMatrix vpMatrix::operator* | ( | const vpVelocityTwistMatrix & | V | ) | const |
Operator that allow to multiply a matrix by a velocity twist matrix. The matrix should be of dimension m-by-6.
Definition at line 817 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
vpMatrix vpMatrix::operator* | ( | const vpForceTwistMatrix & | V | ) | const |
Operator that allow to multiply a matrix by a force/torque twist matrix. The matrix should be of dimension m-by-6.
Definition at line 846 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
vpTranslationVector vpMatrix::operator* | ( | const vpTranslationVector & | tv | ) | const |
Operator that allows to multiply a matrix by a translation vector. The matrix should be of dimension (3x3)
Definition at line 565 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
vpColVector vpMatrix::operator* | ( | const vpColVector & | v | ) | const |
Operation w = A * v (matrix A is unchanged, v and w are column vectors).
Definition at line 591 of file vpMatrix.cpp.
References multMatrixVector().
vpMatrix vpMatrix::operator* | ( | const double | x | ) | const |
Operator that allows to multiply all the elements of a matrix by a scalar.
Definition at line 1203 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
vpMatrix & vpMatrix::operator*= | ( | const double | x | ) |
Multiply all the element of the matrix by x : Aij = Aij * x.
Operator that allows to multiply all the elements of a matrix by a scalar.
Definition at line 1266 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
Operation C = A + B (A is unchanged).
Definition at line 983 of file vpMatrix.cpp.
References add2Matrices().
Operation A = A + B.
Definition at line 1081 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< double >::rowNum, vpArray2D< Type >::rowPtrs, and vpArray2D< double >::rowPtrs.
vpMatrix & vpMatrix::operator+= | ( | const double | x | ) |
Add x to all the element of the matrix : Aij = Aij + x.
Definition at line 1242 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
Operation C = A - B (A is unchanged).
Definition at line 1072 of file vpMatrix.cpp.
References sub2Matrices().
vpMatrix vpMatrix::operator- | ( | void | ) | const |
Operation C = -A (A is unchanged).
Definition at line 1146 of file vpMatrix.cpp.
References negateMatrix().
Operation A = A - B.
Definition at line 1099 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< double >::rowNum, vpArray2D< Type >::rowPtrs, and vpArray2D< double >::rowPtrs.
vpMatrix & vpMatrix::operator-= | ( | const double | x | ) |
Substract x to all the element of the matrix : Aij = Aij - x.
Definition at line 1253 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
vpMatrix vpMatrix::operator/ | ( | const double | x | ) | const |
Cij = Aij / x (A is unchanged)
Definition at line 1215 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpException::divideByZeroError, vpArray2D< Type >::resize(), vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
vpMatrix & vpMatrix::operator/= | ( | double | x | ) |
Divide all the element of the matrix by x : Aij = Aij / x.
Definition at line 1276 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpException::divideByZeroError, vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
vpMatrix & vpMatrix::operator<< | ( | double * | x | ) |
Assigment from an array of double. This method has to be used carefully since the array allocated behind x pointer should have the same dimension than the matrix.
Definition at line 431 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
Copy operator that allows to convert on of the following container that inherit from vpArray2D such as vpMatrix, vpRotationMatrix, vpHomogeneousMatrix, vpPoseVector, vpColVector, vpRowVector... into a vpMatrix.
A | : 2D array to be copied. |
The following example shows how to create a matrix from an homogeneous matrix:
Definition at line 400 of file vpMatrix.cpp.
References vpArray2D< double >::data, vpArray2D< Type >::data, vpArray2D< double >::dsize, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), and vpArray2D< double >::resize().
vpMatrix & vpMatrix::operator= | ( | const double | x | ) |
Set all the element of the matrix A to x.
Definition at line 416 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
|
inlineinherited |
Set element using A[i][j] = x.
Definition at line 259 of file vpArray2D.h.
References vpArray2D< Type >::rowPtrs.
|
inlineinherited |
Get element using x = A[i][j].
Definition at line 261 of file vpArray2D.h.
References vpArray2D< Type >::rowPtrs.
int vpMatrix::print | ( | std::ostream & | s, |
unsigned int | length, | ||
char const * | intro = 0 |
||
) | const |
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 2634 of file vpMatrix.cpp.
References vpArray2D< double >::getCols(), vpArray2D< double >::getRows(), and vpMath::maximum().
|
inline |
Definition at line 422 of file vpMatrix.h.
References vpArray2D< Type >::getCols(), and vpArray2D< Type >::getRows().
vpMatrix vpMatrix::pseudoInverse | ( | double | svThreshold = 1e-6 | ) | const |
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 1741 of file vpMatrix.cpp.
Referenced by vpCalibration::calibrationTsai(), vpSimulatorAfma6::computeArticularVelocity(), vpSimulatorViper850::computeArticularVelocity(), vpServo::computeControlLaw(), computeCovarianceMatrix(), vpMbEdgeKltTracker::computeVVS(), vpMbEdgeKltMultiTracker::computeVVS(), vpMbEdgeTracker::computeVVSFirstPhasePoseEstimation(), vpMbKltTracker::computeVVSPoseEstimation(), vpMbEdgeTracker::computeVVSSecondPhasePoseEstimation(), vpNurbs::globalCurveApprox(), vpNurbs::globalCurveInterp(), vpMeEllipse::initTracking(), vpHomography::inverse(), vpMeLine::leastSquare(), vpPose::poseDementhonNonPlan(), vpPose::poseFromRectangle(), vpPose::poseVirtualVS(), pseudoInverse(), vpHomography::robust(), and solveBySVD().
unsigned int vpMatrix::pseudoInverse | ( | vpMatrix & | Ap, |
double | svThreshold = 1e-6 |
||
) | const |
Compute the pseudo inverse of the matrix using the SVD. return the rank
Compute the pseudo inverse of the matrix
Ap | : The pseudo inverse . |
svThreshold | : Threshold used to test the singular values. |
Definition at line 1701 of file vpMatrix.cpp.
References pseudoInverse().
unsigned int vpMatrix::pseudoInverse | ( | vpMatrix & | Ap, |
vpColVector & | sv, | ||
double | svThreshold = 1e-6 |
||
) | const |
Compute the pseudo inverse of the matrix using the SVD. return the rank and the singular value
Compute the pseudo inverse of the matrix
Ap | : The pseudo inverse . |
sv | : Singular values. |
svThreshold | : Threshold used to test the singular values. |
Definition at line 1757 of file vpMatrix.cpp.
References pseudoInverse().
unsigned int vpMatrix::pseudoInverse | ( | vpMatrix & | Ap, |
vpColVector & | sv, | ||
double | svThreshold, | ||
vpMatrix & | imA, | ||
vpMatrix & | imAt | ||
) | const |
Compute the pseudo inverse of the matrix using the SVD. return the rank and the singular value, image
Compute the pseudo inverse of the matrix along with Ker A, Ker , Im A and Im
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 1795 of file vpMatrix.cpp.
References vpArray2D< double >::getCols(), vpArray2D< double >::getRows(), vpArray2D< Type >::resize(), vpColVector::resize(), svd(), and t().
unsigned int vpMatrix::pseudoInverse | ( | vpMatrix & | Ap, |
vpColVector & | sv, | ||
double | svThreshold, | ||
vpMatrix & | imA, | ||
vpMatrix & | imAt, | ||
vpMatrix & | kerA | ||
) | const |
Compute the pseudo inverse of the matrix using the SVD. return the rank and the singular value, image, kernel.
Compute the pseudo inverse of the matrix along with Ker A, Ker , Im A and Im
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 1971 of file vpMatrix.cpp.
References vpArray2D< double >::getCols(), vpArray2D< Type >::getCols(), getRow(), vpArray2D< double >::getRows(), vpArray2D< Type >::resize(), vpColVector::resize(), vpRowVector::sumSquare(), svd(), and t().
|
inlineinherited |
Set the size of the array and initialize all the values to zero.
nrows | : number of rows. |
ncols | : number of column. |
flagNullify | : if true, then the array is re-initialized to 0 after resize. If false, the initial values from the common part of the array (common part between old and new version of the array) are kept. Default value is true. |
Definition at line 167 of file vpArray2D.h.
References vpArray2D< Type >::colNum, vpArray2D< Type >::data, vpArray2D< Type >::dsize, vpException::memoryAllocationError, vpArray2D< Type >::rowNum, and vpArray2D< Type >::rowPtrs.
Referenced by diag(), eye(), init(), and operator=().
vpRowVector vpMatrix::row | ( | const unsigned int | i | ) |
Return the i-th row of the matrix.
Definition at line 3636 of file vpMatrix.cpp.
References vpArray2D< double >::getCols().
|
inlinestaticinherited |
Save a matrix to a file.
filename | : Absolute file name. |
A | : Array 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 499 of file vpArray2D.h.
References vpArray2D< Type >::getCols(), and vpArray2D< Type >::getRows().
|
inlinestatic |
Save a matrix to a file. This function overloads vpArray2D::load().
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 555 of file vpMatrix.h.
References vpArray2D< Type >::save().
Referenced by vpDot2::defineDots().
|
inlinestatic |
Save a matrix in a YAML-formatted file. This function overloads vpArray2D::saveYAML().
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 572 of file vpMatrix.h.
References vpArray2D< Type >::saveYAML().
|
inlinestaticinherited |
Save an array in a YAML-formatted file.
filename | : absolute file name. |
A | : array 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 588 of file vpArray2D.h.
References vpArray2D< Type >::getCols(), and vpArray2D< Type >::getRows().
void vpMatrix::setIdentity | ( | const double & | val = 1.0 | ) |
Set the matrix diagonal elements to val. More generally set M[i][i] = val.
Definition at line 3667 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, and vpArray2D< double >::rowNum.
Referenced by vpServo::secondaryTask().
|
inlineinherited |
Return the number of elements of the 2D array.
Definition at line 156 of file vpArray2D.h.
References vpArray2D< Type >::colNum, and vpArray2D< Type >::rowNum.
Referenced by vpRowVector::insert(), vpColVector::insert(), and vpColVector::operator*().
void vpMatrix::solveBySVD | ( | const vpColVector & | b, |
vpColVector & | x | ||
) | const |
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 1502 of file vpMatrix.cpp.
References pseudoInverse().
Referenced by solveBySVD().
vpColVector vpMatrix::solveBySVD | ( | const vpColVector & | B | ) | const |
Solve a linear system using Singular Value Decomposition (SVD).
Non destructive wrt. A and B.
B | : Vector . |
Here an example:
Definition at line 1557 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, and solveBySVD().
void vpMatrix::stack | ( | const vpMatrix & | A | ) |
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 2981 of file vpMatrix.cpp.
References vpArray2D< double >::rowNum.
Referenced by vpCalibration::calibrationTsai(), vpMbKltMultiTracker::computeVVS(), vpMbEdgeMultiTracker::computeVVS(), vpMbEdgeKltTracker::computeVVS(), vpMbEdgeKltMultiTracker::computeVVS(), vpFeatureVanishingPoint::interaction(), vpFeatureEllipse::interaction(), vpFeatureSegment::interaction(), vpFeatureMoment::interaction(), vpGenericFeature::interaction(), vpFeaturePoint::interaction(), vpFeatureLine::interaction(), vpFeaturePoint3D::interaction(), vpFeatureThetaU::interaction(), vpFeaturePointPolar::interaction(), vpFeatureTranslation::interaction(), stack(), vpColVector::stackMatrices(), and stackMatrices().
void vpMatrix::stack | ( | const vpRowVector & | r | ) |
Stack row vector r at the end of the current matrix, or copy if the matrix has no dimensions : this = [ this r ]^T.
Definition at line 2992 of file vpMatrix.cpp.
References vpArray2D< double >::rowNum, and stack().
Stack matrix B to the end of matrix A and return the resulting matrix [ A B ]^T
A | : Upper matrix. |
B | : Lower matrix. |
Definition at line 2351 of file vpMatrix.cpp.
References stack().
|
static |
Stack row vector r to matrix A and return the resulting matrix [ A r ]^T
A | : Upper matrix. |
r | : Lower matrix. |
Definition at line 2375 of file vpMatrix.cpp.
References stack().
Stack matrix B to the end of matrix A and return the resulting matrix in C.
A | : Upper matrix. |
B | : Lower matrix. |
C | : Stacked matrix C = [ A B ]^T |
Definition at line 2399 of file vpMatrix.cpp.
References vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), and vpArray2D< Type >::resize().
|
static |
Stack row vector v to the end of matrix A and return the resulting matrix in C.
A | : Upper matrix. |
r | : Lower row vector. |
C | : Stacked matrix C = [ A r ]^T |
Definition at line 2441 of file vpMatrix.cpp.
References vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), and vpArray2D< Type >::resize().
void vpMatrix::stackColumns | ( | vpColVector & | out | ) |
Stacks columns of a matrix in a vector.
out | : a vpColVector. |
Definition at line 1305 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< Type >::colNum, vpArray2D< Type >::data, vpColVector::resize(), vpArray2D< Type >::rowNum, vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
vpColVector vpMatrix::stackColumns | ( | ) |
Stacks columns of a matrix in a vector.
Definition at line 1326 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, and vpArray2D< double >::rowNum.
|
inline |
Definition at line 591 of file vpMatrix.h.
|
inlinestatic |
Definition at line 595 of file vpMatrix.h.
References stack().
|
inlinestatic |
Definition at line 599 of file vpMatrix.h.
References stack().
|
static |
Definition at line 3619 of file vpMatrix.cpp.
References stack().
|
static |
Definition at line 3624 of file vpMatrix.cpp.
References stack().
|
static |
Definition at line 3609 of file vpMatrix.cpp.
References vpColVector::stack().
|
static |
Definition at line 3614 of file vpMatrix.cpp.
References vpColVector::stack().
void vpMatrix::stackRows | ( | vpRowVector & | out | ) |
Stacks rows of a matrix in a vector
out | : a vpRowVector. |
Definition at line 1337 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< double >::data, vpArray2D< Type >::data, vpArray2D< double >::dsize, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpRowVector::resize(), and vpArray2D< double >::rowNum.
vpRowVector vpMatrix::stackRows | ( | ) |
Stacks rows of a matrix in a vector.
Definition at line 1356 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, and vpArray2D< double >::rowNum.
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).
vpException::dimensionError | If A and B matrices have not the same size. |
Definition at line 1042 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< Type >::resize(), vpArray2D< Type >::rowNum, and vpArray2D< Type >::rowPtrs.
Referenced by operator-().
|
static |
Operation C = A - B on column vectors.
The result is placed in the third parameter C and not returned. A new vector won't be allocated for every use of the function (speed gain if used many times with the same result matrix size).
vpException::dimensionError | If A and B vectors have not the same size. |
Definition at line 1005 of file vpMatrix.cpp.
References vpArray2D< Type >::colNum, vpException::dimensionError, vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpColVector::resize(), vpArray2D< Type >::rowNum, and vpArray2D< Type >::rowPtrs.
double vpMatrix::sum | ( | ) | const |
Return the sum of all the elements of the matrix.
Definition at line 1155 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
Referenced by expm().
double vpMatrix::sumSquare | ( | ) | const |
Return the sum square of all the elements of the matrix .
Definition at line 3593 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< double >::rowNum, and vpArray2D< double >::rowPtrs.
void vpMatrix::svd | ( | vpColVector & | w, |
vpMatrix & | v | ||
) |
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 1631 of file vpMatrix.cpp.
References vpArray2D< double >::getCols(), vpArray2D< Type >::getCols(), vpArray2D< Type >::getRows(), vpArray2D< Type >::resize(), and vpColVector::resize().
Referenced by cond(), vpHomography::DLT(), kernel(), vpPose::poseDementhonPlan(), and pseudoInverse().
vpMatrix vpMatrix::t | ( | ) | const |
Compute and return the transpose of the matrix.
Definition at line 207 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< Type >::resize(), and vpArray2D< double >::rowNum.
Referenced by vpCalibration::calibrationTsai(), vpServo::computeControlLaw(), computeCovarianceMatrix(), vpTemplateTracker::computeOptimalBrentGain(), eigenValues(), vpKalmanFilter::filtering(), vpTemplateTrackerWarpHomographySL3::findWarp(), vpPose::poseDementhonNonPlan(), vpPose::poseDementhonPlan(), vpKalmanFilter::prediction(), and pseudoInverse().
vpMatrix vpMatrix::transpose | ( | ) | const |
Compute and return the transpose of the matrix.
Definition at line 233 of file vpMatrix.cpp.
Referenced by vpServo::computeProjectionOperators(), vpTemplateTrackerWarpRT::getParamInverse(), and vpTemplateTrackerWarpSRT::getParamInverse().
void vpMatrix::transpose | ( | vpMatrix & | At | ) | const |
Compute At the transpose of the matrix.
At | (output) : Resulting transpose matrix. |
Definition at line 245 of file vpMatrix.cpp.
References vpArray2D< double >::colNum, vpArray2D< Type >::resize(), vpArray2D< double >::rowNum, vpArray2D< Type >::rowPtrs, and vpArray2D< double >::rowPtrs.
Allow to multiply a scalar by a matrix.
Definition at line 1185 of file vpMatrix.cpp.
References vpArray2D< Type >::getCols(), and vpArray2D< Type >::getRows().
|
related |
Enumeration of the operations applied on matrices in vpGEMM() function.
Operations are :
|
protectedinherited |
Number of columns in the array.
Definition at line 76 of file vpArray2D.h.
Referenced by AAt(), AtA(), vpColVector::clear(), diag(), eigenValues(), expm(), eye(), infinityNorm(), vpSubColVector::init(), vpSubRowVector::init(), vpSubMatrix::init(), vpRowVector::insert(), insert(), inverseByCholesky(), inverseByLU(), inverseByQR(), vpRotationMatrix::operator*(), vpRowVector::operator*(), operator*(), vpRotationMatrix::operator*=(), vpRowVector::operator*=(), operator*=(), vpRowVector::operator+(), vpRowVector::operator+=(), operator+=(), vpRowVector::operator-(), vpRowVector::operator-=(), operator-=(), vpRowVector::operator/(), operator/(), vpRowVector::operator/=(), operator/=(), operator<<(), vpColVector::operator<<(), vpSubRowVector::operator=(), vpSubMatrix::operator=(), vpRowVector::operator=(), operator=(), vpRowVector::reshape(), setIdentity(), solveBySVD(), vpRowVector::stack(), stackColumns(), stackRows(), vpRowVector::sum(), sum(), vpRowVector::sumSquare(), sumSquare(), vpRowVector::t(), t(), and transpose().
|
inherited |
Address of the first element of the data array.
Definition at line 84 of file vpArray2D.h.
Referenced by AtA(), vpHomogeneousMatrix::buildFrom(), vpRzyxVector::buildFrom(), vpRzyzVector::buildFrom(), vpRxyzVector::buildFrom(), vpThetaUVector::buildFrom(), vpSubColVector::checkParentStatus(), vpSubRowVector::checkParentStatus(), vpSubMatrix::checkParentStatus(), vpColVector::clear(), vpHomogeneousMatrix::convert(), vpTranslationVector::euclideanNorm(), vpRowVector::euclideanNorm(), euclideanNorm(), expm(), vpThetaUVector::extract(), vpThetaUVector::getTheta(), vpThetaUVector::getU(), vpSubColVector::init(), vpSubRowVector::init(), vpSubMatrix::init(), vpTranslationVector::operator*(), vpRowVector::operator*(), vpColVector::operator*(), vpHomography::operator*(), vpTranslationVector::operator-(), vpRowVector::operator-(), vpColVector::operator-(), vpTranslationVector::operator/(), vpRowVector::operator/(), vpColVector::operator/(), vpHomography::operator/(), vpHomography::operator/=(), vpSubColVector::operator=(), vpSubRowVector::operator=(), vpQuaternionVector::operator=(), vpTranslationVector::operator=(), vpRowVector::operator=(), vpRzyxVector::operator=(), vpRzyzVector::operator=(), vpRxyzVector::operator=(), vpColVector::operator=(), operator=(), vpThetaUVector::operator=(), vpColVector::operator[](), vpRowVector::reshape(), vpColVector::reshape(), vpQuaternionVector::set(), stackRows(), vpColVector::sum(), vpColVector::sumSquare(), vpRotationVector::t(), vpTranslationVector::t(), vpPoseVector::t(), vpRowVector::t(), vpColVector::t(), vpQuaternionVector::vpQuaternionVector(), vpRxyzVector::vpRxyzVector(), vpRzyxVector::vpRzyxVector(), vpRzyzVector::vpRzyzVector(), vpThetaUVector::vpThetaUVector(), vpQuaternionVector::w(), vpQuaternionVector::x(), vpQuaternionVector::y(), vpQuaternionVector::z(), vpSubColVector::~vpSubColVector(), vpSubMatrix::~vpSubMatrix(), and vpSubRowVector::~vpSubRowVector().
|
protectedinherited |
Current array size (rowNum * colNum)
Definition at line 80 of file vpArray2D.h.
Referenced by vpColVector::clear(), vpTranslationVector::euclideanNorm(), vpRowVector::euclideanNorm(), euclideanNorm(), vpSubColVector::init(), vpSubRowVector::init(), vpSubMatrix::init(), vpTranslationVector::operator*(), vpRotationVector::operator*(), vpTranslationVector::operator-(), vpTranslationVector::operator/(), vpRzyzVector::operator=(), vpRzyxVector::operator=(), vpRxyzVector::operator=(), operator=(), vpThetaUVector::operator=(), vpRowVector::reshape(), vpColVector::reshape(), stackRows(), and vpRotationVector::t().
|
protectedinherited |
Number of rows in the array.
Definition at line 74 of file vpArray2D.h.
Referenced by AAt(), AtA(), vpColVector::clear(), diag(), eigenValues(), expm(), vpColVector::extract(), eye(), vpColVector::infinityNorm(), infinityNorm(), vpSubColVector::init(), vpSubRowVector::init(), vpSubMatrix::init(), insert(), inverseByCholesky(), inverseByLU(), inverseByQR(), vpRotationMatrix::operator*(), vpTranslationVector::operator*(), vpHomogeneousMatrix::operator*(), vpColVector::operator*(), operator*(), vpRotationMatrix::operator*=(), vpTranslationVector::operator*=(), vpColVector::operator*=(), operator*=(), vpColVector::operator+(), vpColVector::operator+=(), operator+=(), vpColVector::operator-(), vpColVector::operator-=(), operator-=(), vpColVector::operator/(), operator/(), vpTranslationVector::operator/=(), vpColVector::operator/=(), operator/=(), operator<<(), vpColVector::operator<<(), vpSubColVector::operator=(), vpSubRowVector::operator=(), vpSubMatrix::operator=(), vpTranslationVector::operator=(), vpRowVector::operator=(), vpColVector::operator=(), operator=(), vpColVector::reshape(), setIdentity(), stack(), vpColVector::stack(), stackColumns(), stackRows(), vpColVector::sum(), sum(), vpRotationVector::sumSquare(), vpTranslationVector::sumSquare(), vpColVector::sumSquare(), sumSquare(), vpTranslationVector::t(), vpPoseVector::t(), vpColVector::t(), t(), and transpose().
|
protectedinherited |
Address of the first element of each rows.
Definition at line 78 of file vpArray2D.h.
Referenced by AAt(), vpColVector::clear(), infinityNorm(), vpSubColVector::init(), vpSubRowVector::init(), vpSubMatrix::init(), vpRowVector::init(), vpColVector::init(), init(), vpRotationMatrix::operator*(), vpForceTwistMatrix::operator*(), vpVelocityTwistMatrix::operator*(), vpHomogeneousMatrix::operator*(), operator*(), vpRotationMatrix::operator*=(), operator*=(), operator+=(), operator-=(), operator/(), operator/=(), operator<<(), vpColVector::operator<<(), vpSubMatrix::operator=(), vpRotationMatrix::operator=(), vpForceTwistMatrix::operator=(), vpVelocityTwistMatrix::operator=(), vpHomogeneousMatrix::operator=(), vpRowVector::operator=(), operator=(), stackColumns(), vpRowVector::sum(), sum(), vpRotationVector::sumSquare(), vpTranslationVector::sumSquare(), vpRowVector::sumSquare(), sumSquare(), and transpose().