bgc-net/BasicGeometry/FP32Matrix3x2.cs

/*
 * Copyright 2019-2025 Andrey Pokidov <andrey.pokidov@gmail.com>
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

/*
 * Author: Andrey Pokidov
 * Date: 11 Nov 2024
 */
namespace BasicGeometry
{
    public struct FP32Matrix3x2
    {
        public float r1c1 = 0.0f, r1c2 = 0.0f, r1c3 = 0.0f;
        public float r2c1 = 0.0f, r2c2 = 0.0f, r2c3 = 0.0f;

        public FP32Matrix3x2(in FP32Matrix3x2 matrix)
        {
            this.r1c1 = matrix.r1c1;
            this.r1c2 = matrix.r1c2;
            this.r1c3 = matrix.r1c3;

            this.r2c1 = matrix.r2c1;
            this.r2c2 = matrix.r2c2;
            this.r2c3 = matrix.r2c3;
        }

        public FP32Matrix3x2(in FP64Matrix3x2 matrix)
        {
            this.r1c1 = (float) matrix.r1c1;
            this.r1c2 = (float) matrix.r1c2;
            this.r1c3 = (float) matrix.r1c3;

            this.r2c1 = (float) matrix.r2c1;
            this.r2c2 = (float) matrix.r2c2;
            this.r2c3 = (float) matrix.r2c3;
        }

        public FP32Matrix3x2(in FP32Matrix2x3 matrix)
        {
            this.r1c1 = matrix.r1c1;
            this.r1c2 = matrix.r2c1;
            this.r1c3 = matrix.r3c1;

            this.r2c1 = matrix.r1c2;
            this.r2c2 = matrix.r2c2;
            this.r2c3 = matrix.r3c2;
        }

        public FP32Matrix3x2(in FP64Matrix2x3 matrix)
        {
            this.r1c1 = (float) matrix.r1c1;
            this.r1c2 = (float) matrix.r2c1;
            this.r1c3 = (float) matrix.r3c1;

            this.r2c1 = (float) matrix.r1c2;
            this.r2c2 = (float) matrix.r2c2;
            this.r2c3 = (float) matrix.r3c2;
        }

        public void Reset()
        {
            this.r1c1 = 0.0f;
            this.r1c2 = 0.0f;
            this.r1c3 = 0.0f;

            this.r2c1 = 0.0f;
            this.r2c2 = 0.0f;
            this.r2c3 = 0.0f;
        }
    
        public void SetValues(in FP32Matrix3x2 matrix)
        {
            this.r1c1 = matrix.r1c1;
            this.r1c2 = matrix.r1c2;
            this.r1c3 = matrix.r1c3;

            this.r2c1 = matrix.r2c1;
            this.r2c2 = matrix.r2c2;
            this.r2c3 = matrix.r2c3;
        }

        public void SetValues(in FP64Matrix3x2 matrix)
        {
            this.r1c1 = (float) matrix.r1c1;
            this.r1c2 = (float) matrix.r1c2;
            this.r1c3 = (float) matrix.r1c3;

            this.r2c1 = (float) matrix.r2c1;
            this.r2c2 = (float) matrix.r2c2;
            this.r2c3 = (float) matrix.r2c3;
        }
    
        public void SetTransposed(in FP32Matrix2x3 matrix)
        {
            this.r1c1 = matrix.r1c1;
            this.r1c2 = matrix.r2c1;
            this.r1c3 = matrix.r3c1;

            this.r2c1 = matrix.r1c2;
            this.r2c2 = matrix.r2c2;
            this.r2c3 = matrix.r3c2;
        }

        public void SetTransposed(in FP64Matrix2x3 matrix)
        {
            this.r1c1 = (float) matrix.r1c1;
            this.r1c2 = (float) matrix.r2c1;
            this.r1c3 = (float) matrix.r3c1;

            this.r2c1 = (float) matrix.r1c2;
            this.r2c2 = (float) matrix.r2c2;
            this.r2c3 = (float) matrix.r3c2;
        }

