ProjectBackup/C#/TSEngine/Core/Math/matrix4x4.ts

namespace TSE {

    export class Matrix4x4 {

        private _data: number[] = [];

        private constructor() {
            this._data = [
                1, 0, 0, 0,
                0, 1, 0, 0,
                0, 0, 1, 0,
                0, 0, 0, 1
            ];
        }

        public get data(): number[] {
            return this._data;
        }

        public static identity(): Matrix4x4 {
            return new Matrix4x4();
        }

        public static orthographic(left: number, right: number, bottom: number, top: number, nearClip: number, farClip: number): Matrix4x4 {
            let matrix = new Matrix4x4();

            let lr: number = 1.0 / (left - right);
            let bt: number = 1.0 / (bottom - top);
            let nf: number = 1.0 / (nearClip - farClip);

            matrix._data[0] = -2.0 * lr;
            matrix._data[5] = -2.0 * bt;
            matrix._data[10] = 2.0 * nf;

            matrix._data[12] = (left + right) * lr;
            matrix._data[13] = (top + bottom) * bt;
            matrix._data[14] = (farClip + nearClip) * nf;

            return matrix;
        }

        public static translation(position: Vector3): Matrix4x4 {
            let matrix = new Matrix4x4();

            matrix._data[12] = position.x;
            matrix._data[13] = position.y;
            matrix._data[14] = position.z;

            return matrix;
        }

        public static rotationX(angle: number): Matrix4x4 {
            let matrix = new Matrix4x4();

            let c = Math.cos(angle);
            let s = Math.sin(angle);

            matrix._data[5] = c;
            matrix._data[6] = s;
            matrix._data[9] = -s;
            matrix._data[10] = c;

            return matrix;
        }

        public static rotationY(angle: number): Matrix4x4 {
            let matrix = new Matrix4x4();

            let c = Math.cos(angle);
            let s = Math.sin(angle);

            matrix._data[0] = c;
            matrix._data[2] = -s;
            matrix._data[8] = s;
            matrix._data[10] = c;

            return matrix;
        }

        public static rotationZ(angle: number): Matrix4x4 {
            let matrix = new Matrix4x4();

            let c = Math.cos(angle);
            let s = Math.sin(angle);

            matrix._data[0] = c;
            matrix._data[1] = s;
            matrix._data[4] = -s;
            matrix._data[5] = c;

            return matrix;
        }

        public static rotationXYZ(x: number, y: number, z: number): Matrix4x4 {
            return Matrix4x4.multiply3(Matrix4x4.rotationZ(z), Matrix4x4.rotationY(y), Matrix4x4.rotationX(x));
        }

        public static scale(scale: Vector3): Matrix4x4 {
            let matrix = new Matrix4x4();

            matrix._data[0] = scale.x;
            matrix._data[5] = scale.y;
            matrix._data[10] = scale.z;

            return matrix;
        }

        public static multiply(a: Matrix4x4, b: Matrix4x4): Matrix4x4 {
            let matrix = new Matrix4x4();

            let b00 = b._data[0 * 4 + 0];
            let b01 = b._data[0 * 4 + 1];
            let b02 = b._data[0 * 4 + 2];
            let b03 = b._data[0 * 4 + 3];
            let b10 = b._data[1 * 4 + 0];
            let b11 = b._data[1 * 4 + 1];
            let b12 = b._data[1 * 4 + 2];
            let b13 = b._data[1 * 4 + 3];
            let b20 = b._data[2 * 4 + 0];
            let b21 = b._data[2 * 4 + 1];
            let b22 = b._data[2 * 4 + 2];
            let b23 = b._data[2 * 4 + 3];
            let b30 = b._data[3 * 4 + 0];
            let b31 = b._data[3 * 4 + 1];
            let b32 = b._data[3 * 4 + 2];
            let b33 = b._data[3 * 4 + 3];
            let a00 = a._data[0 * 4 + 0];
            let a01 = a._data[0 * 4 + 1];
            let a02 = a._data[0 * 4 + 2];
            let a03 = a._data[0 * 4 + 3];
            let a10 = a._data[1 * 4 + 0];
            let a11 = a._data[1 * 4 + 1];
            let a12 = a._data[1 * 4 + 2];
            let a13 = a._data[1 * 4 + 3];
            let a20 = a._data[2 * 4 + 0];
            let a21 = a._data[2 * 4 + 1];
            let a22 = a._data[2 * 4 + 2];
            let a23 = a._data[2 * 4 + 3];
            let a30 = a._data[3 * 4 + 0];
            let a31 = a._data[3 * 4 + 1];
            let a32 = a._data[3 * 4 + 2];
            let a33 = a._data[3 * 4 + 3];

            matrix._data[0] = b00 * a00 + b01 * a10 + b02 * a20 + b03 * a30;
            matrix._data[1] = b00 * a01 + b01 * a11 + b02 * a21 + b03 * a31;
            matrix._data[2] = b00 * a02 + b01 * a12 + b02 * a22 + b03 * a32;
            matrix._data[3] = b00 * a03 + b01 * a13 + b02 * a23 + b03 * a33;
            matrix._data[4] = b10 * a00 + b11 * a10 + b12 * a20 + b13 * a30;
            matrix._data[5] = b10 * a01 + b11 * a11 + b12 * a21 + b13 * a31;
            matrix._data[6] = b10 * a02 + b11 * a12 + b12 * a22 + b13 * a32;
            matrix._data[7] = b10 * a03 + b11 * a13 + b12 * a23 + b13 * a33;
            matrix._data[8] = b20 * a00 + b21 * a10 + b22 * a20 + b23 * a30;
            matrix._data[9] = b20 * a01 + b21 * a11 + b22 * a21 + b23 * a31;
            matrix._data[10] = b20 * a02 + b21 * a12 + b22 * a22 + b23 * a32;
            matrix._data[11] = b20 * a03 + b21 * a13 + b22 * a23 + b23 * a33;
            matrix._data[12] = b30 * a00 + b31 * a10 + b32 * a20 + b33 * a30;
            matrix._data[13] = b30 * a01 + b31 * a11 + b32 * a21 + b33 * a31;
            matrix._data[14] = b30 * a02 + b31 * a12 + b32 * a22 + b33 * a32;
            matrix._data[15] = b30 * a03 + b31 * a13 + b32 * a23 + b33 * a33;

            return matrix;
        }
        public static multiply3(a: Matrix4x4, b: Matrix4x4, c: Matrix4x4): Matrix4x4 {
            return Matrix4x4.multiply(Matrix4x4.multiply(a, b), c);
        }

        public toFloat32Array(): Float32Array { return new Float32Array(this._data); }

        public copyFrom(matrix: Matrix4x4): void {
            for (let i = 0; i < this._data.length; i++) {
                this._data[i] = matrix._data[i];
            }
        }

    }

}