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

396
basic-geometry/matrix2x2.h
View file

@ -9,54 +9,54 @@
inline void bgc_fp32_matrix2x2_reset(BGC_FP32_Matrix2x2* matrix)
{
matrix->row1_col1 = 0.0f;
matrix->row1_col2 = 0.0f;
matrix->row2_col1 = 0.0f;
matrix->row2_col2 = 0.0f;
matrix->r1c1 = 0.0f;
matrix->r1c2 = 0.0f;
matrix->r2c1 = 0.0f;
matrix->r2c2 = 0.0f;
}
inline void bgc_fp64_matrix2x2_reset(BGC_FP64_Matrix2x2* matrix)
{
matrix->row1_col1 = 0.0;
matrix->row1_col2 = 0.0;
matrix->row2_col1 = 0.0;
matrix->row2_col2 = 0.0;
matrix->r1c1 = 0.0;
matrix->r1c2 = 0.0;
matrix->r2c1 = 0.0;
matrix->r2c2 = 0.0;
}
// ================== Identity ================== //
inline void bgc_fp32_matrix2x2_make_identity(BGC_FP32_Matrix2x2* matrix)
{
matrix->row1_col1 = 1.0f;
matrix->row1_col2 = 0.0f;
matrix->row2_col1 = 0.0f;
matrix->row2_col2 = 1.0f;
matrix->r1c1 = 1.0f;
matrix->r1c2 = 0.0f;
matrix->r2c1 = 0.0f;
matrix->r2c2 = 1.0f;
}
inline void bgc_fp64_matrix2x2_make_identity(BGC_FP64_Matrix2x2* matrix)
{
matrix->row1_col1 = 1.0;
matrix->row1_col2 = 0.0;
matrix->row2_col1 = 0.0;
matrix->row2_col2 = 1.0;
matrix->r1c1 = 1.0;
matrix->r1c2 = 0.0;
matrix->r2c1 = 0.0;
matrix->r2c2 = 1.0;
}
// ================ Set Diagonal ================ //
inline void bgc_fp32_matrix2x2_make_diagonal(BGC_FP32_Matrix2x2* matrix, const float d1, const float d2)
{
matrix->row1_col1 = d1;
matrix->row1_col2 = 0.0f;
matrix->row2_col1 = 0.0f;
matrix->row2_col2 = d2;
matrix->r1c1 = d1;
matrix->r1c2 = 0.0f;
matrix->r2c1 = 0.0f;
matrix->r2c2 = d2;
}
inline void bgc_fp64_matrix2x2_make_diagonal(BGC_FP64_Matrix2x2* matrix, const double d1, const double d2)
{
matrix->row1_col1 = d1;
matrix->row1_col2 = 0.0;
matrix->row2_col1 = 0.0;
matrix->row2_col2 = d2;
matrix->r1c1 = d1;
matrix->r1c2 = 0.0;
matrix->r2c1 = 0.0;
matrix->r2c2 = d2;
}
// ============== Rotation Matrix =============== //
@ -67,10 +67,10 @@ inline void bgc_fp32_matrix2x2_make_for_turn(BGC_FP32_Matrix2x2* matrix, const f
const float cosine = cosf(radians);
const float sine = sinf(radians);
matrix->row1_col1 = cosine;
matrix->row1_col2 = -sine;
matrix->row2_col1 = sine;
matrix->row2_col2 = cosine;
matrix->r1c1 = cosine;
matrix->r1c2 = -sine;
matrix->r2c1 = sine;
matrix->r2c2 = cosine;
}
inline void bgc_fp64_matrix2x2_make_for_turn(BGC_FP64_Matrix2x2* matrix, const double angle, const int angle_unit)
@ -79,36 +79,36 @@ inline void bgc_fp64_matrix2x2_make_for_turn(BGC_FP64_Matrix2x2* matrix, const d
const double cosine = cos(radians);
const double sine = sin(radians);
matrix->row1_col1 = cosine;
matrix->row1_col2 = -sine;
matrix->row2_col1 = sine;
matrix->row2_col2 = cosine;
matrix->r1c1 = cosine;
matrix->r1c2 = -sine;
matrix->r2c1 = sine;
matrix->r2c2 = cosine;
}
// ================ Determinant ================= //
inline float bgc_fp32_matrix2x2_get_determinant(const BGC_FP32_Matrix2x2* matrix)
{
return matrix->row1_col1 * matrix->row2_col2 - matrix->row1_col2 * matrix->row2_col1;
return matrix->r1c1 * matrix->r2c2 - matrix->r1c2 * matrix->r2c1;
}
inline double bgc_fp64_matrix2x2_get_determinant(const BGC_FP64_Matrix2x2* matrix)
{
return matrix->row1_col1 * matrix->row2_col2 - matrix->row1_col2 * matrix->row2_col1;
return matrix->r1c1 * matrix->r2c2 - matrix->r1c2 * matrix->r2c1;
}
// ================ Is Identity ================= //
inline int bgc_fp32_matrix2x2_is_identity(const BGC_FP32_Matrix2x2* matrix)
{
return bgc_fp32_is_unit(matrix->row1_col1) && bgc_fp32_is_zero(matrix->row1_col2)
&& bgc_fp32_is_zero(matrix->row2_col1) && bgc_fp32_is_unit(matrix->row2_col2);
return bgc_fp32_is_unit(matrix->r1c1) && bgc_fp32_is_zero(matrix->r1c2)
&& bgc_fp32_is_zero(matrix->r2c1) && bgc_fp32_is_unit(matrix->r2c2);
}
inline int bgc_fp64_matrix2x2_is_identity(const BGC_FP64_Matrix2x2* matrix)
{
return bgc_fp64_is_unit(matrix->row1_col1) && bgc_fp64_is_zero(matrix->row1_col2)
&& bgc_fp64_is_zero(matrix->row2_col1) && bgc_fp64_is_unit(matrix->row2_col2);
return bgc_fp64_is_unit(matrix->r1c1) && bgc_fp64_is_zero(matrix->r1c2)
&& bgc_fp64_is_zero(matrix->r2c1) && bgc_fp64_is_unit(matrix->r2c2);
}
// ================ Is Singular ================= //
@ -129,11 +129,11 @@ inline int bgc_fp32_matrix2x2_is_rotation(const BGC_FP32_Matrix2x2* matrix)
{
BGC_FP32_Matrix2x2 product;
product.row1_col1 = matrix->row1_col1 * matrix->row1_col1 + matrix->row1_col2 * matrix->row2_col1;
product.row1_col2 = matrix->row1_col1 * matrix->row1_col2 + matrix->row1_col2 * matrix->row2_col2;
product.r1c1 = matrix->r1c1 * matrix->r1c1 + matrix->r1c2 * matrix->r2c1;
product.r1c2 = matrix->r1c1 * matrix->r1c2 + matrix->r1c2 * matrix->r2c2;
product.row2_col1 = matrix->row2_col1 * matrix->row1_col1 + matrix->row2_col2 * matrix->row2_col1;
product.row2_col2 = matrix->row2_col1 * matrix->row1_col2 + matrix->row2_col2 * matrix->row2_col2;
product.r2c1 = matrix->r2c1 * matrix->r1c1 + matrix->r2c2 * matrix->r2c1;
product.r2c2 = matrix->r2c1 * matrix->r1c2 + matrix->r2c2 * matrix->r2c2;
return bgc_fp32_matrix2x2_is_identity(&product);
}
@ -142,11 +142,11 @@ inline int bgc_fp64_matrix2x2_is_rotation(const BGC_FP64_Matrix2x2* matrix)
{
BGC_FP64_Matrix2x2 product;
product.row1_col1 = matrix->row1_col1 * matrix->row1_col1 + matrix->row1_col2 * matrix->row2_col1;
product.row1_col2 = matrix->row1_col1 * matrix->row1_col2 + matrix->row1_col2 * matrix->row2_col2;
product.r1c1 = matrix->r1c1 * matrix->r1c1 + matrix->r1c2 * matrix->r2c1;
product.r1c2 = matrix->r1c1 * matrix->r1c2 + matrix->r1c2 * matrix->r2c2;
product.row2_col1 = matrix->row2_col1 * matrix->row1_col1 + matrix->row2_col2 * matrix->row2_col1;
product.row2_col2 = matrix->row2_col1 * matrix->row1_col2 + matrix->row2_col2 * matrix->row2_col2;
product.r2c1 = matrix->r2c1 * matrix->r1c1 + matrix->r2c2 * matrix->r2c1;
product.r2c2 = matrix->r2c1 * matrix->r1c2 + matrix->r2c2 * matrix->r2c2;
return bgc_fp64_matrix2x2_is_identity(&product);
}
@ -155,84 +155,84 @@ inline int bgc_fp64_matrix2x2_is_rotation(const BGC_FP64_Matrix2x2* matrix)
inline void bgc_fp32_matrix2x2_copy(BGC_FP32_Matrix2x2* destination, const BGC_FP32_Matrix2x2* 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;
}
inline void bgc_fp64_matrix2x2_copy(BGC_FP64_Matrix2x2* destination, const BGC_FP64_Matrix2x2* 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;
}
// ==================== Swap ==================== //
inline void bgc_fp32_matrix2x2_swap(BGC_FP32_Matrix2x2* matrix1, BGC_FP32_Matrix2x2* 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;
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;
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;
}
inline void bgc_fp64_matrix2x2_swap(BGC_FP64_Matrix2x2* matrix1, BGC_FP64_Matrix2x2* 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;
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;
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;
}
// ================== Convert =================== //
inline void bgc_fp64_matrix2x2_convert_to_fp32(BGC_FP32_Matrix2x2* destination, const BGC_FP64_Matrix2x2* 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;
}
inline void bgc_fp32_matrix2x2_convert_to_fp64(BGC_FP64_Matrix2x2* destination, const BGC_FP32_Matrix2x2* 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;
}
// ================ Get Inverse ================= //
@ -245,19 +245,19 @@ inline int bgc_fp32_matrix2x2_get_inverse(BGC_FP32_Matrix2x2* inverse, const BGC
return 0;
}
const float row1_col1 = matrix->row2_col2;
const float row1_col2 = -matrix->row1_col2;
const float r1c1 = matrix->r2c2;
const float r1c2 = -matrix->r1c2;
const float row2_col1 = -matrix->row2_col1;
const float row2_col2 = matrix->row1_col1;
const float r2c1 = -matrix->r2c1;
const float r2c2 = matrix->r1c1;
const float multiplier = 1.0f / determinant;
inverse->row1_col1 = row1_col1 * multiplier;
inverse->row1_col2 = row1_col2 * multiplier;
inverse->r1c1 = r1c1 * multiplier;
inverse->r1c2 = r1c2 * multiplier;
inverse->row2_col1 = row2_col1 * multiplier;
inverse->row2_col2 = row2_col2 * multiplier;
inverse->r2c1 = r2c1 * multiplier;
inverse->r2c2 = r2c2 * multiplier;
return 1;
}
@ -270,19 +270,19 @@ inline int bgc_fp64_matrix2x2_get_inverse(BGC_FP64_Matrix2x2* inverse, const BGC
return 0;
}
const double row1_col1 = matrix->row2_col2;
const double row1_col2 = -matrix->row1_col2;
const double r1c1 = matrix->r2c2;
const double r1c2 = -matrix->r1c2;
const double row2_col1 = -matrix->row2_col1;
const double row2_col2 = matrix->row1_col1;
const double r2c1 = -matrix->r2c1;
const double r2c2 = matrix->r1c1;
const double multiplier = 1.0 / determinant;
inverse->row1_col1 = row1_col1 * multiplier;
inverse->row1_col2 = row1_col2 * multiplier;
inverse->r1c1 = r1c1 * multiplier;
inverse->r1c2 = r1c2 * multiplier;
inverse->row2_col1 = row2_col1 * multiplier;
inverse->row2_col2 = row2_col2 * multiplier;
inverse->r2c1 = r2c1 * multiplier;
inverse->r2c2 = r2c2 * multiplier;
return 1;
}
@ -303,40 +303,40 @@ inline int bgc_fp64_matrix2x2_invert(BGC_FP64_Matrix2x2* matrix)
inline void bgc_fp32_matrix2x2_transpose(BGC_FP32_Matrix2x2* matrix)
{
const float row1_col2 = matrix->row1_col2;
matrix->row1_col2 = matrix->row2_col1;
matrix->row2_col1 = row1_col2;
const float r1c2 = matrix->r1c2;
matrix->r1c2 = matrix->r2c1;
matrix->r2c1 = r1c2;
}
inline void bgc_fp64_matrix2x2_transpose(BGC_FP64_Matrix2x2* matrix)
{
const double row1_col2 = matrix->row1_col2;
matrix->row1_col2 = matrix->row2_col1;
matrix->row2_col1 = row1_col2;
const double r1c2 = matrix->r1c2;
matrix->r1c2 = matrix->r2c1;
matrix->r2c1 = r1c2;
}
// =============== Get Transpose ================ //
inline void bgc_fp32_matrix2x2_get_transposed(BGC_FP32_Matrix2x2* transposed, const BGC_FP32_Matrix2x2* matrix)
{
const float row1_col2 = matrix->row1_col2;
const float r1c2 = matrix->r1c2;
transposed->row1_col1 = matrix->row1_col1;
transposed->row1_col2 = matrix->row2_col1;
transposed->r1c1 = matrix->r1c1;
transposed->r1c2 = matrix->r2c1;
transposed->row2_col1 = row1_col2;
transposed->row2_col2 = matrix->row2_col2;
transposed->r2c1 = r1c2;
transposed->r2c2 = matrix->r2c2;
}
inline void bgc_fp64_matrix2x2_get_transposed(BGC_FP64_Matrix2x2* transposed, const BGC_FP64_Matrix2x2* matrix)
{
const double row1_col2 = matrix->row1_col2;
const double r1c2 = matrix->r1c2;
transposed->row1_col1 = matrix->row1_col1;
transposed->row1_col2 = matrix->row2_col1;
transposed->r1c1 = matrix->r1c1;
transposed->r1c2 = matrix->r2c1;
transposed->row2_col1 = row1_col2;
transposed->row2_col2 = matrix->row2_col2;
transposed->r2c1 = r1c2;
transposed->r2c2 = matrix->r2c2;
}
// ================== Get Row =================== //
@ -344,14 +344,14 @@ inline void bgc_fp64_matrix2x2_get_transposed(BGC_FP64_Matrix2x2* transposed, co
inline void bgc_fp32_matrix2x2_get_row(BGC_FP32_Vector2* row, const BGC_FP32_Matrix2x2* 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;
}
@ -362,14 +362,14 @@ inline void bgc_fp32_matrix2x2_get_row(BGC_FP32_Vector2* row, const BGC_FP32_Mat
inline void bgc_fp64_matrix2x2_get_row(BGC_FP64_Vector2* row, const BGC_FP64_Matrix2x2* 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;
}
@ -382,28 +382,28 @@ inline void bgc_fp64_matrix2x2_get_row(BGC_FP64_Vector2* row, const BGC_FP64_Mat
inline void bgc_fp32_matrix2x2_set_row(BGC_FP32_Matrix2x2* 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;
}
}
inline void bgc_fp64_matrix2x2_set_row(BGC_FP64_Matrix2x2* 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;
}
}
@ -412,14 +412,14 @@ inline void bgc_fp64_matrix2x2_set_row(BGC_FP64_Matrix2x2* matrix, const int row
inline void bgc_fp32_matrix2x2_get_column(BGC_FP32_Vector2* column, const BGC_FP32_Matrix2x2* matrix, const int column_number)
{
if (column_number == 1) {
column->x1 = matrix->row1_col1;
column->x2 = matrix->row2_col1;
column->x1 = matrix->r1c1;
column->x2 = matrix->r2c1;
return;
}
if (column_number == 2) {
column->x1 = matrix->row1_col2;
column->x2 = matrix->row2_col2;
column->x1 = matrix->r1c2;
column->x2 = matrix->r2c2;
return;
}
@ -430,14 +430,14 @@ inline void bgc_fp32_matrix2x2_get_column(BGC_FP32_Vector2* column, const BGC_FP
inline void bgc_fp64_matrix2x2_get_column(BGC_FP64_Vector2* column, const BGC_FP64_Matrix2x2* matrix, const int column_number)
{
if (column_number == 1) {
column->x1 = matrix->row1_col1;
column->x2 = matrix->row2_col1;
column->x1 = matrix->r1c1;
column->x2 = matrix->r2c1;
return;
}
if (column_number == 2) {
column->x1 = matrix->row1_col2;
column->x2 = matrix->row2_col2;
column->x1 = matrix->r1c2;
column->x2 = matrix->r2c2;
return;
}
@ -450,28 +450,28 @@ inline void bgc_fp64_matrix2x2_get_column(BGC_FP64_Vector2* column, const BGC_FP
inline void bgc_fp32_matrix2x2_set_column(BGC_FP32_Matrix2x2* matrix, const int column_number, const BGC_FP32_Vector2* column)
{
if (column_number == 1) {
matrix->row1_col1 = column->x1;
matrix->row2_col1 = column->x2;
matrix->r1c1 = column->x1;
matrix->r2c1 = column->x2;
return;
}
if (column_number == 2) {
matrix->row1_col2 = column->x1;
matrix->row2_col2 = column->x2;
matrix->r1c2 = column->x1;
matrix->r2c2 = column->x2;
}
}
inline void bgc_fp64_matrix2x2_set_column(BGC_FP64_Matrix2x2* matrix, const int column_number, const BGC_FP64_Vector2* column)
{
if (column_number == 1) {
matrix->row1_col1 = column->x1;
matrix->row2_col1 = column->x2;
matrix->r1c1 = column->x1;
matrix->r2c1 = column->x2;
return;
}
if (column_number == 2) {
matrix->row1_col2 = column->x1;
matrix->row2_col2 = column->x2;
matrix->r1c2 = column->x1;
matrix->r2c2 = column->x2;
}
}
@ -479,80 +479,80 @@ inline void bgc_fp64_matrix2x2_set_column(BGC_FP64_Matrix2x2* matrix, const int
inline void bgc_fp32_matrix2x2_add(BGC_FP32_Matrix2x2* sum, const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix2x2* 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;
}
inline void bgc_fp64_matrix2x2_add(BGC_FP64_Matrix2x2* sum, const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix2x2* 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;
}
// ================= Add scaled ================= //
inline void bgc_fp32_matrix2x2_add_scaled(BGC_FP32_Matrix2x2* sum, const BGC_FP32_Matrix2x2* basic_matrix, const BGC_FP32_Matrix2x2* 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;
}
inline void bgc_fp64_matrix2x2_add_scaled(BGC_FP64_Matrix2x2* sum, const BGC_FP64_Matrix2x2* basic_matrix, const BGC_FP64_Matrix2x2* 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;
}
// ================== Subtract ================== //
inline void bgc_fp32_matrix2x2_subtract(BGC_FP32_Matrix2x2* difference, const BGC_FP32_Matrix2x2* minuend, const BGC_FP32_Matrix2x2* 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;
}
inline void bgc_fp64_matrix2x2_subtract(BGC_FP64_Matrix2x2* difference, const BGC_FP64_Matrix2x2* minuend, const BGC_FP64_Matrix2x2* 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;
}
// ================== Multiply ================== //
inline void bgc_fp32_matrix2x2_multiply(BGC_FP32_Matrix2x2* product, const BGC_FP32_Matrix2x2* 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;
}
inline void bgc_fp64_matrix2x2_multiply(BGC_FP64_Matrix2x2* product, const BGC_FP64_Matrix2x2* 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;
}
// =================== Divide =================== //
@ -573,30 +573,30 @@ inline void bgc_fp32_matrix2x2_interpolate(BGC_FP32_Matrix2x2* interpolation, co
{
const float counter_phase = 1.0f - phase;
interpolation->row1_col1 = first->row1_col1 * counter_phase + second->row1_col1 * phase;
interpolation->row1_col2 = first->row1_col2 * counter_phase + second->row1_col2 * phase;
interpolation->r1c1 = first->r1c1 * counter_phase + second->r1c1 * phase;
interpolation->r1c2 = first->r1c2 * counter_phase + second->r1c2 * phase;
interpolation->row2_col1 = first->row2_col1 * counter_phase + second->row2_col1 * phase;
interpolation->row2_col2 = first->row2_col2 * counter_phase + second->row2_col2 * phase;
interpolation->r2c1 = first->r2c1 * counter_phase + second->r2c1 * phase;
interpolation->r2c2 = first->r2c2 * counter_phase + second->r2c2 * phase;
}
inline void bgc_fp64_matrix2x2_interpolate(BGC_FP64_Matrix2x2* interpolation, const BGC_FP64_Matrix2x2* first, const BGC_FP64_Matrix2x2* second, const double phase)
{
const double counter_phase = 1.0 - phase;
interpolation->row1_col1 = first->row1_col1 * counter_phase + second->row1_col1 * phase;
interpolation->row1_col2 = first->row1_col2 * counter_phase + second->row1_col2 * phase;
interpolation->r1c1 = first->r1c1 * counter_phase + second->r1c1 * phase;
interpolation->r1c2 = first->r1c2 * counter_phase + second->r1c2 * phase;
interpolation->row2_col1 = first->row2_col1 * counter_phase + second->row2_col1 * phase;
interpolation->row2_col2 = first->row2_col2 * counter_phase + second->row2_col2 * phase;
interpolation->r2c1 = first->r2c1 * counter_phase + second->r2c1 * phase;
interpolation->r2c2 = first->r2c2 * counter_phase + second->r2c2 * phase;
}
// ============ Right Vector Product ============ //
inline void bgc_fp32_multiply_matrix2x2_by_vector2(BGC_FP32_Vector2* product, const BGC_FP32_Matrix2x2* matrix, const BGC_FP32_Vector2* vector)
{
const float x1 = matrix->row1_col1 * vector->x1 + matrix->row1_col2 * vector->x2;
const float x2 = matrix->row2_col1 * vector->x1 + matrix->row2_col2 * vector->x2;
const float x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
const float x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
product->x1 = x1;
product->x2 = x2;
@ -604,8 +604,8 @@ inline void bgc_fp32_multiply_matrix2x2_by_vector2(BGC_FP32_Vector2* product, co
inline void bgc_fp64_multiply_matrix2x2_by_vector2(BGC_FP64_Vector2* product, const BGC_FP64_Matrix2x2* matrix, const BGC_FP64_Vector2* vector)
{
const double x1 = matrix->row1_col1 * vector->x1 + matrix->row1_col2 * vector->x2;
const double x2 = matrix->row2_col1 * vector->x1 + matrix->row2_col2 * vector->x2;
const double x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
const double x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
product->x1 = x1;
product->x2 = x2;
@ -615,8 +615,8 @@ inline void bgc_fp64_multiply_matrix2x2_by_vector2(BGC_FP64_Vector2* product, co
inline void bgc_fp32_multiply_vector2_by_matrix2x2(BGC_FP32_Vector2* product, const BGC_FP32_Vector2* vector, const BGC_FP32_Matrix2x2* matrix)
{
const float x1 = vector->x1 * matrix->row1_col1 + vector->x2 * matrix->row2_col1;
const float x2 = vector->x1 * matrix->row1_col2 + vector->x2 * matrix->row2_col2;
const float x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1;
const float x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2;
product->x1 = x1;
product->x2 = x2;
@ -624,8 +624,8 @@ inline void bgc_fp32_multiply_vector2_by_matrix2x2(BGC_FP32_Vector2* product, co
inline void bgc_fp64_multiply_vector2_by_matrix2x2(BGC_FP64_Vector2* product, const BGC_FP64_Vector2* vector, const BGC_FP64_Matrix2x2* matrix)
{
const double x1 = vector->x1 * matrix->row1_col1 + vector->x2 * matrix->row2_col1;
const double x2 = vector->x1 * matrix->row1_col2 + vector->x2 * matrix->row2_col2;
const double x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1;
const double x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2;
product->x1 = x1;
product->x2 = x2;