mirror of
https://github.com/SapphireServer/Sapphire.git
synced 2025-04-24 13:47:46 +00:00
111 lines
2.5 KiB
C++
111 lines
2.5 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
|