#include "StgSharpGraphic.h"


SSGC_API _inline matrix2map* __cdecl add_mat2(matrix2map* mat1, matrix2map* mat2)
{
	matrix2map* ret = _aligned_malloc(sizeof(matrix2map), 16);

	if (ret != 0)
	{
		ret->colum[0] = _mm_add_ps(mat1->colum[0], mat2->colum[0]);
		ret->colum[1] = _mm_add_ps(mat1->colum[1], mat2->colum[1]);
	}

	return ret;
}

SSGC_API _inline matrix2map* __cdecl sub_mat2(matrix2map* mat1, matrix2map* mat2)
{
	matrix2map* ret = _aligned_malloc(sizeof(matrix2map), 16);

	if (ret != 0)
	{
		ret->colum[0] = _mm_sub_ps(mat1->colum[0], mat2->colum[0]);
		ret->colum[1] = _mm_sub_ps(mat1->colum[1], mat2->colum[1]);
	}

	return ret;
}


SSGC_API _inline void __cdecl transmpose2to4(matrix2map* source, matrix4map* target)
{
    __m128 t0 = _mm_shuffle_ps(ALIGN(source->colum[0]), ALIGN(source->colum[1]), _MM_SHUFFLE(1, 0, 1, 0));
    __m128 t1 = _mm_shuffle_ps(ALIGN(source->colum[0]), ALIGN(source->colum[1]), _MM_SHUFFLE(3, 2, 3, 2));

    target->colum[0] = _mm_shuffle_ps(t0, *defaultVecPtr, _MM_SHUFFLE(2, 0, 2, 0));
    target->colum[1] = _mm_shuffle_ps(t0, *defaultVecPtr, _MM_SHUFFLE(3, 1, 3, 1));
    target->colum[2] = _mm_shuffle_ps(t1, *defaultVecPtr, _MM_SHUFFLE(2, 0, 2, 0));
    target->colum[3] = _mm_shuffle_ps(t1, *defaultVecPtr, _MM_SHUFFLE(3, 1, 3, 1));
}

SSGC_API _inline void __cdecl deinit_mat2(matrix2map* mat)
{
	_aligned_free(mat);
}