The Matrix3x3 class implements a 3x3 rotation matrix, to perform linear algebra in combination with Quaternion, Transform and Vector3. Make sure to only include a pure orthogonal matrix without scaling. More...

#include <Matrix3x3.hpp>

Public Member Functions
	Matrix3x3 ()
	No initialization constructor.

	Matrix3x3 (const Quaternion &q)
	Constructor from Quaternion.

	Matrix3x3 (const tf2Scalar &xx, const tf2Scalar &xy, const tf2Scalar &xz, const tf2Scalar &yx, const tf2Scalar &yy, const tf2Scalar &yz, const tf2Scalar &zx, const tf2Scalar &zy, const tf2Scalar &zz)
	Constructor with row major formatting.

	Matrix3x3 (const Matrix3x3 &other)
	Copy constructor.

Matrix3x3 &	operator= (const Matrix3x3 &other)
	Assignment Operator.

Vector3	getColumn (int i) const
	Get a column of the matrix as a vector.

const Vector3 &	getRow (int i) const
	Get a row of the matrix as a vector.

Vector3 &	operator[] (int i)
	Get a mutable reference to a row of the matrix as a vector.

const Vector3 &	operator[] (int i) const
	Get a const reference to a row of the matrix as a vector.

Matrix3x3 &	operator*= (const Matrix3x3 &m)
	Multiply by the target matrix on the right.

void	setFromOpenGLSubMatrix (const tf2Scalar *m)
	Set from a carray of tf2Scalars.

void	setValue (const tf2Scalar &xx, const tf2Scalar &xy, const tf2Scalar &xz, const tf2Scalar &yx, const tf2Scalar &yy, const tf2Scalar &yz, const tf2Scalar &zx, const tf2Scalar &zy, const tf2Scalar &zz)
	Set the values of the matrix explicitly (row major)

void	setRotation (const Quaternion &q)
	Set the matrix from a quaternion.

void	setEulerYPR (tf2Scalar eulerZ, tf2Scalar eulerY, tf2Scalar eulerX)
	Set the matrix from euler angles YPR around ZYX axes.

void	setRPY (tf2Scalar roll, tf2Scalar pitch, tf2Scalar yaw)
	Set the matrix using RPY about XYZ fixed axes.

void	setIdentity ()
	Set the matrix to the identity.

void	getOpenGLSubMatrix (tf2Scalar *m) const
	Fill the values of the matrix into a 9 element array.

void	getRotation (Quaternion &q) const
	Get the matrix represented as a quaternion.

void	getEulerYPR (tf2Scalar &yaw, tf2Scalar &pitch, tf2Scalar &roll, unsigned int solution_number=1) const
	Get the matrix represented as euler angles around YXZ, roundtrip with setEulerYPR.

void	getRPY (tf2Scalar &roll, tf2Scalar &pitch, tf2Scalar &yaw, unsigned int solution_number=1) const
	Get the matrix represented as roll pitch and yaw about fixed axes XYZ.

Matrix3x3	scaled (const Vector3 &s) const
	Create a scaled copy of the matrix.

tf2Scalar	determinant () const
	Return the determinant of the matrix.

Matrix3x3	adjoint () const
	Return the adjoint of the matrix.

Matrix3x3	absolute () const
	Return the matrix with all values non negative.

Matrix3x3	transpose () const
	Return the transpose of the matrix.

Matrix3x3	inverse () const
	Return the inverse of the matrix.

Matrix3x3	transposeTimes (const Matrix3x3 &m) const

Matrix3x3	timesTranspose (const Matrix3x3 &m) const

tf2Scalar	tdotx (const Vector3 &v) const

tf2Scalar	tdoty (const Vector3 &v) const

tf2Scalar	tdotz (const Vector3 &v) const

void	diagonalize (Matrix3x3 &rot, tf2Scalar threshold, int maxSteps)
	diagonalizes this matrix by the Jacobi method.

tf2Scalar	cofac (int r1, int c1, int r2, int c2) const
	Calculate the matrix cofactor.

void	serialize (struct Matrix3x3Data &dataOut) const

void	serializeFloat (struct Matrix3x3FloatData &dataOut) const

void	deSerialize (const struct Matrix3x3Data &dataIn)

void	deSerializeFloat (const struct Matrix3x3FloatData &dataIn)

void	deSerializeDouble (const struct Matrix3x3DoubleData &dataIn)

Static Public Member Functions
static const Matrix3x3 &	getIdentity ()

Detailed Description

The Matrix3x3 class implements a 3x3 rotation matrix, to perform linear algebra in combination with Quaternion, Transform and Vector3. Make sure to only include a pure orthogonal matrix without scaling.

Constructor & Destructor Documentation

◆ Matrix3x3() [1/4]

tf2::Matrix3x3::Matrix3x3 ( )

inline

No initialization constructor.

◆ Matrix3x3() [2/4]

tf2::Matrix3x3::Matrix3x3 ( const Quaternion & q )

inlineexplicit

Constructor from Quaternion.

◆ Matrix3x3() [3/4]

