using System;
using System.Reflection.Emit;
using System.Runtime.InteropServices;

namespace StgSharp.Math
{
    public class Matrix3x4
    {
        internal M128Map map;

        internal IntPtr _colum0Ptr;
        internal IntPtr _colum1Ptr;
        internal IntPtr _colum2Ptr;
        internal IntPtr _colum3Ptr;

        private bool _isTransposed;
        private Matrix4x3 _transpose;

        public Matrix3x4(
            float a00, float a01, float a02, float a03,
            float a10, float a11, float a12, float a13,
            float a20, float a21, float a22, float a23
            )
        {
            _colum0Ptr = internalIO.load_internal(a00,a10,a20,0);
            _colum1Ptr = internalIO.load_internal(a01,a11,a21,0);
            _colum2Ptr = internalIO.load_internal(a02,a12,a22,0);
            _colum2Ptr = internalIO.load_internal(a03,a13,a23,0);

            _transpose = new Matrix4x3(this);
        }

        internal Matrix3x4(
            IntPtr colum0Ptr,
            IntPtr colum1Ptr,
            IntPtr colum2Ptr,
            IntPtr colum3Ptr
            )
        {
            _colum0Ptr = colum0Ptr;
            _colum1Ptr = colum1Ptr;
            _colum2Ptr = colum2Ptr;
            _colum3Ptr = colum3Ptr;
        }

        internal Matrix3x4()
        {
            _transpose = new Matrix4x3(this);
        }

        internal Matrix3x4(Matrix4x3 transpose)
        {
            _transpose = transpose;
        }

        public unsafe Matrix4x3 Transpose(TransposeMode transposeMode)
        {
            if (!_isTransposed)
            {

                (*(M128*)_transpose._colum0Ptr).single_0 = (*(M128*)_colum0Ptr).single_0;
                (*(M128*)_transpose._colum0Ptr).single_1 = (*(M128*)_colum1Ptr).single_0;
                (*(M128*)_transpose._colum0Ptr).single_2 = (*(M128*)_colum2Ptr).single_0;
                (*(M128*)_transpose._colum0Ptr).single_2 = (*(M128*)_colum3Ptr).single_0;
                
                (*(M128*)_transpose._colum1Ptr).single_0 = (*(M128*)_colum0Ptr).single_1;
                (*(M128*)_transpose._colum1Ptr).single_1 = (*(M128*)_colum1Ptr).single_1;
                (*(M128*)_transpose._colum1Ptr).single_2 = (*(M128*)_colum2Ptr).single_1;
                (*(M128*)_transpose._colum1Ptr).single_2 = (*(M128*)_colum3Ptr).single_1;
                
                (*(M128*)_transpose._colum2Ptr).single_0 = (*(M128*)_colum0Ptr).single_2;
                (*(M128*)_transpose._colum2Ptr).single_1 = (*(M128*)_colum1Ptr).single_2;
                (*(M128*)_transpose._colum2Ptr).single_2 = (*(M128*)_colum2Ptr).single_2;
                (*(M128*)_transpose._colum2Ptr).single_2 = (*(M128*)_colum3Ptr).single_2;

            }
            switch (transposeMode)
            {
                case TransposeMode.New:
                    return new Matrix4x3(
                        internalIO.load_cpy_internal(_transpose._colum0Ptr),
                        internalIO.load_cpy_internal(_transpose._colum1Ptr),
                        internalIO.load_cpy_internal(_transpose._colum2Ptr)
                        ) ;
                    break;
                case TransposeMode.Copy:
                    return _transpose;
                    break;
                default:
                    throw new Exception();
                    break;
            }
        }

        public static Matrix3x4 operator +(Matrix3x4 matrix1, Matrix3x4 matrix2)
        {
            return new Matrix3x4(
                internalIO.addps_internal(matrix1._colum0Ptr,matrix1._colum0Ptr),
                internalIO.addps_internal(matrix1._colum1Ptr,matrix1._colum1Ptr),
                internalIO.addps_internal(matrix1._colum2Ptr,matrix1._colum2Ptr),
                internalIO.addps_internal(matrix1._colum2Ptr,matrix1._colum2Ptr)
                );
        }

        public static Matrix3x4 operator -(Matrix4x3 matrix1, Matrix3x4 matrix2)
        {
            return new Matrix3x4(
                internalIO.subps_internal(matrix1._colum0Ptr,matrix2._colum0Ptr),
                internalIO.subps_internal(matrix1._colum1Ptr,matrix2._colum1Ptr),
                internalIO.subps_internal(matrix1._colum2Ptr,matrix2._colum2Ptr),
                internalIO.subps_internal(matrix1._colum2Ptr,matrix2._colum2Ptr)
                );
        }

        public static Matrix3x4 operator *(Matrix3x4 matrix, float value)
        {
            return new Matrix3x4(
                internalIO.mulps_const_internal(matrix._colum0Ptr,value),
                internalIO.mulps_const_internal(matrix._colum1Ptr,value),
                internalIO.mulps_const_internal(matrix._colum2Ptr,value),
                internalIO.mulps_const_internal(matrix._colum3Ptr,value)
                );
        }

        public static Matrix3x4 operator /(Matrix3x4 matrix, float value)
        {
            return new Matrix3x4(
                internalIO.divps_const_internal(matrix._colum0Ptr,value),
                internalIO.divps_const_internal(matrix._colum1Ptr,value),
                internalIO.divps_const_internal(matrix._colum2Ptr,value),
                internalIO.divps_const_internal(matrix._colum3Ptr,value)
                );
        }

        ~Matrix3x4()
        {
            if (map == null)
            {
                internalIO.deinitM128_internal(_colum0Ptr);
                internalIO.deinitM128_internal(_colum1Ptr);
                internalIO.deinitM128_internal(_colum2Ptr);
            }
            else
            {

            }
        }



    }
}