mirror of https://github.com/AxioDL/zeus.git
46 lines
1.1 KiB
C++
46 lines
1.1 KiB
C++
#include "zeus/CMatrix4f.hpp"
|
|
|
|
namespace zeus
|
|
{
|
|
|
|
const CMatrix4f CMatrix4f::skIdentityMatrix4f = CMatrix4f();
|
|
|
|
CMatrix4f CMatrix4f::transposed() const
|
|
{
|
|
CMatrix4f ret;
|
|
#if __SSE__
|
|
if (!cpuFeatures().SSE41)
|
|
return transposedSSE3();
|
|
__m128 T0 = _mm_unpacklo_ps(vec[0].mVec128, vec[1].mVec128);
|
|
__m128 T2 = _mm_unpacklo_ps(vec[2].mVec128, vec[3].mVec128);
|
|
__m128 T1 = _mm_unpackhi_ps(vec[0].mVec128, vec[1].mVec128);
|
|
__m128 T3 = _mm_unpackhi_ps(vec[2].mVec128, vec[3].mVec128);
|
|
ret.vec[0].mVec128 = _mm_movelh_ps(T0, T2);
|
|
ret.vec[1].mVec128 = _mm_movehl_ps(T2, T0);
|
|
ret.vec[2].mVec128 = _mm_movelh_ps(T1, T3);
|
|
ret.vec[3].mVec128 = _mm_movehl_ps(T3, T1);
|
|
#else
|
|
ret.m[0][0] = m[0][0];
|
|
ret.m[1][0] = m[0][1];
|
|
ret.m[2][0] = m[0][2];
|
|
ret.m[3][0] = m[0][3];
|
|
|
|
ret.m[0][1] = m[1][0];
|
|
ret.m[1][1] = m[1][1];
|
|
ret.m[2][1] = m[1][2];
|
|
ret.m[3][1] = m[1][3];
|
|
|
|
ret.m[0][2] = m[2][0];
|
|
ret.m[1][2] = m[2][1];
|
|
ret.m[2][2] = m[2][2];
|
|
ret.m[3][2] = m[2][3];
|
|
|
|
ret.m[0][3] = m[3][0];
|
|
ret.m[1][3] = m[3][1];
|
|
ret.m[2][3] = m[3][2];
|
|
ret.m[3][3] = m[3][3];
|
|
#endif
|
|
return ret;
|
|
}
|
|
}
|