tf2::Matrix3x3::Matrix3x3	(	const tf2Scalar &	xx,
		const tf2Scalar &	xy,
		const tf2Scalar &	xz,
		const tf2Scalar &	yx,
		const tf2Scalar &	yy,
		const tf2Scalar &	yz,
		const tf2Scalar &	zx,
		const tf2Scalar &	zy,
		const tf2Scalar &	zz
	)

inline

Constructor with row major formatting.

◆ Matrix3x3() [4/4]

tf2::Matrix3x3::Matrix3x3 ( const Matrix3x3 & other )

inline

Copy constructor.

Member Function Documentation

◆ operator=()

Matrix3x3 & tf2::Matrix3x3::operator= ( const Matrix3x3 & other )

inline

Assignment Operator.

◆ getColumn()

Vector3 tf2::Matrix3x3::getColumn ( int i ) const

inline

Get a column of the matrix as a vector.

Parameters

i	Column number 0 indexed

◆ getRow()

const Vector3 & tf2::Matrix3x3::getRow ( int i ) const

inline

Get a row of the matrix as a vector.

Parameters

i	Row number 0 indexed

◆ operator[]() [1/2]

Vector3 & tf2::Matrix3x3::operator[] ( int i )

inline

Get a mutable reference to a row of the matrix as a vector.

Parameters

i	Row number 0 indexed

◆ operator[]() [2/2]

const Vector3 & tf2::Matrix3x3::operator[] ( int i ) const

inline

Get a const reference to a row of the matrix as a vector.

Parameters

i	Row number 0 indexed

◆ operator*=()

Matrix3x3 & tf2::Matrix3x3::operator*= ( const Matrix3x3 & m )

Multiply by the target matrix on the right.

Parameters

m	Rotation matrix to be applied Equivilant to this = this * m

◆ setFromOpenGLSubMatrix()

void tf2::Matrix3x3::setFromOpenGLSubMatrix ( const tf2Scalar * m )

inline

Set from a carray of tf2Scalars.

Parameters

m	A pointer to the beginning of an array of 9 tf2Scalars

◆ setValue()

void tf2::Matrix3x3::setValue	(	const tf2Scalar &	xx,
		const tf2Scalar &	xy,
		const tf2Scalar &	xz,
		const tf2Scalar &	yx,
		const tf2Scalar &	yy,
		const tf2Scalar &	yz,
		const tf2Scalar &	zx,
		const tf2Scalar &	zy,
		const tf2Scalar &	zz
	)

inline

Set the values of the matrix explicitly (row major)

Parameters

xx	Top left
xy	Top Middle
xz	Top Right
yx	Middle Left
yy	Middle Middle
yz	Middle Right
zx	Bottom Left
zy	Bottom Middle
zz	Bottom Right

◆ setRotation()

void tf2::Matrix3x3::setRotation ( const Quaternion & q )

inline

Set the matrix from a quaternion.

Parameters

q	The Quaternion to match

◆ setEulerYPR()

void tf2::Matrix3x3::setEulerYPR	(	tf2Scalar	eulerZ,
		tf2Scalar	eulerY,
		tf2Scalar	eulerX
	)

inline

Set the matrix from euler angles YPR around ZYX axes.

Parameters

eulerZ	Yaw aboud Z axis
eulerY	Pitch around Y axis
eulerX	Roll about X axis

These angles are used to produce a rotation matrix. The euler angles are applied in ZYX order. I.e a vector is first rotated about X then Y and then Z

◆ setRPY()

void tf2::Matrix3x3::setRPY	(	tf2Scalar	roll,
		tf2Scalar	pitch,
		tf2Scalar	yaw
	)

inline

Set the matrix using RPY about XYZ fixed axes.

Parameters

roll	Roll about X axis
pitch	Pitch around Y axis
yaw	Yaw aboud Z axis

◆ setIdentity()

void tf2::Matrix3x3::setIdentity ( )

inline

Set the matrix to the identity.

◆ getIdentity()

static const Matrix3x3 & tf2::Matrix3x3::getIdentity ( )

inlinestatic

◆ getOpenGLSubMatrix()

void tf2::Matrix3x3::getOpenGLSubMatrix ( tf2Scalar * m ) const

inline

Fill the values of the matrix into a 9 element array.

Parameters

m	The array to be filled

◆ getRotation()

void tf2::Matrix3x3::getRotation ( Quaternion & q ) const

inline

Get the matrix represented as a quaternion.

Parameters

q	The quaternion which will be set

◆ getEulerYPR()

void tf2::Matrix3x3::getEulerYPR	(	tf2Scalar &	yaw,
		tf2Scalar &	pitch,
		tf2Scalar &	roll,
		unsigned int	solution_number = `1`
	)		const

inline

Get the matrix represented as euler angles around YXZ, roundtrip with setEulerYPR.

Parameters

yaw	Yaw around Z axis
pitch	Pitch around Y axis
roll	around X axis
solution_number	Which solution of two possible solutions (1 or 2) are possible values

◆ getRPY()