        public void SetRow1(float c1, float c2, float c3)
        {
            this.r1c1 = c1;
            this.r1c2 = c2;
            this.r1c3 = c3;
        }

        public void SetRow2(float c1, float c2, float c3)
        {
            this.r2c1 = c1;
            this.r2c2 = c2;
            this.r2c3 = c3;
        }

        public void SetColumn1(float r1, float r2)
        {
            this.r1c1 = r1;
            this.r2c1 = r2;
        }

        public void SetColumn2(float r1, float r2)
        {
            this.r1c2 = r1;
            this.r2c2 = r2;
        }

        public void SetColumn3(float r1, float r2)
        {
            this.r1c3 = r1;
            this.r2c3 = r2;
        }

        public void AppendScaled(in FP32Matrix3x2 matrix, float scale)
        {
            this.r1c1 += matrix.r1c1 * scale;
            this.r1c2 += matrix.r1c2 * scale;
            this.r1c3 += matrix.r1c3 * scale;

            this.r2c1 += matrix.r2c1 * scale;
            this.r2c2 += matrix.r2c2 * scale;
            this.r2c3 += matrix.r2c3 * scale;
        }

        public static void Add(in FP32Matrix3x2 matrix1, in FP32Matrix3x2 matrix2, out FP32Matrix3x2 sum)
        {
            sum.r1c1 = matrix1.r1c1 + matrix2.r1c1;
            sum.r1c2 = matrix1.r1c2 + matrix2.r1c2;
            sum.r1c3 = matrix1.r1c3 + matrix2.r1c3;

            sum.r2c1 = matrix1.r2c1 + matrix2.r2c1;
            sum.r2c2 = matrix1.r2c2 + matrix2.r2c2;
            sum.r2c3 = matrix1.r2c3 + matrix2.r2c3;
        }

        public static void Subtract(in FP32Matrix3x2 minuend, in FP32Matrix3x2 subtrahend, out FP32Matrix3x2 difference)
        {
            difference.r1c1 = minuend.r1c1 - subtrahend.r1c1;
            difference.r1c2 = minuend.r1c2 - subtrahend.r1c2;
            difference.r1c3 = minuend.r1c3 - subtrahend.r1c3;

            difference.r2c1 = minuend.r2c1 - subtrahend.r2c1;
            difference.r2c2 = minuend.r2c2 - subtrahend.r2c2;
            difference.r2c3 = minuend.r2c3 - subtrahend.r2c3;
        }

        public static void Multiply(in FP32Matrix3x2 multiplicand, float multiplier, out FP32Matrix3x2 product)
        {
            product.r1c1 = multiplicand.r1c1 * multiplier;
            product.r1c2 = multiplicand.r1c2 * multiplier;
            product.r1c3 = multiplicand.r1c3 * multiplier;

            product.r2c1 = multiplicand.r2c1 * multiplier;
            product.r2c2 = multiplicand.r2c2 * multiplier;
            product.r2c3 = multiplicand.r2c3 * multiplier;
        }

        public static void Divide(in FP32Matrix3x2 dividend, float divisor, out FP32Matrix3x2 quotient)
        {
            Multiply(dividend, 1.0f / divisor, out quotient);
        }

        public static void GetRightProduct(in FP32Matrix3x2 matrix, in FP32Vector3 vector, out FP32Vector2 result)
        {
            result.x1 = matrix.r1c1 * vector.x1 + matrix.r1c2 * vector.x2 + matrix.r1c3 * vector.x3;
            result.x2 = matrix.r2c1 * vector.x1 + matrix.r2c2 * vector.x2 + matrix.r2c3 * vector.x3;
        }

        public static void GetLeftProduct(in FP32Vector2 vector, in FP32Matrix3x2 matrix, out FP32Vector3 result)
        {
            result.x1 = vector.x1 * matrix.r1c1 + vector.x2 * matrix.r2c1;
            result.x2 = vector.x1 * matrix.r1c2 + vector.x2 * matrix.r2c2;
            result.x3 = vector.x1 * matrix.r1c3 + vector.x2 * matrix.r2c3;
        }
    }
}