matrix.h

robocuo相关资料robocuo相关资料

#ifndef __Matrix1_H
#define __Matrix1_H

#include <stdio.h>
#include <string>

using namespace std;
struct Vector2d;
struct Vector3d;

struct Matrix
{
	Matrix();
	explicit Matrix( const Vector2d & );
	explicit Matrix( const Vector3d & );

	Vector2d getVector2d();
	Vector3d getVector3d();

	Matrix operator*( const Matrix & ) const;
	Vector3d operator*( const Vector3d & ) const;
	Matrix operator-() const;

	static Matrix transferX( double );
	static Matrix transferY( double );
	static Matrix transferZ( double );
	static Matrix translate( double, double, double );

	static Matrix rotateX( double );
	static Matrix rotateY( double );
	static Matrix rotateZ( double );
	static Matrix rotate_arbitrary_axis( Vector3d, double );

	void swap_col( int, int );
	double factor( int, int ) const;
	Matrix cofactors() const;
	Matrix transport() const;
	double determinant() const;

	void print();

	double m[4][4];
};
#endif