mirror of
https://github.com/SapphireServer/Sapphire.git
synced 2025-04-24 13:47:46 +00:00
101 lines
2.3 KiB
C
101 lines
2.3 KiB
C
|
#ifndef _MATRIX4_H
|
||
|
|
#define _MATRIX4_H
|
||
|
|
|
||
|
|
#include <cstdint>
|
||
|
|
#include <cmath>
|
||
|
|
|
||
|
|
// https://github.com/jpd002/Play--Framework/tree/master/include/math
|
||
|
|
struct matrix4
|
||
|
|
{
|
||
|
|
// 4x4
|
||
|
|
float grid[16];
|
||
|
|
matrix4()
|
||
|
|
{
|
||
|
|
memset( &grid[0], 0, sizeof( grid ) );
|
||
|
|
}
|
||
|
|
|
||
|
|
float operator()( int row, int col ) const
|
||
|
|
{
|
||
|
|
return grid[(row * 4) + col];
|
||
|
|
}
|
||
|
|
|
||
|
|
float& operator()( int row, int col )
|
||
|
|
{
|
||
|
|
return grid[(row * 4) + col];
|
||
|
|
}
|
||
|
|
static matrix4 rotateX( float angle )
|
||
|
|
{
|
||
|
|
matrix4 ret = matrix4();
|
||
|
|
ret(0, 0) = 1.000000000f;
|
||
|
|
ret(1, 1) = cos(angle);
|
||
|
|
ret(1, 2) = -sin(angle);
|
||
|
|
ret(2, 1) = sin(angle);
|
||
|
|
ret(2, 2) = cos(angle);
|
||
|
|
ret(3, 3) = 1.000000000f;
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
static matrix4 rotateY( float angle )
|
||
|
|
{
|
||
|
|
matrix4 ret = matrix4();
|
||
|
|
ret(0, 0) = cos(angle);
|
||
|
|
ret(0, 2) = sin(angle);
|
||
|
|
ret(1, 1) = 1.000000000f;
|
||
|
|
ret(2, 0) = -sin(angle);
|
||
|
|
ret(2, 2) = cos(angle);
|
||
|
|
ret(3, 3) = 1.000000000f;
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
static matrix4 rotateZ( float angle )
|
||
|
|
{
|
||
|
|
matrix4 ret = matrix4();
|
||
|
|
ret(0, 0) = cos(angle);
|
||
|
|
ret(0, 1) = -sin(angle);
|
||
|
|
ret(1, 0) = sin(angle);
|
||
|
|
ret(1, 1) = cos(angle);
|
||
|
|
ret(2, 2) = 1.000000000f;
|
||
|
|
ret(3, 3) = 1.000000000f;
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
static matrix4 scale( float x, float y, float z )
|
||
|
|
{
|
||
|
|
matrix4 ret = matrix4();
|
||
|
|
ret(0, 0) = x;
|
||
|
|
ret(1, 1) = y;
|
||
|
|
ret(2, 2) = z;
|
||
|
|
ret(3, 3) = 1;
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
static matrix4 translate( float x, float y, float z )
|
||
|
|
{
|
||
|
|
matrix4 ret = matrix4();
|
||
|
|
ret(0, 0) = 1;
|
||
|
|
ret(1, 1) = 1;
|
||
|
|
ret(2, 2) = 1;
|
||
|
|
ret(3, 3) = 1;
|
||
|
|
|
||
|
|
ret(3, 0) = x;
|
||
|
|
ret(3, 1) = y;
|
||
|
|
ret(3, 2) = z;
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
matrix4 operator *( const matrix4& rhs ) const
|
||
|
|
{
|
||
|
|
matrix4 ret;
|
||
|
|
for( unsigned int i = 0; i < 4; i++ )
|
||
|
|
{
|
||
|
|
ret( i, 0 ) = (*this)(i, 0) * rhs( 0, 0 ) + (*this)(i, 1) * rhs( 1, 0 ) + (*this)(i, 2) * rhs( 2, 0 ) + (*this)(i, 3) * rhs( 3, 0 );
|
||
|
|
ret( i, 1 ) = (*this)(i, 0) * rhs( 0, 1 ) + (*this)(i, 1) * rhs( 1, 1 ) + (*this)(i, 2) * rhs( 2, 1 ) + (*this)(i, 3) * rhs( 3, 1 );
|
||
|
|
ret( i, 2 ) = (*this)(i, 0) * rhs( 0, 2 ) + (*this)(i, 1) * rhs( 1, 2 ) + (*this)(i, 2) * rhs( 2, 2 ) + (*this)(i, 3) * rhs( 3, 2 );
|
||
|
|
ret( i, 3 ) = (*this)(i, 0) * rhs( 0, 3 ) + (*this)(i, 1) * rhs( 1, 3 ) + (*this)(i, 2) * rhs( 2, 3 ) + (*this)(i, 3) * rhs( 3, 3 );
|
||
|
|
}
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
};
|
||
|
|
#endif
|