49 #include <visp/vpDebug.h>
50 #include <visp/vpMatrix.h>
51 #include <visp/vpHomogeneousMatrix.h>
52 #include <visp/vpQuaternionVector.h>
55 #include <visp/vpException.h>
56 #include <visp/vpMatrixException.h>
59 #include <visp/vpDebug.h>
80 for (i=0 ; i < 4 ; i++)
81 for (j=0 ; j < 4; j++)
133 buildFrom(p[0],p[1],p[2],p[3],p[4],p[5]) ;
209 for (
int i=0; i<4; i++)
211 for (
int j=0; j<4; j++)
268 for (
unsigned int j=0;j<4;j++) {
269 for (
unsigned int i=0;i<4;i++) {
302 for (i=0 ; i < 3 ; i++)
303 for (j=0 ; j < 3; j++)
304 R[i][j] = (*
this)[i][j] ;
313 t[0] = (*this)[0][3] ;
314 t[1] = (*this)[1][3] ;
315 t[2] = (*this)[2][3] ;
348 for (i=0 ; i < 3 ; i++)
349 for (j=0 ; j < 3; j++)
350 (*
this)[i][j] = R[i][j] ;
372 (*this)[0][3] = T[0] ;
373 (*this)[1][3] = T[1] ;
374 (*this)[2][3] = T[2] ;
429 (*this)[0][1] = (*this)[0][2] = 0 ;
430 (*this)[1][0] = (*this)[1][2] = 0 ;
431 (*this)[2][0] = (*this)[2][1] = 0 ;
519 for (
unsigned int i=0 ; i < 4 ; i++)
520 for (
unsigned int j=0 ; j < 4 ; j++)