Kimelas/bgc-c
2
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

Развитие дуальный чисел, векторов и кватернионов, а также гомогенных векторов и матриц

Browse source
This commit is contained in:
Andrey Pokidov 2026-02-03 19:56:56 +07:00
parent 3f96b661a9
commit b87518cd3f
21 changed files with 1787 additions and 1511 deletions
Download patch file Download diff file Expand all files Collapse all files

404
basic-geometry/matrix2x3.h
View file

@ -9,166 +9,166 @@
inline void bgc_fp32_matrix2x3_reset(BGC_FP32_Matrix2x3* matrix)
{
matrix->row1_col1 = 0.0f;
matrix->row1_col2 = 0.0f;
matrix->r1c1 = 0.0f;
matrix->r1c2 = 0.0f;
matrix->row2_col1 = 0.0f;
matrix->row2_col2 = 0.0f;
matrix->r2c1 = 0.0f;
matrix->r2c2 = 0.0f;
matrix->row3_col1 = 0.0f;
matrix->row3_col2 = 0.0f;
matrix->r3c1 = 0.0f;
matrix->r3c2 = 0.0f;
}
inline void bgc_fp64_matrix2x3_reset(BGC_FP64_Matrix2x3* matrix)
{
matrix->row1_col1 = 0.0;
matrix->row1_col2 = 0.0;
matrix->r1c1 = 0.0;
matrix->r1c2 = 0.0;
matrix->row2_col1 = 0.0;
matrix->row2_col2 = 0.0;
matrix->r2c1 = 0.0;
matrix->r2c2 = 0.0;
matrix->row3_col1 = 0.0;
matrix->row3_col2 = 0.0;
matrix->r3c1 = 0.0;
matrix->r3c2 = 0.0;
}
// ==================== Copy ==================== //
inline void bgc_fp32_matrix2x3_copy(BGC_FP32_Matrix2x3* destination, const BGC_FP32_Matrix2x3* source)
{
destination->row1_col1 = source->row1_col1;
destination->row1_col2 = source->row1_col2;
destination->r1c1 = source->r1c1;
destination->r1c2 = source->r1c2;
destination->row2_col1 = source->row2_col1;
destination->row2_col2 = source->row2_col2;
destination->r2c1 = source->r2c1;
destination->r2c2 = source->r2c2;
destination->row3_col1 = source->row3_col1;
destination->row3_col2 = source->row3_col2;
destination->r3c1 = source->r3c1;
destination->r3c2 = source->r3c2;
}
inline void bgc_fp64_matrix2x3_copy(BGC_FP64_Matrix2x3* destination, const BGC_FP64_Matrix2x3* source)
{
destination->row1_col1 = source->row1_col1;
destination->row1_col2 = source->row1_col2;
destination->r1c1 = source->r1c1;
destination->r1c2 = source->r1c2;
destination->row2_col1 = source->row2_col1;
destination->row2_col2 = source->row2_col2;
destination->r2c1 = source->r2c1;
destination->r2c2 = source->r2c2;
destination->row3_col1 = source->row3_col1;
destination->row3_col2 = source->row3_col2;
destination->r3c1 = source->r3c1;
destination->r3c2 = source->r3c2;
}
// ==================== Swap ==================== //
inline void bgc_fp32_matrix2x3_swap(BGC_FP32_Matrix2x3* matrix1, BGC_FP32_Matrix2x3* matrix2)
{
const float row1_col1 = matrix2->row1_col1;
const float row1_col2 = matrix2->row1_col2;
const float r1c1 = matrix2->r1c1;
const float r1c2 = matrix2->r1c2;
const float row2_col1 = matrix2->row2_col1;
const float row2_col2 = matrix2->row2_col2;
const float r2c1 = matrix2->r2c1;
const float r2c2 = matrix2->r2c2;
const float row3_col1 = matrix2->row3_col1;
const float row3_col2 = matrix2->row3_col2;
const float r3c1 = matrix2->r3c1;
const float r3c2 = matrix2->r3c2;
matrix2->row1_col1 = matrix1->row1_col1;
matrix2->row1_col2 = matrix1->row1_col2;
matrix2->r1c1 = matrix1->r1c1;
matrix2->r1c2 = matrix1->r1c2;
matrix2->row2_col1 = matrix1->row2_col1;
matrix2->row2_col2 = matrix1->row2_col2;
matrix2->r2c1 = matrix1->r2c1;
matrix2->r2c2 = matrix1->r2c2;
matrix2->row3_col1 = matrix1->row3_col1;
matrix2->row3_col2 = matrix1->row3_col2;
matrix2->r3c1 = matrix1->r3c1;
matrix2->r3c2 = matrix1->r3c2;
matrix1->row1_col1 = row1_col1;
matrix1->row1_col2 = row1_col2;
matrix1->r1c1 = r1c1;
matrix1->r1c2 = r1c2;
matrix1->row2_col1 = row2_col1;
matrix1->row2_col2 = row2_col2;
matrix1->r2c1 = r2c1;
matrix1->r2c2 = r2c2;
matrix1->row3_col1 = row3_col1;
matrix1->row3_col2 = row3_col2;
matrix1->r3c1 = r3c1;
matrix1->r3c2 = r3c2;
}
inline void bgc_fp64_matrix2x3_swap(BGC_FP64_Matrix2x3* matrix1, BGC_FP64_Matrix2x3* matrix2)
{
const double row1_col1 = matrix2->row1_col1;
const double row1_col2 = matrix2->row1_col2;
const double r1c1 = matrix2->r1c1;
const double r1c2 = matrix2->r1c2;
const double row2_col1 = matrix2->row2_col1;
const double row2_col2 = matrix2->row2_col2;
const double r2c1 = matrix2->r2c1;
const double r2c2 = matrix2->r2c2;
const double row3_col1 = matrix2->row3_col1;
const double row3_col2 = matrix2->row3_col2;
const double r3c1 = matrix2->r3c1;
const double r3c2 = matrix2->r3c2;
matrix2->row1_col1 = matrix1->row1_col1;
matrix2->row1_col2 = matrix1->row1_col2;
matrix2->r1c1 = matrix1->r1c1;
matrix2->r1c2 = matrix1->r1c2;
matrix2->row2_col1 = matrix1->row2_col1;
matrix2->row2_col2 = matrix1->row2_col2;
matrix2->r2c1 = matrix1->r2c1;
matrix2->r2c2 = matrix1->r2c2;
matrix2->row3_col1 = matrix1->row3_col1;
matrix2->row3_col2 = matrix1->row3_col2;
matrix2->r3c1 = matrix1->r3c1;
matrix2->r3c2 = matrix1->r3c2;
matrix1->row1_col1 = row1_col1;
matrix1->row1_col2 = row1_col2;
matrix1->r1c1 = r1c1;
matrix1->r1c2 = r1c2;
matrix1->row2_col1 = row2_col1;
matrix1->row2_col2 = row2_col2;
matrix1->r2c1 = r2c1;
matrix1->r2c2 = r2c2;
matrix1->row3_col1 = row3_col1;
matrix1->row3_col2 = row3_col2;
matrix1->r3c1 = r3c1;
matrix1->r3c2 = r3c2;
}
// ================== Convert =================== //
inline void bgc_fp64_matrix2x3_convert_to_fp32(BGC_FP32_Matrix2x3* destination, const BGC_FP64_Matrix2x3* source)
{
destination->row1_col1 = (float)source->row1_col1;
destination->row1_col2 = (float)source->row1_col2;
destination->r1c1 = (float)source->r1c1;
destination->r1c2 = (float)source->r1c2;
destination->row2_col1 = (float)source->row2_col1;
destination->row2_col2 = (float)source->row2_col2;
destination->r2c1 = (float)source->r2c1;
destination->r2c2 = (float)source->r2c2;
destination->row3_col1 = (float)source->row3_col1;
destination->row3_col2 = (float)source->row3_col2;
destination->r3c1 = (float)source->r3c1;
destination->r3c2 = (float)source->r3c2;
}
inline void bgc_fp32_matrix2x3_convert_to_fp64(BGC_FP64_Matrix2x3* destination, const BGC_FP32_Matrix2x3* source)
{
destination->row1_col1 = source->row1_col1;
destination->row1_col2 = source->row1_col2;
destination->r1c1 = source->r1c1;
destination->r1c2 = source->r1c2;
destination->row2_col1 = source->row2_col1;
destination->row2_col2 = source->row2_col2;
destination->r2c1 = source->r2c1;
destination->r2c2 = source->r2c2;
destination->row3_col1 = source->row3_col1;
destination->row3_col2 = source->row3_col2;
destination->r3c1 = source->r3c1;
destination->r3c2 = source->r3c2;
}
// ================= Transpose ================== //
inline void bgc_fp32_matrix2x3_get_transposed(BGC_FP32_Matrix2x3* transposed, const BGC_FP32_Matrix3x2* matrix)
{
transposed->row1_col1 = matrix->row1_col1;
transposed->row1_col2 = matrix->row2_col1;
transposed->r1c1 = matrix->r1c1;
transposed->r1c2 = matrix->r2c1;
transposed->row2_col1 = matrix->row1_col2;
transposed->row2_col2 = matrix->row2_col2;
transposed->r2c1 = matrix->r1c2;
transposed->r2c2 = matrix->r2c2;
transposed->row3_col1 = matrix->row1_col3;
transposed->row3_col2 = matrix->row2_col3;
transposed->r3c1 = matrix->r1c3;
transposed->r3c2 = matrix->r2c3;
}
inline void bgc_fp64_matrix2x3_get_transposed(BGC_FP64_Matrix2x3* transposed, const BGC_FP64_Matrix3x2* matrix)
{
transposed->row1_col1 = matrix->row1_col1;
transposed->row1_col2 = matrix->row2_col1;
transposed->r1c1 = matrix->r1c1;
transposed->r1c2 = matrix->r2c1;
transposed->row2_col1 = matrix->row1_col2;
transposed->row2_col2 = matrix->row2_col2;
transposed->r2c1 = matrix->r1c2;
transposed->r2c2 = matrix->r2c2;
transposed->row3_col1 = matrix->row1_col3;
transposed->row3_col2 = matrix->row2_col3;
transposed->r3c1 = matrix->r1c3;
transposed->r3c2 = matrix->r2c3;
}
// ================== Get Row =================== //
@ -176,20 +176,20 @@ inline void bgc_fp64_matrix2x3_get_transposed(BGC_FP64_Matrix2x3* transposed, co
inline void bgc_fp32_matrix2x3_get_row(BGC_FP32_Vector2* row, const BGC_FP32_Matrix2x3* matrix, const int row_number)
{
if (row_number == 1) {
row->x1 = matrix->row1_col1;
row->x2 = matrix->row1_col2;
row->x1 = matrix->r1c1;
row->x2 = matrix->r1c2;
return;
}
if (row_number == 2) {
row->x1 = matrix->row2_col1;
row->x2 = matrix->row2_col2;
row->x1 = matrix->r2c1;
row->x2 = matrix->r2c2;
return;
}
if (row_number == 3) {
row->x1 = matrix->row3_col1;
row->x2 = matrix->row3_col2;
row->x1 = matrix->r3c1;
row->x2 = matrix->r3c2;
return;
}
@ -200,20 +200,20 @@ inline void bgc_fp32_matrix2x3_get_row(BGC_FP32_Vector2* row, const BGC_FP32_Mat
inline void bgc_fp64_matrix2x3_get_row(BGC_FP64_Vector2* row, const BGC_FP64_Matrix2x3* matrix, const int row_number)
{
if (row_number == 1) {
row->x1 = matrix->row1_col1;
row->x2 = matrix->row1_col2;
row->x1 = matrix->r1c1;
row->x2 = matrix->r1c2;
return;
}
if (row_number == 2) {
row->x1 = matrix->row2_col1;
row->x2 = matrix->row2_col2;
row->x1 = matrix->r2c1;
row->x2 = matrix->r2c2;
return;
}
if (row_number == 3) {
row->x1 = matrix->row3_col1;
row->x2 = matrix->row3_col2;
row->x1 = matrix->r3c1;
row->x2 = matrix->r3c2;
return;
}
@ -226,40 +226,40 @@ inline void bgc_fp64_matrix2x3_get_row(BGC_FP64_Vector2* row, const BGC_FP64_Mat
inline void bgc_fp32_matrix2x3_set_row(BGC_FP32_Matrix2x3* matrix, const int row_number, const BGC_FP32_Vector2* row)
{
if (row_number == 1) {
matrix->row1_col1 = row->x1;
matrix->row1_col2 = row->x2;
matrix->r1c1 = row->x1;
matrix->r1c2 = row->x2;
return;
}
if (row_number == 2) {
matrix->row2_col1 = row->x1;
matrix->row2_col2 = row->x2;
matrix->r2c1 = row->x1;
matrix->r2c2 = row->x2;
return;
}
if (row_number == 3) {
matrix->row3_col1 = row->x1;
matrix->row3_col2 = row->x2;
matrix->r3c1 = row->x1;
matrix->r3c2 = row->x2;
}
}
inline void bgc_fp64_matrix2x3_set_row(BGC_FP64_Matrix2x3* matrix, const int row_number, const BGC_FP64_Vector2* row)
{
if (row_number == 1) {
matrix->row1_col1 = row->x1;
matrix->row1_col2 = row->x2;
matrix->r1c1 = row->x1;
matrix->r1c2 = row->x2;
return;
}
if (row_number == 2) {
matrix->row2_col1 = row->x1;
matrix->row2_col2 = row->x2;
matrix->r2c1 = row->x1;
matrix->r2c2 = row->x2;
return;
}
if (row_number == 3) {
matrix->row3_col1 = row->x1;
matrix->row3_col2 = row->x2;
matrix->r3c1 = row->x1;
matrix->r3c2 = row->x2;
}
}
@ -268,32 +268,32 @@ inline void bgc_fp64_matrix2x3_set_row(BGC_FP64_Matrix2x3* matrix, const int row
inline void bgc_fp32_matrix2x3_get_column(BGC_FP32_Vector3* column, const BGC_FP32_Matrix2x3* matrix, const int column_number)
{
if (column_number == 1) {
column->x1 = matrix->row1_col1;
column->x2 = matrix->row2_col1;
column->x3 = matrix->row3_col1;
column->x1 = matrix->r1c1;
column->x2 = matrix->r2c1;
column->x3 = matrix->r3c1;
return;
}
if (column_number == 2) {
column->x1 = matrix->row1_col2;
column->x2 = matrix->row2_col2;
column->x3 = matrix->row3_col2;
column->x1 = matrix->r1c2;
column->x2 = matrix->r2c2;
column->x3 = matrix->r3c2;
}
}
inline void bgc_fp64_matrix2x3_get_column(BGC_FP64_Vector3* column, const BGC_FP64_Matrix2x3* matrix, const int column_number)
{
if (column_number == 1) {
column->x1 = matrix->row1_col1;
column->x2 = matrix->row2_col1;
column->x3 = matrix->row3_col1;
column->x1 = matrix->r1c1;
column->x2 = matrix->r2c1;
column->x3 = matrix->r3c1;
return;
}
if (column_number == 2) {
column->x1 = matrix->row1_col2;
column->x2 = matrix->row2_col2;
column->x3 = matrix->row3_col2;
column->x1 = matrix->r1c2;
column->x2 = matrix->r2c2;
column->x3 = matrix->r3c2;
}
}
@ -302,32 +302,32 @@ inline void bgc_fp64_matrix2x3_get_column(BGC_FP64_Vector3* column, const BGC_FP
inline void bgc_fp32_matrix2x3_set_column(BGC_FP32_Matrix2x3* matrix, const int column_number, const BGC_FP32_Vector3* column)
{
if (column_number == 1) {
matrix->row1_col1 = column->x1;
matrix->row2_col1 = column->x2;
matrix->row3_col1 = column->x3;
matrix->r1c1 = column->x1;
matrix->r2c1 = column->x2;
matrix->r3c1 = column->x3;
return;
}
if (column_number == 2) {
matrix->row1_col2 = column->x1;
matrix->row2_col2 = column->x2;
matrix->row3_col2 = column->x3;
matrix->r1c2 = column->x1;
matrix->r2c2 = column->x2;
matrix->r3c2 = column->x3;
}
}
inline void bgc_fp64_matrix2x3_set_column(BGC_FP64_Matrix2x3* matrix, const int column_number, const BGC_FP64_Vector3* column)
{
if (column_number == 1) {
matrix->row1_col1 = column->x1;
matrix->row2_col1 = column->x2;
matrix->row3_col1 = column->x3;
matrix->r1c1 = column->x1;
matrix->r2c1 = column->x2;
matrix->r3c1 = column->x3;
return;
}
if (column_number == 2) {
matrix->row1_col2 = column->x1;
matrix->row2_col2 = column->x2;
matrix->row3_col2 = column->x3;
matrix->r1c2 = column->x1;
matrix->r2c2 = column->x2;
matrix->r3c2 = column->x3;
}
}
@ -335,104 +335,104 @@ inline void bgc_fp64_matrix2x3_set_column(BGC_FP64_Matrix2x3* matrix, const int
inline void bgc_fp32_matrix2x3_add(BGC_FP32_Matrix2x3* sum, const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix2x3* matrix2)
{
sum->row1_col1 = matrix1->row1_col1 + matrix2->row1_col1;
sum->row1_col2 = matrix1->row1_col2 + matrix2->row1_col2;
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
sum->row2_col1 = matrix1->row2_col1 + matrix2->row2_col1;
sum->row2_col2 = matrix1->row2_col2 + matrix2->row2_col2;
sum->r2c1 = matrix1->r2c1 + matrix2->r2c1;
sum->r2c2 = matrix1->r2c2 + matrix2->r2c2;
sum->row3_col1 = matrix1->row3_col1 + matrix2->row3_col1;
sum->row3_col2 = matrix1->row3_col2 + matrix2->row3_col2;
sum->r3c1 = matrix1->r3c1 + matrix2->r3c1;
sum->r3c2 = matrix1->r3c2 + matrix2->r3c2;
}
inline void bgc_fp64_matrix2x3_add(BGC_FP64_Matrix2x3* sum, const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix2x3* matrix2)
{
sum->row1_col1 = matrix1->row1_col1 + matrix2->row1_col1;
sum->row1_col2 = matrix1->row1_col2 + matrix2->row1_col2;
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
sum->row2_col1 = matrix1->row2_col1 + matrix2->row2_col1;
sum->row2_col2 = matrix1->row2_col2 + matrix2->row2_col2;
sum->r2c1 = matrix1->r2c1 + matrix2->r2c1;
sum->r2c2 = matrix1->r2c2 + matrix2->r2c2;
sum->row3_col1 = matrix1->row3_col1 + matrix2->row3_col1;
sum->row3_col2 = matrix1->row3_col2 + matrix2->row3_col2;
sum->r3c1 = matrix1->r3c1 + matrix2->r3c1;
sum->r3c2 = matrix1->r3c2 + matrix2->r3c2;
}
// ================= Add scaled ================= //
inline void bgc_fp32_matrix2x3_add_scaled(BGC_FP32_Matrix2x3* sum, const BGC_FP32_Matrix2x3* basic_matrix, const BGC_FP32_Matrix2x3* scalable_matrix, const float scale)
{
sum->row1_col1 = basic_matrix->row1_col1 + scalable_matrix->row1_col1 * scale;
sum->row1_col2 = basic_matrix->row1_col2 + scalable_matrix->row1_col2 * scale;
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
sum->row2_col1 = basic_matrix->row2_col1 + scalable_matrix->row2_col1 * scale;
sum->row2_col2 = basic_matrix->row2_col2 + scalable_matrix->row2_col2 * scale;
sum->r2c1 = basic_matrix->r2c1 + scalable_matrix->r2c1 * scale;
sum->r2c2 = basic_matrix->r2c2 + scalable_matrix->r2c2 * scale;
sum->row3_col1 = basic_matrix->row3_col1 + scalable_matrix->row3_col1 * scale;
sum->row3_col2 = basic_matrix->row3_col2 + scalable_matrix->row3_col2 * scale;
sum->r3c1 = basic_matrix->r3c1 + scalable_matrix->r3c1 * scale;
sum->r3c2 = basic_matrix->r3c2 + scalable_matrix->r3c2 * scale;
}
inline void bgc_fp64_matrix2x3_add_scaled(BGC_FP64_Matrix2x3* sum, const BGC_FP64_Matrix2x3* basic_matrix, const BGC_FP64_Matrix2x3* scalable_matrix, const double scale)
{
sum->row1_col1 = basic_matrix->row1_col1 + scalable_matrix->row1_col1 * scale;
sum->row1_col2 = basic_matrix->row1_col2 + scalable_matrix->row1_col2 * scale;
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
sum->row2_col1 = basic_matrix->row2_col1 + scalable_matrix->row2_col1 * scale;
sum->row2_col2 = basic_matrix->row2_col2 + scalable_matrix->row2_col2 * scale;
sum->r2c1 = basic_matrix->r2c1 + scalable_matrix->r2c1 * scale;
sum->r2c2 = basic_matrix->r2c2 + scalable_matrix->r2c2 * scale;
sum->row3_col1 = basic_matrix->row3_col1 + scalable_matrix->row3_col1 * scale;
sum->row3_col2 = basic_matrix->row3_col2 + scalable_matrix->row3_col2 * scale;
sum->r3c1 = basic_matrix->r3c1 + scalable_matrix->r3c1 * scale;
sum->r3c2 = basic_matrix->r3c2 + scalable_matrix->r3c2 * scale;
}
// ================== Subtract ================== //
inline void bgc_fp32_matrix2x3_subtract(BGC_FP32_Matrix2x3* difference, const BGC_FP32_Matrix2x3* minuend, const BGC_FP32_Matrix2x3* subtrahend)
{
difference->row1_col1 = minuend->row1_col1 - subtrahend->row1_col1;
difference->row1_col2 = minuend->row1_col2 - subtrahend->row1_col2;
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
difference->row2_col1 = minuend->row2_col1 - subtrahend->row2_col1;
difference->row2_col2 = minuend->row2_col2 - subtrahend->row2_col2;
difference->r2c1 = minuend->r2c1 - subtrahend->r2c1;
difference->r2c2 = minuend->r2c2 - subtrahend->r2c2;
difference->row3_col1 = minuend->row3_col1 - subtrahend->row3_col1;
difference->row3_col2 = minuend->row3_col2 - subtrahend->row3_col2;
difference->r3c1 = minuend->r3c1 - subtrahend->r3c1;
difference->r3c2 = minuend->r3c2 - subtrahend->r3c2;
}
inline void bgc_fp64_matrix2x3_subtract(BGC_FP64_Matrix2x3* difference, const BGC_FP64_Matrix2x3* minuend, const BGC_FP64_Matrix2x3* subtrahend)
{
difference->row1_col1 = minuend->row1_col1 - subtrahend->row1_col1;
difference->row1_col2 = minuend->row1_col2 - subtrahend->row1_col2;
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
difference->row2_col1 = minuend->row2_col1 - subtrahend->row2_col1;
difference->row2_col2 = minuend->row2_col2 - subtrahend->row2_col2;
difference->r2c1 = minuend->r2c1 - subtrahend->r2c1;
difference->r2c2 = minuend->r2c2 - subtrahend->r2c2;
difference->row3_col1 = minuend->row3_col1 - subtrahend->row3_col1;
difference->row3_col2 = minuend->row3_col2 - subtrahend->row3_col2;
difference->r3c1 = minuend->r3c1 - subtrahend->r3c1;
difference->r3c2 = minuend->r3c2 - subtrahend->r3c2;
}
// ================== Multiply ================== //
inline void bgc_fp32_matrix2x3_multiply(BGC_FP32_Matrix2x3* product, const BGC_FP32_Matrix2x3* multiplicand, const float multiplier)
{
product->row1_col1 = multiplicand->row1_col1 * multiplier;
product->row1_col2 = multiplicand->row1_col2 * multiplier;
product->r1c1 = multiplicand->r1c1 * multiplier;
product->r1c2 = multiplicand->r1c2 * multiplier;
product->row2_col1 = multiplicand->row2_col1 * multiplier;
product->row2_col2 = multiplicand->row2_col2 * multiplier;
product->r2c1 = multiplicand->r2c1 * multiplier;
product->r2c2 = multiplicand->r2c2 * multiplier;
product->row3_col1 = multiplicand->row3_col1 * multiplier;
product->row3_col2 = multiplicand->row3_col2 * multiplier;
product->r3c1 = multiplicand->r3c1 * multiplier;
product->r3c2 = multiplicand->r3c2 * multiplier;
}
inline void bgc_fp64_matrix2x3_multiply(BGC_FP64_Matrix2x3* product, const BGC_FP64_Matrix2x3* multiplicand, const double multiplier)
{
product->row1_col1 = multiplicand->row1_col1 * multiplier;
product->row1_col2 = multiplicand->row1_col2 * multiplier;
product->r1c1 = multiplicand->r1c1 * multiplier;
product->r1c2 = multiplicand->r1c2 * multiplier;
product->row2_col1 = multiplicand->row2_col1 * multiplier;
product->row2_col2 = multiplicand->row2_col2 * multiplier;
product->r2c1 = multiplicand->r2c1 * multiplier;
product->r2c2 = multiplicand->r2c2 * multiplier;
product->row3_col1 = multiplicand->row3_col1 * multiplier;
product->row3_col2 = multiplicand->row3_col2 * multiplier;
product->r3c1 = multiplicand->r3c1 * multiplier;
product->r3c2 = multiplicand->r3c2 * multiplier;
}
// =================== Divide =================== //
@ -453,58 +453,58 @@ inline void bgc_fp32_matrix2x3_interpolate(BGC_FP32_Matrix2x3* interpolation, co
{
const float couter_phase = 1.0f - phase;
interpolation->row1_col1 = first->row1_col1 * couter_phase + second->row1_col1 * phase;
interpolation->row1_col2 = first->row1_col2 * couter_phase + second->row1_col2 * phase;
interpolation->r1c1 = first->r1c1 * couter_phase + second->r1c1 * phase;
interpolation->r1c2 = first->r1c2 * couter_phase + second->r1c2 * phase;
interpolation->row2_col1 = first->row2_col1 * couter_phase + second->row2_col1 * phase;
interpolation->row2_col2 = first->row2_col2 * couter_phase + second->row2_col2 * phase;
interpolation->r2c1 = first->r2c1 * couter_phase + second->r2c1 * phase;
interpolation->r2c2 = first->r2c2 * couter_phase + second->r2c2 * phase;
interpolation->row3_col1 = first->row3_col1 * couter_phase + second->row3_col1 * phase;
interpolation->row3_col2 = first->row3_col2 * couter_phase + second->row3_col2 * phase;
interpolation->r3c1 = first->r3c1 * couter_phase + second->r3c1 * phase;
interpolation->r3c2 = first->r3c2 * couter_phase + second->r3c2 * phase;
}
inline void bgc_fp64_matrix2x3_interpolate(BGC_FP64_Matrix2x3* interpolation, const BGC_FP64_Matrix2x3* first, const BGC_FP64_Matrix2x3* second, const double phase)
{
const double couter_phase = 1.0 - phase;
interpolation->row1_col1 = first->row1_col1 * couter_phase + second->row1_col1 * phase;
interpolation->row1_col2 = first->row1_col2 * couter_phase + second->row1_col2 * phase;
interpolation->r1c1 = first->r1c1 * couter_phase + second->r1c1 * phase;
interpolation->r1c2 = first->r1c2 * couter_phase + second->r1c2 * phase;
interpolation->row2_col1 = first->row2_col1 * couter_phase + second->row2_col1 * phase;
interpolation->row2_col2 = first->row2_col2 * couter_phase + second->row2_col2 * phase;
interpolation->r2c1 = first->r2c1 * couter_phase + second->r2c1 * phase;
interpolation->r2c2 = first->r2c2 * couter_phase + second->r2c2 * phase;
interpolation->row3_col1 = first->row3_col1 * couter_phase + second->row3_col1 * phase;
interpolation->row3_col2 = first->row3_col2 * couter_phase + second->row3_col2 * phase;
interpolation->r3c1 = first->r3c1 * couter_phase + second->r3c1 * phase;
interpolation->r3c2 = first->r3c2 * couter_phase + second->r3c2 * phase;
}
// ============ Left Vector Product ============= //
inline void bgc_fp32_multiply_vector3_by_matrix2x3(BGC_FP32_Vector2* product, const BGC_FP32_Vector3* vector, const BGC_FP32_Matrix2x3* matrix)
{
product->x1 = vector->x1 * matrix->row1_col1 + vector->x2 * matrix->row2_col1 + vector->x3 * matrix->row3_col1;
product->x2 = vector->x1 * matrix->row1_col2 + vector->x2 * matrix->row2_col2 + vector->x3 * matrix->row3_col2;
product->x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1 + vector->x3 * matrix->r3c1;
product->x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2 + vector->x3 * matrix->r3c2;
}
inline void bgc_fp64_multiply_vector3_by_matrix2x3(BGC_FP64_Vector2* product, const BGC_FP64_Vector3* vector, const BGC_FP64_Matrix2x3* matrix)
{
product->x1 = vector->x1 * matrix->row1_col1 + vector->x2 * matrix->row2_col1 + vector->x3 * matrix->row3_col1;
product->x2 = vector->x1 * matrix->row1_col2 + vector->x2 * matrix->row2_col2 + vector->x3 * matrix->row3_col2;
product->x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1 + vector->x3 * matrix->r3c1;
product->x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2 + vector->x3 * matrix->r3c2;
}
// ============ Right Vector Product ============ //
inline void bgc_fp32_multiply_matrix2x3_by_vector2(BGC_FP32_Vector3* product, const BGC_FP32_Matrix2x3* matrix, const BGC_FP32_Vector2* vector)
{
product->x1 = matrix->row1_col1 * vector->x1 + matrix->row1_col2 * vector->x2;
product->x2 = matrix->row2_col1 * vector->x1 + matrix->row2_col2 * vector->x2;
product->x3 = matrix->row3_col1 * vector->x1 + matrix->row3_col2 * vector->x2;
product->x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
product->x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
product->x3 = matrix->r3c1 * vector->x1 + matrix->r3c2 * vector->x2;
}
inline void bgc_fp64_multiply_matrix2x3_by_vector2(BGC_FP64_Vector3* product, const BGC_FP64_Matrix2x3* matrix, const BGC_FP64_Vector2* vector)
{
product->x1 = matrix->row1_col1 * vector->x1 + matrix->row1_col2 * vector->x2;
product->x2 = matrix->row2_col1 * vector->x1 + matrix->row2_col2 * vector->x2;
product->x3 = matrix->row3_col1 * vector->x1 + matrix->row3_col2 * vector->x2;
product->x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
product->x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
product->x3 = matrix->r3c1 * vector->x1 + matrix->r3c2 * vector->x2;
}
#endif