void tf2::Matrix3x3::getRPY	(	tf2Scalar &	roll,
		tf2Scalar &	pitch,
		tf2Scalar &	yaw,
		unsigned int	solution_number = `1`
	)		const

inline

Get the matrix represented as roll pitch and yaw about fixed axes XYZ.

Parameters

roll	around X axis
pitch	Pitch around Y axis
yaw	Yaw around Z axis
solution_number	Which solution of two possible solutions ( 1 or 2) are possible values

◆ scaled()

Matrix3x3 tf2::Matrix3x3::scaled ( const Vector3 & s ) const

inline

Create a scaled copy of the matrix.

Parameters

s	Scaling vector The elements of the vector will scale each column

◆ determinant()

tf2Scalar tf2::Matrix3x3::determinant ( ) const

Return the determinant of the matrix.

◆ adjoint()

Matrix3x3 tf2::Matrix3x3::adjoint ( ) const

Return the adjoint of the matrix.

◆ absolute()

Matrix3x3 tf2::Matrix3x3::absolute ( ) const

Return the matrix with all values non negative.

◆ transpose()

Matrix3x3 tf2::Matrix3x3::transpose ( ) const

Return the transpose of the matrix.

◆ inverse()

Matrix3x3 tf2::Matrix3x3::inverse ( ) const

Return the inverse of the matrix.

◆ transposeTimes()

Matrix3x3 tf2::Matrix3x3::transposeTimes ( const Matrix3x3 & m ) const

◆ timesTranspose()

Matrix3x3 tf2::Matrix3x3::timesTranspose ( const Matrix3x3 & m ) const

◆ tdotx()

tf2Scalar tf2::Matrix3x3::tdotx ( const Vector3 & v ) const

inline

◆ tdoty()

tf2Scalar tf2::Matrix3x3::tdoty ( const Vector3 & v ) const

inline

◆ tdotz()

tf2Scalar tf2::Matrix3x3::tdotz ( const Vector3 & v ) const

inline

◆ diagonalize()

void tf2::Matrix3x3::diagonalize	(	Matrix3x3 &	rot,
		tf2Scalar	threshold,
		int	maxSteps
	)

inline

diagonalizes this matrix by the Jacobi method.

Parameters

rot	stores the rotation from the coordinate system in which the matrix is diagonal to the original coordinate system, i.e., old_this = rot * new_this * rot^T.
threshold	See iteration
maxSteps	The iteration stops when all off-diagonal elements are less than the threshold multiplied by the sum of the absolute values of the diagonal, or when maxSteps have been executed.

Note that this matrix is assumed to be symmetric.

◆ cofac()

tf2Scalar tf2::Matrix3x3::cofac	(	int	r1,
		int	c1,
		int	r2,
		int	c2
	)		const

inline

Calculate the matrix cofactor.

Parameters

r1	The first row to use for calculating the cofactor
c1	The first column to use for calculating the cofactor
r2	The second row to use for calculating the cofactor
c2	The second column to use for calculating the cofactor See http://en.wikipedia.org/wiki/Cofactor_(linear_algebra) for more details

◆ serialize()

void tf2::Matrix3x3::serialize ( struct Matrix3x3Data & dataOut ) const

◆ serializeFloat()

void tf2::Matrix3x3::serializeFloat ( struct Matrix3x3FloatData & dataOut ) const

◆ deSerialize()

void tf2::Matrix3x3::deSerialize ( const struct Matrix3x3Data & dataIn )

◆ deSerializeFloat()

void tf2::Matrix3x3::deSerializeFloat ( const struct Matrix3x3FloatData & dataIn )

◆ deSerializeDouble()

void tf2::Matrix3x3::deSerializeDouble ( const struct Matrix3x3DoubleData & dataIn )

The documentation for this class was generated from the following file:

include/tf2/LinearMath/Matrix3x3.hpp

Public Member Functions

Static Public Member Functions

Detailed Description

Constructor & Destructor Documentation

◆ Matrix3x3() [1/4]

◆ Matrix3x3() [2/4]

◆ Matrix3x3() [3/4]

◆ Matrix3x3() [4/4]

Member Function Documentation

◆ operator=()

◆ getColumn()

◆ getRow()

◆ operator[]() [1/2]

◆ operator[]() [2/2]

◆ operator*=()

◆ setFromOpenGLSubMatrix()

◆ setValue()

◆ setRotation()

◆ setEulerYPR()

◆ setRPY()

◆ setIdentity()

◆ getIdentity()

◆ getOpenGLSubMatrix()

◆ getRotation()

◆ getEulerYPR()

◆ getRPY()

◆ scaled()

◆ determinant()

◆ adjoint()

◆ absolute()

◆ transpose()

◆ inverse()

◆ transposeTimes()

◆ timesTranspose()

◆ tdotx()

◆ tdoty()

◆ tdotz()

◆ diagonalize()

◆ cofac()

◆ serialize()

◆ serializeFloat()

◆ deSerialize()

◆ deSerializeFloat()

◆ deSerializeDouble()