42 #include <visp3/core/vpRzyxVector.h> 109 double phi = atan2(ny, nx);
110 double si = sin(phi);
111 double co = cos(phi);
114 double theta = atan2(-nz, co * nx + si * ny);
121 double psi = atan2(si * ax - co * ay, -si * ox + co * oy);
161 if (rzyx.
size() != 3) {
165 for (
unsigned int i = 0; i < 3; i++)
177 if (rzyx.size() != 3) {
181 for (
unsigned int i = 0; i < 3; i++)
208 for (
unsigned int i = 0; i <
dsize; i++)
239 if (rzyx.
size() != 3) {
243 for (
unsigned int i = 0; i < 3; i++)
Implementation of a generic rotation vector.
error that can be emited by ViSP classes.
vpRzyxVector & operator=(const vpColVector &rzyx)
double * data
Address of the first element of the data array.
unsigned int size() const
Return the number of elements of the 2D array.
Implementation of a rotation vector as Euler angle minimal representation.
Implementation of a rotation matrix and operations on such kind of matrices.
vpRotationMatrix buildFrom(const vpHomogeneousMatrix &M)
vpRzyxVector buildFrom(const vpRotationMatrix &R)
Implementation of column vector and the associated operations.
unsigned int dsize
Current array size (rowNum * colNum)
Implementation of a rotation vector as axis-angle minimal representation.