Переход на парадигму Destination first в порядке параметров функий
This commit is contained in:
parent
f7e41645fe
commit
03627f4401
41 changed files with 1570 additions and 1978 deletions
|
|
@ -41,18 +41,18 @@ BGC_FP32_Affine3* _create_bgc_affine3_random_list(int affine_amount)
|
||||||
|
|
||||||
for (int i = 0; i < affine_amount; i++) {
|
for (int i = 0; i < affine_amount; i++) {
|
||||||
bgc_fp32_versor_make(
|
bgc_fp32_versor_make(
|
||||||
|
&position.turn,
|
||||||
get_random_value_fp32(),
|
get_random_value_fp32(),
|
||||||
get_random_value_fp32(),
|
get_random_value_fp32(),
|
||||||
get_random_value_fp32(),
|
get_random_value_fp32(),
|
||||||
get_random_value_fp32(),
|
get_random_value_fp32()
|
||||||
&position.turn
|
|
||||||
);
|
);
|
||||||
|
|
||||||
position.shift.x1 = get_random_value_fp32();
|
position.shift.x1 = get_random_value_fp32();
|
||||||
position.shift.x2 = get_random_value_fp32();
|
position.shift.x2 = get_random_value_fp32();
|
||||||
position.shift.x3 = get_random_value_fp32();
|
position.shift.x3 = get_random_value_fp32();
|
||||||
|
|
||||||
bgc_fp32_position3_get_outward_affine(&position, &affines[i]);
|
bgc_fp32_position3_get_outward_affine(&affines[i], &position);
|
||||||
}
|
}
|
||||||
|
|
||||||
return affines;
|
return affines;
|
||||||
|
|
@ -131,7 +131,7 @@ float test_bgc_affine3_performance(int affine_amount, int vector_per_affine)
|
||||||
for (int i = 0; i < affine_amount; i++)
|
for (int i = 0; i < affine_amount; i++)
|
||||||
{
|
{
|
||||||
for (int j = 0; j < vector_per_affine; j++) {
|
for (int j = 0; j < vector_per_affine; j++) {
|
||||||
bgc_fp32_affine3_transform_point(&affines[i], &source_vectors[vector_index], &result_vectors[vector_index]);
|
bgc_fp32_affine3_transform_point(&result_vectors[vector_index], &affines[i], &source_vectors[vector_index]);
|
||||||
vector_index++;
|
vector_index++;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -30,19 +30,19 @@ structure_fp32_t* make_structures(const unsigned int amount)
|
||||||
|
|
||||||
for (unsigned int i = 0; i < amount; i++) {
|
for (unsigned int i = 0; i < amount; i++) {
|
||||||
bgc_fp32_versor_make(
|
bgc_fp32_versor_make(
|
||||||
|
&list[i].versor1,
|
||||||
rand() * multiplier - 1.0f,
|
rand() * multiplier - 1.0f,
|
||||||
rand() * multiplier - 1.0f,
|
rand() * multiplier - 1.0f,
|
||||||
rand() * multiplier - 1.0f,
|
rand() * multiplier - 1.0f,
|
||||||
rand() * multiplier - 1.0f,
|
rand() * multiplier - 1.0f
|
||||||
&list[i].versor1
|
|
||||||
);
|
);
|
||||||
|
|
||||||
bgc_fp32_versor_make(
|
bgc_fp32_versor_make(
|
||||||
|
&list[i].versor2,
|
||||||
rand() * multiplier - 1.0f,
|
rand() * multiplier - 1.0f,
|
||||||
rand() * multiplier - 1.0f,
|
rand() * multiplier - 1.0f,
|
||||||
rand() * multiplier - 1.0f,
|
rand() * multiplier - 1.0f,
|
||||||
rand() * multiplier - 1.0f,
|
rand() * multiplier - 1.0f
|
||||||
&list[i].versor2
|
|
||||||
);
|
);
|
||||||
|
|
||||||
bgc_fp32_versor_reset(&list[i].result);
|
bgc_fp32_versor_reset(&list[i].result);
|
||||||
|
|
@ -157,74 +157,74 @@ void test_basis_difference_fp32()
|
||||||
BGC_FP32_Versor turn;
|
BGC_FP32_Versor turn;
|
||||||
|
|
||||||
// No turn
|
// No turn
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, 0.0f, 1.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary, 0.0f, 1.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp32_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nNo turn:\n");
|
printf("\nNo turn:\n");
|
||||||
print_versor_fp32(&turn);
|
print_versor_fp32(&turn);
|
||||||
|
|
||||||
// Turn around (1, 1, 0) axis on 180 degrees
|
// Turn around (1, 1, 0) axis on 180 degrees
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, 0.0f, 1.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, 0.0f, 1.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary, 1.0f, 0.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp32_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nTurn around (1, 1, 0) axis on 180 degrees:\n");
|
printf("\nTurn around (1, 1, 0) axis on 180 degrees:\n");
|
||||||
print_versor_fp32(&turn);
|
print_versor_fp32(&turn);
|
||||||
|
|
||||||
// 180 degree turn
|
// 180 degree turn
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, 0.0f, 1.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_vector3_make(-1.0f, 0.0f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, -1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary, 0.0f, 1.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp32_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\n180 degree turn around (0, 1, 0):\n");
|
printf("\n180 degree turn around (0, 1, 0):\n");
|
||||||
print_versor_fp32(&turn);
|
print_versor_fp32(&turn);
|
||||||
|
|
||||||
// 90 degree turn around x3 axis
|
// 90 degree turn around x3 axis
|
||||||
bgc_fp32_vector3_make(2.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 2.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 3.1f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, 0.0f, 3.1f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_vector3_make(0.0f, 10.0f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, 0.0f, 10.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(-1.0f, 0.0f, 0.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary,-1.0f, 0.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp32_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\n90 degree turn around (0, 0, 1):\n");
|
printf("\n90 degree turn around (0, 0, 1):\n");
|
||||||
print_versor_fp32(&turn);
|
print_versor_fp32(&turn);
|
||||||
|
|
||||||
// Unorthogonal pairs turn at 90 degrees around x3 axis
|
// Unorthogonal pairs turn at 90 degrees around x3 axis
|
||||||
bgc_fp32_vector3_make(2.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 2.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(-2.0f, 3.1f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, -2.0f, 3.1f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_vector3_make(0.0f, 10.0f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, 0.0f, 10.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(-1.0f, 5.0f, 0.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary, -1.0f, 5.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp32_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nUnorthogonal pairs turn at 90 degrees around (0, 0, 1):\n");
|
printf("\nUnorthogonal pairs turn at 90 degrees around (0, 0, 1):\n");
|
||||||
print_versor_fp32(&turn);
|
print_versor_fp32(&turn);
|
||||||
|
|
||||||
// Zero vectors
|
// Zero vectors
|
||||||
bgc_fp32_vector3_make(0.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 0.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, 0.0f, 1.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary, 0.0f, 1.0f, 0.0f);
|
||||||
|
|
||||||
int code;
|
int code;
|
||||||
|
|
||||||
code = bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
code = bgc_fp32_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
if (code >= 0) {
|
if (code >= 0) {
|
||||||
printf("\nZero vectors: this cannot be!\n");
|
printf("\nZero vectors: this cannot be!\n");
|
||||||
|
|
@ -235,12 +235,12 @@ void test_basis_difference_fp32()
|
||||||
}
|
}
|
||||||
|
|
||||||
// Parallel vectors
|
// Parallel vectors
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(2.0f, 0.0f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, 2.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary, 0.0f, 1.0f, 0.0f);
|
||||||
|
|
||||||
code = bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
code = bgc_fp32_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
if (code >= 0) {
|
if (code >= 0) {
|
||||||
printf("\nParallel vectors: this cannot be!\n");
|
printf("\nParallel vectors: this cannot be!\n");
|
||||||
|
|
@ -251,60 +251,60 @@ void test_basis_difference_fp32()
|
||||||
}
|
}
|
||||||
|
|
||||||
// Small angle turn (about 1 degree):
|
// Small angle turn (about 1 degree):
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, 0.0f, 1.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_vector3_make(0.999848f, 0.017452f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, 0.999848f, 0.017452f, 0.0f);
|
||||||
bgc_fp32_vector3_make(-0.017452f, 0.999848f, 0.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary, -0.017452f, 0.999848f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp32_versor_make_basis_difference(&turn , &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nSmall angle turn (about 1 degree):\n");
|
printf("\nSmall angle turn (about 1 degree):\n");
|
||||||
print_versor_fp32(&turn);
|
print_versor_fp32(&turn);
|
||||||
|
|
||||||
// About 179 degrees turn
|
// About 179 degrees turn
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, 0.0f, 1.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_vector3_make(-0.999848f, -0.017452f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, -0.999848f, -0.017452f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.017452f, -0.999848f, 0.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary, 0.017452f, -0.999848f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp32_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nAbout 179 degrees turn:\n");
|
printf("\nAbout 179 degrees turn:\n");
|
||||||
print_versor_fp32(&turn);
|
print_versor_fp32(&turn);
|
||||||
|
|
||||||
// 120 degrees around (-1, -1, 1)
|
// 120 degrees around (-1, -1, 1)
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, 0.0f, 1.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, 0.0f, 1.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 0.0f, -1.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary, 0.0f, 0.0f, -1.0f);
|
||||||
|
|
||||||
bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp32_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\n120 degees turn:\n");
|
printf("\n120 degees turn:\n");
|
||||||
print_versor_fp32(&turn);
|
print_versor_fp32(&turn);
|
||||||
|
|
||||||
|
|
||||||
// About 1 degree turn difference between initial_primary and initial_auxiliary directions
|
// About 1 degree turn difference between initial_primary and initial_auxiliary directions
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.999848f, 0.017452f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, 0.999848f, 0.017452f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, 1.0f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, 0.0f, 1.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(-1.0f, 0.0f, 0.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary, -1.0f, 0.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp32_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nAbout 1 degree turn difference between initial_primary and initial_auxiliary directions:\n");
|
printf("\nAbout 1 degree turn difference between initial_primary and initial_auxiliary directions:\n");
|
||||||
print_versor_fp32(&turn);
|
print_versor_fp32(&turn);
|
||||||
|
|
||||||
// About 0.01 degree turn difference between initial_primary and initial_auxiliary directions
|
// About 0.01 degree turn difference between initial_primary and initial_auxiliary directions
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &initial_primary);
|
bgc_fp32_vector3_make(&initial_primary, 1.0f, 0.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(1.0f, 0.000001f, 0.0f, &initial_auxiliary);
|
bgc_fp32_vector3_make(&initial_auxiliary, 1.0f, 0.000001f, 0.0f);
|
||||||
bgc_fp32_vector3_make(0.0f, -1.0f, 0.0f, &final_primary);
|
bgc_fp32_vector3_make(&final_primary, 0.0f, -1.0f, 0.0f);
|
||||||
bgc_fp32_vector3_make(1.0f, 0.0f, 0.0f, &final_auxiliary);
|
bgc_fp32_vector3_make(&final_auxiliary, 1.0f, 0.0f, 0.0f);
|
||||||
|
|
||||||
bgc_fp32_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp32_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nAbout 0.01 degree turn difference between initial_primary and initial_auxiliary directions:\n");
|
printf("\nAbout 0.01 degree turn difference between initial_primary and initial_auxiliary directions:\n");
|
||||||
print_versor_fp32(&turn);
|
print_versor_fp32(&turn);
|
||||||
|
|
@ -318,72 +318,72 @@ void test_basis_difference_fp64()
|
||||||
BGC_FP64_Versor turn;
|
BGC_FP64_Versor turn;
|
||||||
|
|
||||||
// No turn
|
// No turn
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, 0.0, 1.0, 0.0);
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&final_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, 0.0, 1.0, 0.0);
|
||||||
|
|
||||||
bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nNo turn:\n");
|
printf("\nNo turn:\n");
|
||||||
print_versor_fp64(&turn);
|
print_versor_fp64(&turn);
|
||||||
|
|
||||||
// Turn around (1, 1, 0) axis on 180 degrees
|
// Turn around (1, 1, 0) axis on 180 degrees
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, 0.0, 1.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&final_primary, 0.0, 1.0, 0.0);
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, 1.0, 0.0, 0.0);
|
||||||
|
|
||||||
bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nTurn around (1, 1, 0) axis on 180 degrees:\n");
|
printf("\nTurn around (1, 1, 0) axis on 180 degrees:\n");
|
||||||
print_versor_fp64(&turn);
|
print_versor_fp64(&turn);
|
||||||
|
|
||||||
// 180 degree turn
|
// 180 degree turn
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, 0.0, 1.0, 0.0);
|
||||||
|
|
||||||
bgc_fp64_vector3_make(-1.0, 0.0, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&initial_auxiliary, -1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, 0.0, 1.0, 0.0);
|
||||||
|
|
||||||
bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\n180 degree turn around (0, 1, 0):\n");
|
printf("\n180 degree turn around (0, 1, 0):\n");
|
||||||
print_versor_fp64(&turn);
|
print_versor_fp64(&turn);
|
||||||
|
|
||||||
// 90 degree turn around x3 axis
|
// 90 degree turn around x3 axis
|
||||||
bgc_fp64_vector3_make(2.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 2.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 3.1, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, 0.0, 3.1, 0.0);
|
||||||
|
|
||||||
bgc_fp64_vector3_make(0.0, 10.0, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&final_primary, 0.0, 10.0, 0.0);
|
||||||
bgc_fp64_vector3_make(-1.0, 0.0, 0.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, -1.0, 0.0, 0.0);
|
||||||
|
|
||||||
bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\n90 degree turn around (0, 0, 1):\n");
|
printf("\n90 degree turn around (0, 0, 1):\n");
|
||||||
print_versor_fp64(&turn);
|
print_versor_fp64(&turn);
|
||||||
|
|
||||||
// Unorthogonal pairs turn at 90 degrees around x3 axis
|
// Unorthogonal pairs turn at 90 degrees around x3 axis
|
||||||
bgc_fp64_vector3_make(2.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 2.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(-2.0, 3.1, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, -2.0, 3.1, 0.0);
|
||||||
|
|
||||||
bgc_fp64_vector3_make(0.0, 10.0, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&final_primary, 0.0, 10.0, 0.0);
|
||||||
bgc_fp64_vector3_make(-1.0, 5.0, 0.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, -1.0, 5.0, 0.0);
|
||||||
|
|
||||||
bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nUnorthogonal pairs turn at 90 degrees around (0, 0, 1):\n");
|
printf("\nUnorthogonal pairs turn at 90 degrees around (0, 0, 1):\n");
|
||||||
print_versor_fp64(&turn);
|
print_versor_fp64(&turn);
|
||||||
|
|
||||||
// Zero vectors
|
// Zero vectors
|
||||||
bgc_fp64_vector3_make(0.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 0.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, 0.0, 1.0, 0.0);
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&final_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, 0.0, 1.0, 0.0);
|
||||||
|
|
||||||
int code;
|
int code;
|
||||||
|
|
||||||
code = bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
code = bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
if (code >= 0) {
|
if (code >= 0) {
|
||||||
printf("\nZero vectors: this cannot be!\n");
|
printf("\nZero vectors: this cannot be!\n");
|
||||||
|
|
@ -394,12 +394,12 @@ void test_basis_difference_fp64()
|
||||||
}
|
}
|
||||||
|
|
||||||
// Parallel vectors
|
// Parallel vectors
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(2.0, 0.0, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, 2.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&final_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, 0.0, 1.0, 0.0);
|
||||||
|
|
||||||
code = bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
code = bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
if (code >= 0) {
|
if (code >= 0) {
|
||||||
printf("\nParallel vectors: this cannot be!\n");
|
printf("\nParallel vectors: this cannot be!\n");
|
||||||
|
|
@ -410,60 +410,60 @@ void test_basis_difference_fp64()
|
||||||
}
|
}
|
||||||
|
|
||||||
// Small angle turn (about 1 degree):
|
// Small angle turn (about 1 degree):
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, 0.0, 1.0, 0.0);
|
||||||
|
|
||||||
bgc_fp64_vector3_make(0.999848, 0.017452, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&final_primary, 0.999848, 0.017452, 0.0);
|
||||||
bgc_fp64_vector3_make(-0.017452, 0.999848, 0.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, -0.017452, 0.999848, 0.0);
|
||||||
|
|
||||||
bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nSmall angle turn (about 1 degree):\n");
|
printf("\nSmall angle turn (about 1 degree):\n");
|
||||||
print_versor_fp64(&turn);
|
print_versor_fp64(&turn);
|
||||||
|
|
||||||
// About 179 degrees turn
|
// About 179 degrees turn
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, 0.0, 1.0, 0.0);
|
||||||
|
|
||||||
bgc_fp64_vector3_make(-0.999848, -0.017452, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&final_primary, -0.999848, -0.017452, 0.0);
|
||||||
bgc_fp64_vector3_make(0.017452, -0.999848, 0.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, 0.017452, -0.999848, 0.0);
|
||||||
|
|
||||||
bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nAbout 179 degrees turn:\n");
|
printf("\nAbout 179 degrees turn:\n");
|
||||||
print_versor_fp64(&turn);
|
print_versor_fp64(&turn);
|
||||||
|
|
||||||
// 120 degrees around (-1, -1, 1)
|
// 120 degrees around (-1, -1, 1)
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, 0.0, 1.0, 0.0);
|
||||||
|
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&final_primary, 0.0, 1.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 0.0, -1.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, 0.0, 0.0, -1.0);
|
||||||
|
|
||||||
bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\n120 degees turn:\n");
|
printf("\n120 degees turn:\n");
|
||||||
print_versor_fp64(&turn);
|
print_versor_fp64(&turn);
|
||||||
|
|
||||||
|
|
||||||
// About 1 degree turn difference between initial_primary and initial_auxiliary directions
|
// About 1 degree turn difference between initial_primary and initial_auxiliary directions
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(0.999848, 0.017452, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, 0.999848, 0.017452, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, 1.0, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&final_primary, 0.0, 1.0, 0.0);
|
||||||
bgc_fp64_vector3_make(-1.0, 0.0, 0.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, -1.0, 0.0, 0.0);
|
||||||
|
|
||||||
bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nAbout 1 degree turn difference between initial_primary and initial_auxiliary directions:\n");
|
printf("\nAbout 1 degree turn difference between initial_primary and initial_auxiliary directions:\n");
|
||||||
print_versor_fp64(&turn);
|
print_versor_fp64(&turn);
|
||||||
|
|
||||||
// About 0.001 degree turn difference between initial_primary and initial_auxiliary directions
|
// About 0.001 degree turn difference between initial_primary and initial_auxiliary directions
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &initial_primary);
|
bgc_fp64_vector3_make(&initial_primary, 1.0, 0.0, 0.0);
|
||||||
bgc_fp64_vector3_make(1.0, 0.000001, 0.0, &initial_auxiliary);
|
bgc_fp64_vector3_make(&initial_auxiliary, 1.0, 0.000001, 0.0);
|
||||||
bgc_fp64_vector3_make(0.0, -1.0, 0.0, &final_primary);
|
bgc_fp64_vector3_make(&final_primary, 0.0, -1.0, 0.0);
|
||||||
bgc_fp64_vector3_make(1.0, 0.0, 0.0, &final_auxiliary);
|
bgc_fp64_vector3_make(&final_auxiliary, 1.0, 0.0, 0.0);
|
||||||
|
|
||||||
bgc_fp64_versor_make_basis_difference(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
bgc_fp64_versor_make_basis_difference(&turn, &initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary);
|
||||||
|
|
||||||
printf("\nAbout 0.01 degree turn difference between initial_primary and initial_auxiliary directions:\n");
|
printf("\nAbout 0.01 degree turn difference between initial_primary and initial_auxiliary directions:\n");
|
||||||
print_versor_fp64(&turn);
|
print_versor_fp64(&turn);
|
||||||
|
|
@ -475,23 +475,23 @@ int main()
|
||||||
{
|
{
|
||||||
//BGC_FP32_Versor start = { 1.0f, 0.0f, 0.0f, 0.0f };
|
//BGC_FP32_Versor start = { 1.0f, 0.0f, 0.0f, 0.0f };
|
||||||
//BGC_FP32_Versor end = { 0.0f, 1.0f, 0.0f, 0.0f };
|
//BGC_FP32_Versor end = { 0.0f, 1.0f, 0.0f, 0.0f };
|
||||||
/*
|
|
||||||
BGC_FP32_Versor start = { 1.0f, 0.0f, 0.0f, 0.0f };
|
BGC_FP32_Versor start = { 1.0f, 0.0f, 0.0f, 0.0f };
|
||||||
BGC_FP32_Versor end = { 0.9999f, 0.01414f, 0.0f, 0.0f };
|
BGC_FP32_Versor end = { 0.9999f, 0.01414f, 0.0f, 0.0f };
|
||||||
BGC_FP32_Slerp slerp;
|
BGC_FP32_Slerp slerp;
|
||||||
BGC_FP32_Versor result;
|
BGC_FP32_Versor result;
|
||||||
bgc_fp32_slerp_make_full(&start, &end, &slerp);
|
bgc_fp32_slerp_make_full(&slerp, &start, &end);
|
||||||
bgc_fp32_slerp_get_phase_versor(&slerp, 0.5f, &result);
|
bgc_fp32_slerp_get_phase_versor(&result, &slerp, 0.5f);
|
||||||
|
|
||||||
print_versor_fp32(&result);
|
//print_versor_fp32(&result);
|
||||||
*/
|
|
||||||
//test_basis_difference_fp64();
|
test_basis_difference_fp64();
|
||||||
|
|
||||||
|
//printf("Affine3 performance test: %f\n", test_bgc_affine3_performance(10000000, 10));
|
||||||
|
|
||||||
printf("Affine3 performance test: %f\n", test_bgc_affine3_performance(10000000, 10));
|
//printf("sizeof(BGC_FP32_Affine3) = %zu\n", sizeof(BGC_FP32_Affine3));
|
||||||
|
|
||||||
printf("sizeof(BGC_FP32_Affine3) = %zu\n", sizeof(BGC_FP32_Affine3));
|
|
||||||
//printf("offsetof(shift) = %zu\n", offsetof(BGC_FP32_Affine3, shift));
|
//printf("offsetof(shift) = %zu\n", offsetof(BGC_FP32_Affine3, shift));
|
||||||
printf("sizeof(BGC_FP32_Matrix3x3) = %zu\n", sizeof(BGC_FP32_Matrix3x3));
|
//printf("sizeof(BGC_FP32_Matrix3x3) = %zu\n", sizeof(BGC_FP32_Matrix3x3));
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -150,105 +150,9 @@
|
||||||
<ItemGroup>
|
<ItemGroup>
|
||||||
<ClCompile Include="helpers.c" />
|
<ClCompile Include="helpers.c" />
|
||||||
<ClCompile Include="main.c" />
|
<ClCompile Include="main.c" />
|
||||||
<ClCompile Include="tests\complex.c" />
|
|
||||||
<ClCompile Include="tests\complex\complex_copy.c" />
|
|
||||||
<ClCompile Include="tests\complex\complex_is_unit.c" />
|
|
||||||
<ClCompile Include="tests\complex\complex_is_zero.c" />
|
|
||||||
<ClCompile Include="tests\complex\complex_modulus.c" />
|
|
||||||
<ClCompile Include="tests\complex\complex_reset.c" />
|
|
||||||
<ClCompile Include="tests\complex\complex_set_values.c" />
|
|
||||||
<ClCompile Include="tests\complex\complex_swap.c" />
|
|
||||||
<ClCompile Include="tests\complex\complex_arithmetics.c" />
|
|
||||||
<ClCompile Include="tests\quaternion.c" />
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_copy.c" />
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_is_unit.c" />
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_is_zero.c" />
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_modulus.c" />
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_reset.c" />
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_set_to_identity.c" />
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_set_values.c" />
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_swap.c" />
|
|
||||||
<ClCompile Include="tests\utilities.c" />
|
|
||||||
<ClCompile Include="tests\utilities\are_close.c" />
|
|
||||||
<ClCompile Include="tests\utilities\is_unit.c" />
|
|
||||||
<ClCompile Include="tests\utilities\is_zero.c" />
|
|
||||||
<ClCompile Include="tests\vector2.c" />
|
|
||||||
<ClCompile Include="tests\vector2\vector2_arithmetics.c" />
|
|
||||||
<ClCompile Include="tests\vector2\vector2_is_unit.c" />
|
|
||||||
<ClCompile Include="tests\vector2\vector2_is_zero.c" />
|
|
||||||
<ClCompile Include="tests\vector2\vector2_copy.c" />
|
|
||||||
<ClCompile Include="tests\vector2\vector2_modulus.c" />
|
|
||||||
<ClCompile Include="tests\vector2\vector2_reset.c" />
|
|
||||||
<ClCompile Include="tests\vector2\vector2_set_values.c" />
|
|
||||||
<ClCompile Include="tests\vector2\vector2_swap.c" />
|
|
||||||
<ClCompile Include="tests\vector3.c" />
|
|
||||||
<ClCompile Include="tests\vector3\vector3_arithmetics.c" />
|
|
||||||
<ClCompile Include="tests\vector3\vector3_is_unit.c" />
|
|
||||||
<ClCompile Include="tests\vector3\vector3_is_zero.c" />
|
|
||||||
<ClCompile Include="tests\vector3\vector3_copy.c" />
|
|
||||||
<ClCompile Include="tests\vector3\vector3_modulus.c" />
|
|
||||||
<ClCompile Include="tests\vector3\vector3_swap.c" />
|
|
||||||
<ClCompile Include="tests\vector3\vector3_reset.c" />
|
|
||||||
<ClCompile Include="tests\vector3\vector3_set_values.c" />
|
|
||||||
<ClCompile Include="tests\versor.c" />
|
|
||||||
<ClCompile Include="tests\versor\versor_copy.c" />
|
|
||||||
<ClCompile Include="tests\versor\versor_is_identity.c" />
|
|
||||||
<ClCompile Include="tests\versor\versor_swap.c" />
|
|
||||||
<ClCompile Include="tests\versor\versor_combine.c" />
|
|
||||||
<ClCompile Include="tests\versor\versor_reset.c" />
|
|
||||||
<ClCompile Include="tests\versor\versor_set_values.c" />
|
|
||||||
<ClCompile Include="tests\versor\versor_are_close.c" />
|
|
||||||
</ItemGroup>
|
</ItemGroup>
|
||||||
<ItemGroup>
|
<ItemGroup>
|
||||||
<ClInclude Include="helpers.h" />
|
<ClInclude Include="helpers.h" />
|
||||||
<ClInclude Include="tests\complex.h" />
|
|
||||||
<ClInclude Include="tests\complex\complex_copy.h" />
|
|
||||||
<ClInclude Include="tests\complex\complex_is_unit.h" />
|
|
||||||
<ClInclude Include="tests\complex\complex_is_zero.h" />
|
|
||||||
<ClInclude Include="tests\complex\complex_modulus.h" />
|
|
||||||
<ClInclude Include="tests\complex\complex_reset.h" />
|
|
||||||
<ClInclude Include="tests\complex\complex_set_values.h" />
|
|
||||||
<ClInclude Include="tests\complex\complex_swap.h" />
|
|
||||||
<ClInclude Include="tests\complex\complex_arithmetics.h" />
|
|
||||||
<ClInclude Include="tests\quaternion.h" />
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_copy.h" />
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_is_unit.h" />
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_is_zero.h" />
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_modulus.h" />
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_reset.h" />
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_set_to_identity.h" />
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_set_values.h" />
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_swap.h" />
|
|
||||||
<ClInclude Include="tests\utilities.h" />
|
|
||||||
<ClInclude Include="tests\utilities\are_close.h" />
|
|
||||||
<ClInclude Include="tests\utilities\is_unit.h" />
|
|
||||||
<ClInclude Include="tests\utilities\is_zero.h" />
|
|
||||||
<ClInclude Include="tests\vector2.h" />
|
|
||||||
<ClInclude Include="tests\vector2\vector2_arithmetics.h" />
|
|
||||||
<ClInclude Include="tests\vector2\vector2_is_unit.h" />
|
|
||||||
<ClInclude Include="tests\vector2\vector2_is_zero.h" />
|
|
||||||
<ClInclude Include="tests\vector2\vector2_copy.h" />
|
|
||||||
<ClInclude Include="tests\vector2\vector2_modulus.h" />
|
|
||||||
<ClInclude Include="tests\vector2\vector2_reset.h" />
|
|
||||||
<ClInclude Include="tests\vector2\vector2_set_values.h" />
|
|
||||||
<ClInclude Include="tests\vector2\vector2_swap.h" />
|
|
||||||
<ClInclude Include="tests\vector3.h" />
|
|
||||||
<ClInclude Include="tests\vector3\vector3_arithmetics.h" />
|
|
||||||
<ClInclude Include="tests\vector3\vector3_is_unit.h" />
|
|
||||||
<ClInclude Include="tests\vector3\vector3_is_zero.h" />
|
|
||||||
<ClInclude Include="tests\vector3\vector3_copy.h" />
|
|
||||||
<ClInclude Include="tests\vector3\vector3_modulus.h" />
|
|
||||||
<ClInclude Include="tests\vector3\vector3_swap.h" />
|
|
||||||
<ClInclude Include="tests\vector3\vector3_reset.h" />
|
|
||||||
<ClInclude Include="tests\vector3\vector3_set_values.h" />
|
|
||||||
<ClInclude Include="tests\versor.h" />
|
|
||||||
<ClInclude Include="tests\versor\versor_copy.h" />
|
|
||||||
<ClInclude Include="tests\versor\versor_is_identity.h" />
|
|
||||||
<ClInclude Include="tests\versor\versor_swap.h" />
|
|
||||||
<ClInclude Include="tests\versor\versor_combine.h" />
|
|
||||||
<ClInclude Include="tests\versor\versor_reset.h" />
|
|
||||||
<ClInclude Include="tests\versor\versor_set_values.h" />
|
|
||||||
<ClInclude Include="tests\versor\versor_are_close.h" />
|
|
||||||
</ItemGroup>
|
</ItemGroup>
|
||||||
<Import Project="$(VCTargetsPath)\Microsoft.Cpp.targets" />
|
<Import Project="$(VCTargetsPath)\Microsoft.Cpp.targets" />
|
||||||
<ImportGroup Label="ExtensionTargets">
|
<ImportGroup Label="ExtensionTargets">
|
||||||
|
|
|
||||||
|
|
@ -3,319 +3,8 @@
|
||||||
<ItemGroup>
|
<ItemGroup>
|
||||||
<ClCompile Include="main.c" />
|
<ClCompile Include="main.c" />
|
||||||
<ClCompile Include="helpers.c" />
|
<ClCompile Include="helpers.c" />
|
||||||
<ClCompile Include="tests\utilities.c">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector2.c">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector3.c">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\versor.c">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\utilities\is_zero.c">
|
|
||||||
<Filter>tests\utilities</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\utilities\is_unit.c">
|
|
||||||
<Filter>tests\utilities</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\utilities\are_close.c">
|
|
||||||
<Filter>tests\utilities</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\versor\versor_are_close.c">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\versor\versor_set_values.c">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\versor\versor_combine.c">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\versor\versor_reset.c">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector2\vector2_reset.c">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector2\vector2_set_values.c">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector3\vector3_reset.c">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector3\vector3_set_values.c">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector2\vector2_copy.c">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector2\vector2_swap.c">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector3\vector3_copy.c">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector3\vector3_swap.c">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\versor\versor_copy.c">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\versor\versor_swap.c">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_copy.c">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_reset.c">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_set_values.c">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_swap.c">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\quaternion.c">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_set_to_identity.c">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector3\vector3_is_zero.c">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector2\vector2_is_zero.c">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_is_zero.c">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_is_unit.c">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector3\vector3_is_unit.c">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector2\vector2_is_unit.c">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\versor\versor_is_identity.c">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector2\vector2_modulus.c">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector3\vector3_modulus.c">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\quaternion\quaternion_modulus.c">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\complex\complex_copy.c">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\complex\complex_is_unit.c">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\complex\complex_is_zero.c">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\complex\complex_modulus.c">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\complex\complex_reset.c">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\complex\complex_set_values.c">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\complex\complex_swap.c">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\complex.c">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector2\vector2_arithmetics.c">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\vector3\vector3_arithmetics.c">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
<ClCompile Include="tests\complex\complex_arithmetics.c">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClCompile>
|
|
||||||
</ItemGroup>
|
</ItemGroup>
|
||||||
<ItemGroup>
|
<ItemGroup>
|
||||||
<ClInclude Include="helpers.h" />
|
<ClInclude Include="helpers.h" />
|
||||||
<ClInclude Include="tests\utilities.h">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector2.h">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector3.h">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\versor.h">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\utilities\is_zero.h">
|
|
||||||
<Filter>tests\utilities</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\utilities\is_unit.h">
|
|
||||||
<Filter>tests\utilities</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\utilities\are_close.h">
|
|
||||||
<Filter>tests\utilities</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\versor\versor_are_close.h">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\versor\versor_set_values.h">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\versor\versor_combine.h">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\versor\versor_reset.h">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector2\vector2_reset.h">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector2\vector2_set_values.h">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector3\vector3_reset.h">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector3\vector3_set_values.h">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector2\vector2_copy.h">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector2\vector2_swap.h">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector3\vector3_copy.h">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector3\vector3_swap.h">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\versor\versor_copy.h">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\versor\versor_swap.h">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_copy.h">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_reset.h">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_set_values.h">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_swap.h">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\quaternion.h">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_set_to_identity.h">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector3\vector3_is_zero.h">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector2\vector2_is_zero.h">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_is_zero.h">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_is_unit.h">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector3\vector3_is_unit.h">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector2\vector2_is_unit.h">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\versor\versor_is_identity.h">
|
|
||||||
<Filter>tests\versor</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector2\vector2_modulus.h">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector3\vector3_modulus.h">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\quaternion\quaternion_modulus.h">
|
|
||||||
<Filter>tests\quaternion</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\complex\complex_copy.h">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\complex\complex_is_unit.h">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\complex\complex_is_zero.h">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\complex\complex_modulus.h">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\complex\complex_reset.h">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\complex\complex_set_values.h">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\complex\complex_swap.h">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\complex.h">
|
|
||||||
<Filter>tests</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector2\vector2_arithmetics.h">
|
|
||||||
<Filter>tests\vector2</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\vector3\vector3_arithmetics.h">
|
|
||||||
<Filter>tests\vector3</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
<ClInclude Include="tests\complex\complex_arithmetics.h">
|
|
||||||
<Filter>tests\complex</Filter>
|
|
||||||
</ClInclude>
|
|
||||||
</ItemGroup>
|
|
||||||
<ItemGroup>
|
|
||||||
<Filter Include="tests">
|
|
||||||
<UniqueIdentifier>{10db9024-67b8-4555-80a9-48b54ae0dec9}</UniqueIdentifier>
|
|
||||||
</Filter>
|
|
||||||
<Filter Include="tests\utilities">
|
|
||||||
<UniqueIdentifier>{392bc542-f334-4132-a22b-b5b440c77897}</UniqueIdentifier>
|
|
||||||
</Filter>
|
|
||||||
<Filter Include="tests\vector2">
|
|
||||||
<UniqueIdentifier>{d9f520e0-1b2d-4379-8887-1b5728763129}</UniqueIdentifier>
|
|
||||||
</Filter>
|
|
||||||
<Filter Include="tests\vector3">
|
|
||||||
<UniqueIdentifier>{dbf2eefa-8f1f-4447-b3d4-d17dee049580}</UniqueIdentifier>
|
|
||||||
</Filter>
|
|
||||||
<Filter Include="tests\versor">
|
|
||||||
<UniqueIdentifier>{d6f82407-8310-4b32-b153-aa67e766c72a}</UniqueIdentifier>
|
|
||||||
</Filter>
|
|
||||||
<Filter Include="tests\quaternion">
|
|
||||||
<UniqueIdentifier>{e8bafdb8-66e5-4393-bc89-8bff83bcccd6}</UniqueIdentifier>
|
|
||||||
</Filter>
|
|
||||||
<Filter Include="tests\complex">
|
|
||||||
<UniqueIdentifier>{e025e123-45aa-44f9-aab4-f1705844b211}</UniqueIdentifier>
|
|
||||||
</Filter>
|
|
||||||
</ItemGroup>
|
</ItemGroup>
|
||||||
</Project>
|
</Project>
|
||||||
|
|
@ -1,31 +1,31 @@
|
||||||
#include "affine2.h"
|
#include "affine2.h"
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine2_reset(BGC_FP32_Affine2 * affine);
|
extern inline void bgc_fp32_affine2_reset(BGC_FP32_Affine2* affine);
|
||||||
extern inline void bgc_fp64_affine2_reset(BGC_FP64_Affine2 * affine);
|
extern inline void bgc_fp64_affine2_reset(BGC_FP64_Affine2* affine);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine2_make(const BGC_FP32_Matrix2x2 * distortion, const BGC_FP32_Vector2 * shift, BGC_FP32_Affine2 * affine);
|
extern inline void bgc_fp32_affine2_make(BGC_FP32_Affine2* affine, const BGC_FP32_Matrix2x2* distortion, const BGC_FP32_Vector2* shift);
|
||||||
extern inline void bgc_fp64_affine2_make(const BGC_FP64_Matrix2x2 * distortion, const BGC_FP64_Vector2 * shift, BGC_FP64_Affine2 * affine);
|
extern inline void bgc_fp64_affine2_make(BGC_FP64_Affine2* affine, const BGC_FP64_Matrix2x2* distortion, const BGC_FP64_Vector2* shift);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine2_copy(const BGC_FP32_Affine2 * source, BGC_FP32_Affine2 * destination);
|
extern inline void bgc_fp32_affine2_copy(BGC_FP32_Affine2* destination, const BGC_FP32_Affine2* source);
|
||||||
extern inline void bgc_fp64_affine2_copy(const BGC_FP64_Affine2 * source, BGC_FP64_Affine2 * destination);
|
extern inline void bgc_fp64_affine2_copy(BGC_FP64_Affine2* destination, const BGC_FP64_Affine2* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine2_swap(BGC_FP32_Affine2 * first, BGC_FP32_Affine2 * second);
|
extern inline void bgc_fp32_affine2_swap(BGC_FP32_Affine2* first, BGC_FP32_Affine2* second);
|
||||||
extern inline void bgc_fp64_affine2_swap(BGC_FP64_Affine2 * first, BGC_FP64_Affine2 * second);
|
extern inline void bgc_fp64_affine2_swap(BGC_FP64_Affine2* first, BGC_FP64_Affine2* second);
|
||||||
|
|
||||||
extern inline void bgc_fp64_affine2_convert_to_fp32(const BGC_FP64_Affine2 * source, BGC_FP32_Affine2 * destination);
|
extern inline void bgc_fp32_affine2_convert_to_fp64(BGC_FP64_Affine2* destination, const BGC_FP32_Affine2* source);
|
||||||
extern inline void bgc_fp32_affine2_convert_to_fp64(const BGC_FP32_Affine2 * source, BGC_FP64_Affine2 * destination);
|
extern inline void bgc_fp64_affine2_convert_to_fp32(BGC_FP32_Affine2* destination, const BGC_FP64_Affine2* source);
|
||||||
|
|
||||||
extern inline int bgc_fp32_affine2_invert(BGC_FP32_Affine2 * affine);
|
extern inline int bgc_fp32_affine2_invert(BGC_FP32_Affine2* affine);
|
||||||
extern inline int bgc_fp64_affine2_invert(BGC_FP64_Affine2 * affine);
|
extern inline int bgc_fp64_affine2_invert(BGC_FP64_Affine2* affine);
|
||||||
|
|
||||||
extern inline int bgc_fp32_affine2_get_inverse(const BGC_FP32_Affine2 * source, BGC_FP32_Affine2 * destination);
|
extern inline int bgc_fp32_affine2_get_inverse(BGC_FP32_Affine2* inverse, const BGC_FP32_Affine2* affine);
|
||||||
extern inline int bgc_fp64_affine2_get_inverse(const BGC_FP64_Affine2 * source, BGC_FP64_Affine2 * destination);
|
extern inline int bgc_fp64_affine2_get_inverse(BGC_FP64_Affine2* inverse, const BGC_FP64_Affine2* affine);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine2_combine(const BGC_FP32_Affine2 * first, const BGC_FP32_Affine2 * second, BGC_FP32_Affine2 * combination);
|
extern inline void bgc_fp32_affine2_combine(BGC_FP32_Affine2* combination, const BGC_FP32_Affine2* first, const BGC_FP32_Affine2* second);
|
||||||
extern inline void bgc_fp64_affine2_combine(const BGC_FP64_Affine2 * first, const BGC_FP64_Affine2 * second, BGC_FP64_Affine2 * combination);
|
extern inline void bgc_fp64_affine2_combine(BGC_FP64_Affine2* combination, const BGC_FP64_Affine2* first, const BGC_FP64_Affine2* second);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine2_transform_point(const BGC_FP32_Affine2 * affine, const BGC_FP32_Vector2 * initial_point, BGC_FP32_Vector2 * transformed_point);
|
extern inline void bgc_fp32_affine2_transform_point(BGC_FP32_Vector2* transformed_point, const BGC_FP32_Affine2* affine, const BGC_FP32_Vector2* initial_point);
|
||||||
extern inline void bgc_fp64_affine2_transform_point(const BGC_FP64_Affine2 * affine, const BGC_FP64_Vector2 * initial_point, BGC_FP64_Vector2 * transformed_point);
|
extern inline void bgc_fp64_affine2_transform_point(BGC_FP64_Vector2* transformed_point, const BGC_FP64_Affine2* affine, const BGC_FP64_Vector2* initial_point);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine2_transform_vector(const BGC_FP32_Affine2 * affine, const BGC_FP32_Vector2 * initial_vector, BGC_FP32_Vector2 * transformed_vector);
|
extern inline void bgc_fp32_affine2_transform_vector(BGC_FP32_Vector2* transformed_vector, const BGC_FP32_Affine2* affine, const BGC_FP32_Vector2* initial_vector);
|
||||||
extern inline void bgc_fp64_affine2_transform_vector(const BGC_FP64_Affine2 * affine, const BGC_FP64_Vector2 * initial_vector, BGC_FP64_Vector2 * transformed_vector);
|
extern inline void bgc_fp64_affine2_transform_vector(BGC_FP64_Vector2* transformed_vector, const BGC_FP64_Affine2* affine, const BGC_FP64_Vector2* initial_vector);
|
||||||
|
|
|
||||||
|
|
@ -2,7 +2,7 @@
|
||||||
#define _BGC_AFFINE2_H_INCLUDED_
|
#define _BGC_AFFINE2_H_INCLUDED_
|
||||||
|
|
||||||
#include "vector2.h"
|
#include "vector2.h"
|
||||||
#include "matrixes.h"
|
#include "matrices.h"
|
||||||
#include "matrix2x2.h"
|
#include "matrix2x2.h"
|
||||||
|
|
||||||
// ==================== Types ==================== //
|
// ==================== Types ==================== //
|
||||||
|
|
@ -19,13 +19,13 @@ typedef struct {
|
||||||
|
|
||||||
// ==================== Reset ==================== //
|
// ==================== Reset ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine2_reset(BGC_FP32_Affine2 * affine)
|
inline void bgc_fp32_affine2_reset(BGC_FP32_Affine2* affine)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix2x2_make_identity(&affine->distortion);
|
bgc_fp32_matrix2x2_make_identity(&affine->distortion);
|
||||||
bgc_fp32_vector2_reset(&affine->shift);
|
bgc_fp32_vector2_reset(&affine->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine2_reset(BGC_FP64_Affine2 * affine)
|
inline void bgc_fp64_affine2_reset(BGC_FP64_Affine2* affine)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix2x2_make_identity(&affine->distortion);
|
bgc_fp64_matrix2x2_make_identity(&affine->distortion);
|
||||||
bgc_fp64_vector2_reset(&affine->shift);
|
bgc_fp64_vector2_reset(&affine->shift);
|
||||||
|
|
@ -33,31 +33,31 @@ inline void bgc_fp64_affine2_reset(BGC_FP64_Affine2 * affine)
|
||||||
|
|
||||||
// ==================== Make ===================== //
|
// ==================== Make ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine2_make(const BGC_FP32_Matrix2x2 * distortion, const BGC_FP32_Vector2 * shift, BGC_FP32_Affine2 * affine)
|
inline void bgc_fp32_affine2_make(BGC_FP32_Affine2* affine, const BGC_FP32_Matrix2x2* distortion, const BGC_FP32_Vector2* shift)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix2x2_copy(distortion, &affine->distortion);
|
bgc_fp32_matrix2x2_copy(&affine->distortion, distortion);
|
||||||
bgc_fp32_vector2_copy(shift, &affine->shift);
|
bgc_fp32_vector2_copy(&affine->shift, shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine2_make(const BGC_FP64_Matrix2x2 * distortion, const BGC_FP64_Vector2 * shift, BGC_FP64_Affine2 * affine)
|
inline void bgc_fp64_affine2_make(BGC_FP64_Affine2* affine, const BGC_FP64_Matrix2x2* distortion, const BGC_FP64_Vector2* shift)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix2x2_copy(distortion, &affine->distortion);
|
bgc_fp64_matrix2x2_copy(&affine->distortion, distortion);
|
||||||
bgc_fp64_vector2_copy(shift, &affine->shift);
|
bgc_fp64_vector2_copy(&affine->shift, shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
// ==================== Copy ===================== //
|
// ==================== Copy ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine2_copy(const BGC_FP32_Affine2 * source, BGC_FP32_Affine2 * destination)
|
inline void bgc_fp32_affine2_copy(BGC_FP32_Affine2* destination, const BGC_FP32_Affine2* source)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix2x2_copy(&source->distortion, &destination->distortion);
|
bgc_fp32_matrix2x2_copy(&destination->distortion, &source->distortion);
|
||||||
bgc_fp32_vector2_copy(&source->shift, &destination->shift);
|
bgc_fp32_vector2_copy(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine2_copy(const BGC_FP64_Affine2 * source, BGC_FP64_Affine2 * destination)
|
inline void bgc_fp64_affine2_copy(BGC_FP64_Affine2* destination, const BGC_FP64_Affine2* source)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix2x2_copy(&source->distortion, &destination->distortion);
|
bgc_fp64_matrix2x2_copy(&destination->distortion, &source->distortion);
|
||||||
bgc_fp64_vector2_copy(&source->shift, &destination->shift);
|
bgc_fp64_vector2_copy(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ==================== Swap ===================== //
|
// ==================== Swap ===================== //
|
||||||
|
|
@ -76,16 +76,16 @@ inline void bgc_fp64_affine2_swap(BGC_FP64_Affine2 * first, BGC_FP64_Affine2 * s
|
||||||
|
|
||||||
// =================== Convert =================== //
|
// =================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_affine2_convert_to_fp32(const BGC_FP64_Affine2 * source, BGC_FP32_Affine2 * destination)
|
inline void bgc_fp32_affine2_convert_to_fp64(BGC_FP64_Affine2* destination, const BGC_FP32_Affine2* source)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix2x2_convert_to_fp32(&source->distortion, &destination->distortion);
|
bgc_fp32_matrix2x2_convert_to_fp64(&destination->distortion, &source->distortion);
|
||||||
bgc_fp64_vector2_convert_to_fp32(&source->shift, &destination->shift);
|
bgc_fp32_vector2_convert_to_fp64(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_affine2_convert_to_fp64(const BGC_FP32_Affine2 * source, BGC_FP64_Affine2 * destination)
|
inline void bgc_fp64_affine2_convert_to_fp32(BGC_FP32_Affine2* destination, const BGC_FP64_Affine2 * source)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix2x2_convert_to_fp64(&source->distortion, &destination->distortion);
|
bgc_fp64_matrix2x2_convert_to_fp32(&destination->distortion, &source->distortion);
|
||||||
bgc_fp32_vector2_convert_to_fp64(&source->shift, &destination->shift);
|
bgc_fp64_vector2_convert_to_fp32(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Invert ==================== //
|
// =================== Invert ==================== //
|
||||||
|
|
@ -96,7 +96,7 @@ inline int bgc_fp32_affine2_invert(BGC_FP32_Affine2 * affine)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp32_multiply_matrix2x2_by_vector2(&affine->distortion, &affine->shift, &affine->shift);
|
bgc_fp32_multiply_matrix2x2_by_vector2(&affine->shift, &affine->distortion, &affine->shift);
|
||||||
bgc_fp32_vector2_revert(&affine->shift);
|
bgc_fp32_vector2_revert(&affine->shift);
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
|
|
@ -108,7 +108,7 @@ inline int bgc_fp64_affine2_invert(BGC_FP64_Affine2 * affine)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp64_multiply_matrix2x2_by_vector2(&affine->distortion, &affine->shift, &affine->shift);
|
bgc_fp64_multiply_matrix2x2_by_vector2(&affine->shift, &affine->distortion, &affine->shift);
|
||||||
bgc_fp64_vector2_revert(&affine->shift);
|
bgc_fp64_vector2_revert(&affine->shift);
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
|
|
@ -116,74 +116,74 @@ inline int bgc_fp64_affine2_invert(BGC_FP64_Affine2 * affine)
|
||||||
|
|
||||||
// ================= Get Inverse ================= //
|
// ================= Get Inverse ================= //
|
||||||
|
|
||||||
inline int bgc_fp32_affine2_get_inverse(const BGC_FP32_Affine2 * source, BGC_FP32_Affine2 * destination)
|
inline int bgc_fp32_affine2_get_inverse(BGC_FP32_Affine2* inverse, const BGC_FP32_Affine2 * affine)
|
||||||
{
|
{
|
||||||
if (!bgc_fp32_matrix2x2_get_inverse(&source->distortion, &destination->distortion)) {
|
if (!bgc_fp32_matrix2x2_get_inverse(&inverse->distortion, &affine->distortion)) {
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp32_multiply_matrix2x2_by_vector2(&destination->distortion, &source->shift, &destination->shift);
|
bgc_fp32_multiply_matrix2x2_by_vector2(&inverse->shift, &inverse->distortion, &affine->shift);
|
||||||
bgc_fp32_vector2_revert(&destination->shift);
|
bgc_fp32_vector2_revert(&inverse->shift);
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_affine2_get_inverse(const BGC_FP64_Affine2 * source, BGC_FP64_Affine2 * destination)
|
inline int bgc_fp64_affine2_get_inverse(BGC_FP64_Affine2* inverse, const BGC_FP64_Affine2 * affine)
|
||||||
{
|
{
|
||||||
if (!bgc_fp64_matrix2x2_get_inverse(&source->distortion, &destination->distortion)) {
|
if (!bgc_fp64_matrix2x2_get_inverse(&inverse->distortion, &affine->distortion)) {
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp64_multiply_matrix2x2_by_vector2(&destination->distortion, &source->shift, &destination->shift);
|
bgc_fp64_multiply_matrix2x2_by_vector2(&inverse->shift, &inverse->distortion, &affine->shift);
|
||||||
bgc_fp64_vector2_revert(&destination->shift);
|
bgc_fp64_vector2_revert(&inverse->shift);
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Combine =================== //
|
// =================== Combine =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine2_combine(const BGC_FP32_Affine2 * first, const BGC_FP32_Affine2 * second, BGC_FP32_Affine2 * combination)
|
inline void bgc_fp32_affine2_combine(BGC_FP32_Affine2* combination, const BGC_FP32_Affine2 * first, const BGC_FP32_Affine2 * second)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector2 first_shift;
|
BGC_FP32_Vector2 first_shift;
|
||||||
bgc_fp32_multiply_matrix2x2_by_vector2(&second->distortion, &first->shift, &first_shift);
|
bgc_fp32_multiply_matrix2x2_by_vector2(&first_shift, &second->distortion, &first->shift);
|
||||||
bgc_fp32_multiply_matrix2x2_by_matrix2x2(&second->distortion, &first->distortion, &combination->distortion);
|
bgc_fp32_multiply_matrix2x2_by_matrix2x2(&combination->distortion, &second->distortion, &first->distortion);
|
||||||
bgc_fp32_vector2_add(&first_shift, &second->shift, &combination->shift);
|
bgc_fp32_vector2_add(&combination->shift, &second->shift, &first_shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine2_combine(const BGC_FP64_Affine2 * first, const BGC_FP64_Affine2 * second, BGC_FP64_Affine2 * combination)
|
inline void bgc_fp64_affine2_combine(BGC_FP64_Affine2* combination, const BGC_FP64_Affine2 * first, const BGC_FP64_Affine2 * second)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector2 first_shift;
|
BGC_FP64_Vector2 first_shift;
|
||||||
bgc_fp64_multiply_matrix2x2_by_vector2(&second->distortion, &first->shift, &first_shift);
|
bgc_fp64_multiply_matrix2x2_by_vector2(&first_shift, &second->distortion, &first->shift);
|
||||||
bgc_fp64_multiply_matrix2x2_by_matrix2x2(&second->distortion, &first->distortion, &combination->distortion);
|
bgc_fp64_multiply_matrix2x2_by_matrix2x2(&combination->distortion, &second->distortion, &first->distortion);
|
||||||
bgc_fp64_vector2_add(&first_shift, &second->shift, &combination->shift);
|
bgc_fp64_vector2_add(&combination->shift, &second->shift, &first_shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =============== Transform Point =============== //
|
// =============== Transform Point =============== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine2_transform_point(const BGC_FP32_Affine2 * affine, const BGC_FP32_Vector2 * initial_point, BGC_FP32_Vector2 * transformed_point)
|
inline void bgc_fp32_affine2_transform_point(BGC_FP32_Vector2* transformed_point, const BGC_FP32_Affine2 * affine, const BGC_FP32_Vector2 * initial_point)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector2 distorted;
|
BGC_FP32_Vector2 distorted;
|
||||||
bgc_fp32_multiply_matrix2x2_by_vector2(&affine->distortion, initial_point, &distorted);
|
bgc_fp32_multiply_matrix2x2_by_vector2(&distorted, &affine->distortion, initial_point);
|
||||||
bgc_fp32_vector2_add(&affine->shift, &distorted, transformed_point);
|
bgc_fp32_vector2_add(transformed_point, &affine->shift, &distorted);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine2_transform_point(const BGC_FP64_Affine2 * affine, const BGC_FP64_Vector2 * initial_point, BGC_FP64_Vector2 * transformed_point)
|
inline void bgc_fp64_affine2_transform_point(BGC_FP64_Vector2* transformed_point, const BGC_FP64_Affine2 * affine, const BGC_FP64_Vector2 * initial_point)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector2 distorted;
|
BGC_FP64_Vector2 distorted;
|
||||||
bgc_fp64_multiply_matrix2x2_by_vector2(&affine->distortion, initial_point, &distorted);
|
bgc_fp64_multiply_matrix2x2_by_vector2(&distorted, &affine->distortion, initial_point);
|
||||||
bgc_fp64_vector2_add(&affine->shift, &distorted, transformed_point);
|
bgc_fp64_vector2_add(transformed_point, &affine->shift, &distorted);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============== Transform Vector =============== //
|
// ============== Transform Vector =============== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine2_transform_vector(const BGC_FP32_Affine2 * affine, const BGC_FP32_Vector2 * initial_vector, BGC_FP32_Vector2 * transformed_vector)
|
inline void bgc_fp32_affine2_transform_vector(BGC_FP32_Vector2* transformed_vector, const BGC_FP32_Affine2 * affine, const BGC_FP32_Vector2 * initial_vector)
|
||||||
{
|
{
|
||||||
bgc_fp32_multiply_matrix2x2_by_vector2(&affine->distortion, initial_vector, transformed_vector);
|
bgc_fp32_multiply_matrix2x2_by_vector2(transformed_vector, &affine->distortion, initial_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine2_transform_vector(const BGC_FP64_Affine2 * affine, const BGC_FP64_Vector2 * initial_vector, BGC_FP64_Vector2 * transformed_vector)
|
inline void bgc_fp64_affine2_transform_vector(BGC_FP64_Vector2* transformed_vector, const BGC_FP64_Affine2 * affine, const BGC_FP64_Vector2 * initial_vector)
|
||||||
{
|
{
|
||||||
bgc_fp64_multiply_matrix2x2_by_vector2(&affine->distortion, initial_vector, transformed_vector);
|
bgc_fp64_multiply_matrix2x2_by_vector2(transformed_vector, &affine->distortion, initial_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
||||||
|
|
@ -1,31 +1,31 @@
|
||||||
#include "affine3.h"
|
#include "affine3.h"
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine3_reset(BGC_FP32_Affine3 * affine);
|
extern inline void bgc_fp32_affine3_reset(BGC_FP32_Affine3* affine);
|
||||||
extern inline void bgc_fp64_affine3_reset(BGC_FP64_Affine3 * affine);
|
extern inline void bgc_fp64_affine3_reset(BGC_FP64_Affine3* affine);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine3_make(const BGC_FP32_Matrix3x3 * distortion, const BGC_FP32_Vector3 * shift, BGC_FP32_Affine3 * affine);
|
extern inline void bgc_fp32_affine3_make(BGC_FP32_Affine3* affine, const BGC_FP32_Matrix3x3* distortion, const BGC_FP32_Vector3* shift);
|
||||||
extern inline void bgc_fp64_affine3_make(const BGC_FP64_Matrix3x3 * distortion, const BGC_FP64_Vector3 * shift, BGC_FP64_Affine3 * affine);
|
extern inline void bgc_fp64_affine3_make(BGC_FP64_Affine3* affine, const BGC_FP64_Matrix3x3* distortion, const BGC_FP64_Vector3* shift);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine3_copy(const BGC_FP32_Affine3 * source, BGC_FP32_Affine3 * destination);
|
extern inline void bgc_fp32_affine3_copy(BGC_FP32_Affine3* destination, const BGC_FP32_Affine3* source);
|
||||||
extern inline void bgc_fp64_affine3_copy(const BGC_FP64_Affine3 * source, BGC_FP64_Affine3 * destination);
|
extern inline void bgc_fp64_affine3_copy(BGC_FP64_Affine3* destination, const BGC_FP64_Affine3* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine3_swap(BGC_FP32_Affine3 * first, BGC_FP32_Affine3 * second);
|
extern inline void bgc_fp32_affine3_swap(BGC_FP32_Affine3* first, BGC_FP32_Affine3* second);
|
||||||
extern inline void bgc_fp64_affine3_swap(BGC_FP64_Affine3 * first, BGC_FP64_Affine3 * second);
|
extern inline void bgc_fp64_affine3_swap(BGC_FP64_Affine3* first, BGC_FP64_Affine3* second);
|
||||||
|
|
||||||
extern inline void bgc_fp64_affine3_convert_to_fp32(const BGC_FP64_Affine3 * source, BGC_FP32_Affine3 * destination);
|
extern inline void bgc_fp32_affine3_convert_to_fp64(BGC_FP64_Affine3* destination, const BGC_FP32_Affine3* source);
|
||||||
extern inline void bgc_fp32_affine3_convert_to_fp64(const BGC_FP32_Affine3 * source, BGC_FP64_Affine3 * destination);
|
extern inline void bgc_fp64_affine3_convert_to_fp32(BGC_FP32_Affine3* destination, const BGC_FP64_Affine3* source);
|
||||||
|
|
||||||
extern inline int bgc_fp32_affine3_invert(BGC_FP32_Affine3 * affine);
|
extern inline int bgc_fp32_affine3_invert(BGC_FP32_Affine3* affine);
|
||||||
extern inline int bgc_fp64_affine3_invert(BGC_FP64_Affine3 * affine);
|
extern inline int bgc_fp64_affine3_invert(BGC_FP64_Affine3* affine);
|
||||||
|
|
||||||
extern inline int bgc_fp32_affine3_get_inverse(const BGC_FP32_Affine3 * source, BGC_FP32_Affine3 * destination);
|
extern inline int bgc_fp32_affine3_get_inverse(BGC_FP32_Affine3* inverse, const BGC_FP32_Affine3* affine);
|
||||||
extern inline int bgc_fp64_affine3_get_inverse(const BGC_FP64_Affine3 * source, BGC_FP64_Affine3 * destination);
|
extern inline int bgc_fp64_affine3_get_inverse(BGC_FP64_Affine3* inverse, const BGC_FP64_Affine3* affine);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine3_combine(const BGC_FP32_Affine3 * first, const BGC_FP32_Affine3 * second, BGC_FP32_Affine3 * combination);
|
extern inline void bgc_fp32_affine3_combine(BGC_FP32_Affine3* combination, const BGC_FP32_Affine3* first, const BGC_FP32_Affine3* second);
|
||||||
extern inline void bgc_fp64_affine3_combine(const BGC_FP64_Affine3 * first, const BGC_FP64_Affine3 * second, BGC_FP64_Affine3 * combination);
|
extern inline void bgc_fp64_affine3_combine(BGC_FP64_Affine3* combination, const BGC_FP64_Affine3* first, const BGC_FP64_Affine3* second);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine3_transform_point(const BGC_FP32_Affine3 * affine, const BGC_FP32_Vector3 * initial_point, BGC_FP32_Vector3 * transformed_point);
|
extern inline void bgc_fp32_affine3_transform_point(BGC_FP32_Vector3* transformed_point, const BGC_FP32_Affine3* affine, const BGC_FP32_Vector3* initial_point);
|
||||||
extern inline void bgc_fp64_affine3_transform_point(const BGC_FP64_Affine3 * affine, const BGC_FP64_Vector3 * initial_point, BGC_FP64_Vector3 * transformed_point);
|
extern inline void bgc_fp64_affine3_transform_point(BGC_FP64_Vector3* transformed_point, const BGC_FP64_Affine3* affine, const BGC_FP64_Vector3* initial_point);
|
||||||
|
|
||||||
extern inline void bgc_fp32_affine3_transform_vector(const BGC_FP32_Affine3 * affine, const BGC_FP32_Vector3 * initial_vector, BGC_FP32_Vector3 * transformed_vector);
|
extern inline void bgc_fp32_affine3_transform_vector(BGC_FP32_Vector3* transformed_vector, const BGC_FP32_Affine3* affine, const BGC_FP32_Vector3* initial_vector);
|
||||||
extern inline void bgc_fp64_affine3_transform_vector(const BGC_FP64_Affine3 * affine, const BGC_FP64_Vector3 * initial_vector, BGC_FP64_Vector3 * transformed_vector);
|
extern inline void bgc_fp64_affine3_transform_vector(BGC_FP64_Vector3* transformed_vector, const BGC_FP64_Affine3* affine, const BGC_FP64_Vector3* initial_vector);
|
||||||
|
|
|
||||||
|
|
@ -2,7 +2,7 @@
|
||||||
#define _BGC_AFFINE3_H_INCLUDED_
|
#define _BGC_AFFINE3_H_INCLUDED_
|
||||||
|
|
||||||
#include "vector3.h"
|
#include "vector3.h"
|
||||||
#include "matrixes.h"
|
#include "matrices.h"
|
||||||
#include "matrix3x3.h"
|
#include "matrix3x3.h"
|
||||||
|
|
||||||
// ==================== Types ==================== //
|
// ==================== Types ==================== //
|
||||||
|
|
@ -33,58 +33,58 @@ inline void bgc_fp64_affine3_reset(BGC_FP64_Affine3 * affine)
|
||||||
|
|
||||||
// ==================== Make ===================== //
|
// ==================== Make ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine3_make(const BGC_FP32_Matrix3x3 * distortion, const BGC_FP32_Vector3 * shift, BGC_FP32_Affine3 * affine)
|
inline void bgc_fp32_affine3_make(BGC_FP32_Affine3* affine, const BGC_FP32_Matrix3x3 * distortion, const BGC_FP32_Vector3 * shift)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix3x3_copy(distortion, &affine->distortion);
|
bgc_fp32_matrix3x3_copy(&affine->distortion, distortion);
|
||||||
bgc_fp32_vector3_copy(shift, &affine->shift);
|
bgc_fp32_vector3_copy(&affine->shift, shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine3_make(const BGC_FP64_Matrix3x3 * distortion, const BGC_FP64_Vector3 * shift, BGC_FP64_Affine3 * affine)
|
inline void bgc_fp64_affine3_make(BGC_FP64_Affine3* affine, const BGC_FP64_Matrix3x3 * distortion, const BGC_FP64_Vector3 * shift)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix3x3_copy(distortion, &affine->distortion);
|
bgc_fp64_matrix3x3_copy(&affine->distortion, distortion);
|
||||||
bgc_fp64_vector3_copy(shift, &affine->shift);
|
bgc_fp64_vector3_copy(&affine->shift, shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ==================== Copy ===================== //
|
// ==================== Copy ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine3_copy(const BGC_FP32_Affine3 * source, BGC_FP32_Affine3 * destination)
|
inline void bgc_fp32_affine3_copy(BGC_FP32_Affine3* destination, const BGC_FP32_Affine3 * source)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix3x3_copy(&source->distortion, &destination->distortion);
|
bgc_fp32_matrix3x3_copy(&destination->distortion, &source->distortion);
|
||||||
bgc_fp32_vector3_copy(&source->shift, &destination->shift);
|
bgc_fp32_vector3_copy(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine3_copy(const BGC_FP64_Affine3 * source, BGC_FP64_Affine3 * destination)
|
inline void bgc_fp64_affine3_copy(BGC_FP64_Affine3* destination, const BGC_FP64_Affine3 * source)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix3x3_copy(&source->distortion, &destination->distortion);
|
bgc_fp64_matrix3x3_copy(&destination->distortion, &source->distortion);
|
||||||
bgc_fp64_vector3_copy(&source->shift, &destination->shift);
|
bgc_fp64_vector3_copy(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ==================== Swap ===================== //
|
// ==================== Swap ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine3_swap(BGC_FP32_Affine3 * first, BGC_FP32_Affine3 * second)
|
inline void bgc_fp32_affine3_swap(BGC_FP32_Affine3 * first, BGC_FP32_Affine3 * second)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix3x3_copy(&first->distortion, &second->distortion);
|
bgc_fp32_matrix3x3_swap(&first->distortion, &second->distortion);
|
||||||
bgc_fp32_vector3_copy(&first->shift, &second->shift);
|
bgc_fp32_vector3_swap(&first->shift, &second->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine3_swap(BGC_FP64_Affine3 * first, BGC_FP64_Affine3 * second)
|
inline void bgc_fp64_affine3_swap(BGC_FP64_Affine3 * first, BGC_FP64_Affine3 * second)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix3x3_copy(&first->distortion, &second->distortion);
|
bgc_fp64_matrix3x3_swap(&first->distortion, &second->distortion);
|
||||||
bgc_fp64_vector3_copy(&first->shift, &second->shift);
|
bgc_fp64_vector3_swap(&first->shift, &second->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Convert =================== //
|
// =================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_affine3_convert_to_fp32(const BGC_FP64_Affine3 * source, BGC_FP32_Affine3 * destination)
|
inline void bgc_fp32_affine3_convert_to_fp64(BGC_FP64_Affine3* destination, const BGC_FP32_Affine3 * source)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix3x3_convert_to_fp32(&source->distortion, &destination->distortion);
|
bgc_fp32_matrix3x3_convert_to_fp64(&destination->distortion, &source->distortion);
|
||||||
bgc_fp64_vector3_convert_to_fp32(&source->shift, &destination->shift);
|
bgc_fp32_vector3_convert_to_fp64(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_affine3_convert_to_fp64(const BGC_FP32_Affine3 * source, BGC_FP64_Affine3 * destination)
|
inline void bgc_fp64_affine3_convert_to_fp32(BGC_FP32_Affine3* destination, const BGC_FP64_Affine3* source)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix3x3_convert_to_fp64(&source->distortion, &destination->distortion);
|
bgc_fp64_matrix3x3_convert_to_fp32(&destination->distortion, &source->distortion);
|
||||||
bgc_fp32_vector3_convert_to_fp64(&source->shift, &destination->shift);
|
bgc_fp64_vector3_convert_to_fp32(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Invert ==================== //
|
// =================== Invert ==================== //
|
||||||
|
|
@ -95,7 +95,7 @@ inline int bgc_fp32_affine3_invert(BGC_FP32_Affine3 * affine)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp32_multiply_matrix3x3_by_vector3(&affine->distortion, &affine->shift, &affine->shift);
|
bgc_fp32_multiply_matrix3x3_by_vector3(&affine->shift, &affine->distortion, &affine->shift);
|
||||||
bgc_fp32_vector3_revert(&affine->shift);
|
bgc_fp32_vector3_revert(&affine->shift);
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
|
|
@ -107,7 +107,7 @@ inline int bgc_fp64_affine3_invert(BGC_FP64_Affine3 * affine)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp64_multiply_matrix3x3_by_vector3(&affine->distortion, &affine->shift, &affine->shift);
|
bgc_fp64_multiply_matrix3x3_by_vector3(&affine->shift, &affine->distortion, &affine->shift);
|
||||||
bgc_fp64_vector3_revert(&affine->shift);
|
bgc_fp64_vector3_revert(&affine->shift);
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
|
|
@ -115,25 +115,25 @@ inline int bgc_fp64_affine3_invert(BGC_FP64_Affine3 * affine)
|
||||||
|
|
||||||
// ================= Get Inverse ================= //
|
// ================= Get Inverse ================= //
|
||||||
|
|
||||||
inline int bgc_fp32_affine3_get_inverse(const BGC_FP32_Affine3 * source, BGC_FP32_Affine3 * destination)
|
inline int bgc_fp32_affine3_get_inverse(BGC_FP32_Affine3* destination, const BGC_FP32_Affine3 * source)
|
||||||
{
|
{
|
||||||
if (!bgc_fp32_matrix3x3_get_inverse(&source->distortion, &destination->distortion)) {
|
if (!bgc_fp32_matrix3x3_get_inverse(&destination->distortion, &source->distortion)) {
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp32_multiply_matrix3x3_by_vector3(&destination->distortion, &source->shift, &destination->shift);
|
bgc_fp32_multiply_matrix3x3_by_vector3(&destination->shift, &destination->distortion, &source->shift);
|
||||||
bgc_fp32_vector3_revert(&destination->shift);
|
bgc_fp32_vector3_revert(&destination->shift);
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_affine3_get_inverse(const BGC_FP64_Affine3 * source, BGC_FP64_Affine3 * destination)
|
inline int bgc_fp64_affine3_get_inverse(BGC_FP64_Affine3* destination, const BGC_FP64_Affine3 * source)
|
||||||
{
|
{
|
||||||
if (!bgc_fp64_matrix3x3_get_inverse(&source->distortion, &destination->distortion)) {
|
if (!bgc_fp64_matrix3x3_get_inverse(&destination->distortion, &source->distortion)) {
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp64_multiply_matrix3x3_by_vector3(&destination->distortion, &source->shift, &destination->shift);
|
bgc_fp64_multiply_matrix3x3_by_vector3(&destination->shift, &destination->distortion, &source->shift);
|
||||||
bgc_fp64_vector3_revert(&destination->shift);
|
bgc_fp64_vector3_revert(&destination->shift);
|
||||||
|
|
||||||
return 1;
|
return 1;
|
||||||
|
|
@ -141,48 +141,48 @@ inline int bgc_fp64_affine3_get_inverse(const BGC_FP64_Affine3 * source, BGC_FP6
|
||||||
|
|
||||||
// =================== Combine =================== //
|
// =================== Combine =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine3_combine(const BGC_FP32_Affine3 * first, const BGC_FP32_Affine3 * second, BGC_FP32_Affine3 * combination)
|
inline void bgc_fp32_affine3_combine(BGC_FP32_Affine3* combination, const BGC_FP32_Affine3 * first, const BGC_FP32_Affine3 * second)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector3 first_shift;
|
BGC_FP32_Vector3 first_shift;
|
||||||
bgc_fp32_multiply_matrix3x3_by_vector3(&second->distortion, &first->shift, &first_shift);
|
bgc_fp32_multiply_matrix3x3_by_vector3(&first_shift, &second->distortion, &first->shift);
|
||||||
bgc_fp32_multiply_matrix3x3_by_matrix3x3(&second->distortion, &first->distortion, &combination->distortion);
|
bgc_fp32_multiply_matrix3x3_by_matrix3x3(&combination->distortion, &second->distortion, &first->distortion);
|
||||||
bgc_fp32_vector3_add(&first_shift, &second->shift, &combination->shift);
|
bgc_fp32_vector3_add(&combination->shift, &first_shift, &second->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine3_combine(const BGC_FP64_Affine3 * first, const BGC_FP64_Affine3 * second, BGC_FP64_Affine3 * combination)
|
inline void bgc_fp64_affine3_combine(BGC_FP64_Affine3* combination, const BGC_FP64_Affine3 * first, const BGC_FP64_Affine3 * second)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector3 first_shift;
|
BGC_FP64_Vector3 first_shift;
|
||||||
bgc_fp64_multiply_matrix3x3_by_vector3(&second->distortion, &first->shift, &first_shift);
|
bgc_fp64_multiply_matrix3x3_by_vector3(&first_shift, &second->distortion, &first->shift);
|
||||||
bgc_fp64_multiply_matrix3x3_by_matrix3x3(&second->distortion, &first->distortion, &combination->distortion);
|
bgc_fp64_multiply_matrix3x3_by_matrix3x3(&combination->distortion, &second->distortion, &first->distortion);
|
||||||
bgc_fp64_vector3_add(&first_shift, &second->shift, &combination->shift);
|
bgc_fp64_vector3_add(&combination->shift, &first_shift, &second->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =============== Transform Point =============== //
|
// =============== Transform Point =============== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine3_transform_point(const BGC_FP32_Affine3 * affine, const BGC_FP32_Vector3 * initial_point, BGC_FP32_Vector3 * transformed_point)
|
inline void bgc_fp32_affine3_transform_point(BGC_FP32_Vector3* transformed_point, const BGC_FP32_Affine3 * affine, const BGC_FP32_Vector3 * initial_point)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector3 distorted;
|
BGC_FP32_Vector3 distorted;
|
||||||
bgc_fp32_multiply_matrix3x3_by_vector3(&affine->distortion, initial_point, &distorted);
|
bgc_fp32_multiply_matrix3x3_by_vector3(&distorted, &affine->distortion, initial_point);
|
||||||
bgc_fp32_vector3_add(&affine->shift, &distorted, transformed_point);
|
bgc_fp32_vector3_add(transformed_point, &affine->shift, &distorted);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine3_transform_point(const BGC_FP64_Affine3 * affine, const BGC_FP64_Vector3 * initial_point, BGC_FP64_Vector3 * transformed_point)
|
inline void bgc_fp64_affine3_transform_point(BGC_FP64_Vector3* transformed_point, const BGC_FP64_Affine3 * affine, const BGC_FP64_Vector3 * initial_point)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector3 distorted;
|
BGC_FP64_Vector3 distorted;
|
||||||
bgc_fp64_multiply_matrix3x3_by_vector3(&affine->distortion, initial_point, &distorted);
|
bgc_fp64_multiply_matrix3x3_by_vector3(&distorted, &affine->distortion, initial_point);
|
||||||
bgc_fp64_vector3_add(&affine->shift, &distorted, transformed_point);
|
bgc_fp64_vector3_add(transformed_point, &affine->shift, &distorted);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============== Transform Vector =============== //
|
// ============== Transform Vector =============== //
|
||||||
|
|
||||||
inline void bgc_fp32_affine3_transform_vector(const BGC_FP32_Affine3 * affine, const BGC_FP32_Vector3 * initial_vector, BGC_FP32_Vector3 * transformed_vector)
|
inline void bgc_fp32_affine3_transform_vector(BGC_FP32_Vector3* transformed_vector, const BGC_FP32_Affine3 * affine, const BGC_FP32_Vector3 * initial_vector)
|
||||||
{
|
{
|
||||||
bgc_fp32_multiply_matrix3x3_by_vector3(&affine->distortion, initial_vector, transformed_vector);
|
bgc_fp32_multiply_matrix3x3_by_vector3(transformed_vector, &affine->distortion, initial_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_affine3_transform_vector(const BGC_FP64_Affine3 * affine, const BGC_FP64_Vector3 * initial_vector, BGC_FP64_Vector3 * transformed_vector)
|
inline void bgc_fp64_affine3_transform_vector(BGC_FP64_Vector3* transformed_vector, const BGC_FP64_Affine3 * affine, const BGC_FP64_Vector3 * initial_vector)
|
||||||
{
|
{
|
||||||
bgc_fp64_multiply_matrix3x3_by_vector3(&affine->distortion, initial_vector, transformed_vector);
|
bgc_fp64_multiply_matrix3x3_by_vector3(transformed_vector, &affine->distortion, initial_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
||||||
|
|
@ -8,14 +8,14 @@
|
||||||
#include "./vector2.h"
|
#include "./vector2.h"
|
||||||
#include "./vector3.h"
|
#include "./vector3.h"
|
||||||
|
|
||||||
#include "./matrixes.h"
|
#include "./matrices.h"
|
||||||
#include "./matrix2x2.h"
|
#include "./matrix2x2.h"
|
||||||
#include "./matrix2x3.h"
|
#include "./matrix2x3.h"
|
||||||
#include "./matrix3x2.h"
|
#include "./matrix3x2.h"
|
||||||
#include "./matrix3x3.h"
|
#include "./matrix3x3.h"
|
||||||
|
|
||||||
#include "./affine2.h"
|
#include "./affine2.h"
|
||||||
#include "./affine3.h"
|
#include "./affine3.h"
|
||||||
|
|
||||||
#include "./complex.h"
|
#include "./complex.h"
|
||||||
#include "./cotes-number.h"
|
#include "./cotes-number.h"
|
||||||
|
|
@ -25,8 +25,8 @@
|
||||||
#include "./quaternion.h"
|
#include "./quaternion.h"
|
||||||
#include "./versor.h"
|
#include "./versor.h"
|
||||||
#include "./slerp.h"
|
#include "./slerp.h"
|
||||||
|
|
||||||
#include "./position2.h"
|
#include "./position2.h"
|
||||||
#include "./position3.h"
|
#include "./position3.h"
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
||||||
|
|
@ -1,4 +1,4 @@
|
||||||
<?xml version="1.0" encoding="utf-8"?>
|
<?xml version="1.0" encoding="utf-8"?>
|
||||||
<Project DefaultTargets="Build" xmlns="http://schemas.microsoft.com/developer/msbuild/2003">
|
<Project DefaultTargets="Build" xmlns="http://schemas.microsoft.com/developer/msbuild/2003">
|
||||||
<ItemGroup Label="ProjectConfigurations">
|
<ItemGroup Label="ProjectConfigurations">
|
||||||
<ProjectConfiguration Include="Debug|Win32">
|
<ProjectConfiguration Include="Debug|Win32">
|
||||||
|
|
@ -29,7 +29,7 @@
|
||||||
<ClInclude Include="matrix2x3.h" />
|
<ClInclude Include="matrix2x3.h" />
|
||||||
<ClInclude Include="matrix3x2.h" />
|
<ClInclude Include="matrix3x2.h" />
|
||||||
<ClInclude Include="matrix3x3.h" />
|
<ClInclude Include="matrix3x3.h" />
|
||||||
<ClInclude Include="matrixes.h" />
|
<ClInclude Include="matrices.h" />
|
||||||
<ClInclude Include="position2.h" />
|
<ClInclude Include="position2.h" />
|
||||||
<ClInclude Include="position3.h" />
|
<ClInclude Include="position3.h" />
|
||||||
<ClInclude Include="quaternion.h" />
|
<ClInclude Include="quaternion.h" />
|
||||||
|
|
@ -54,7 +54,7 @@
|
||||||
<ClCompile Include="matrix2x3.c" />
|
<ClCompile Include="matrix2x3.c" />
|
||||||
<ClCompile Include="matrix3x2.c" />
|
<ClCompile Include="matrix3x2.c" />
|
||||||
<ClCompile Include="matrix3x3.c" />
|
<ClCompile Include="matrix3x3.c" />
|
||||||
<ClCompile Include="matrixes.c" />
|
<ClCompile Include="matrices.c" />
|
||||||
<ClCompile Include="quaternion.c" />
|
<ClCompile Include="quaternion.c" />
|
||||||
<ClCompile Include="rotation3.c" />
|
<ClCompile Include="rotation3.c" />
|
||||||
<ClCompile Include="slerp.c" />
|
<ClCompile Include="slerp.c" />
|
||||||
|
|
|
||||||
|
|
@ -57,7 +57,7 @@
|
||||||
<ClInclude Include="matrix3x2.h">
|
<ClInclude Include="matrix3x2.h">
|
||||||
<Filter>Файлы заголовков</Filter>
|
<Filter>Файлы заголовков</Filter>
|
||||||
</ClInclude>
|
</ClInclude>
|
||||||
<ClInclude Include="matrixes.h">
|
<ClInclude Include="matrices.h">
|
||||||
<Filter>Файлы заголовков</Filter>
|
<Filter>Файлы заголовков</Filter>
|
||||||
</ClInclude>
|
</ClInclude>
|
||||||
<ClInclude Include="complex.c">
|
<ClInclude Include="complex.c">
|
||||||
|
|
@ -113,7 +113,7 @@
|
||||||
<ClCompile Include="quaternion.c">
|
<ClCompile Include="quaternion.c">
|
||||||
<Filter>Исходные файлы</Filter>
|
<Filter>Исходные файлы</Filter>
|
||||||
</ClCompile>
|
</ClCompile>
|
||||||
<ClCompile Include="matrixes.c">
|
<ClCompile Include="matrices.c">
|
||||||
<Filter>Исходные файлы</Filter>
|
<Filter>Исходные файлы</Filter>
|
||||||
</ClCompile>
|
</ClCompile>
|
||||||
<ClCompile Include="matrix2x3.c">
|
<ClCompile Include="matrix2x3.c">
|
||||||
|
|
|
||||||
|
|
@ -3,8 +3,8 @@
|
||||||
extern inline void bgc_fp32_complex_reset(BGC_FP32_Complex* complex);
|
extern inline void bgc_fp32_complex_reset(BGC_FP32_Complex* complex);
|
||||||
extern inline void bgc_fp64_complex_reset(BGC_FP64_Complex* complex);
|
extern inline void bgc_fp64_complex_reset(BGC_FP64_Complex* complex);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_make(const float real, const float imaginary, BGC_FP32_Complex* complex);
|
extern inline void bgc_fp32_complex_make(BGC_FP32_Complex* complex, const float real, const float imaginary);
|
||||||
extern inline void bgc_fp64_complex_make(const double real, const double imaginary, BGC_FP64_Complex* complex);
|
extern inline void bgc_fp64_complex_make(BGC_FP64_Complex* complex, const double real, const double imaginary);
|
||||||
|
|
||||||
extern inline float bgc_fp32_complex_get_square_modulus(const BGC_FP32_Complex* number);
|
extern inline float bgc_fp32_complex_get_square_modulus(const BGC_FP32_Complex* number);
|
||||||
extern inline double bgc_fp64_complex_get_square_modulus(const BGC_FP64_Complex* number);
|
extern inline double bgc_fp64_complex_get_square_modulus(const BGC_FP64_Complex* number);
|
||||||
|
|
@ -18,75 +18,75 @@ extern inline int bgc_fp64_complex_is_zero(const BGC_FP64_Complex* number);
|
||||||
extern inline int bgc_fp32_complex_is_unit(const BGC_FP32_Complex* number);
|
extern inline int bgc_fp32_complex_is_unit(const BGC_FP32_Complex* number);
|
||||||
extern inline int bgc_fp64_complex_is_unit(const BGC_FP64_Complex* number);
|
extern inline int bgc_fp64_complex_is_unit(const BGC_FP64_Complex* number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_copy(const BGC_FP32_Complex* source, BGC_FP32_Complex* destination);
|
extern inline void bgc_fp32_complex_copy(BGC_FP32_Complex* destination, const BGC_FP32_Complex* source);
|
||||||
extern inline void bgc_fp64_complex_copy(const BGC_FP64_Complex* source, BGC_FP64_Complex* destination);
|
extern inline void bgc_fp64_complex_copy(BGC_FP64_Complex* destination, const BGC_FP64_Complex* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_swap(BGC_FP32_Complex* number1, BGC_FP32_Complex* number2);
|
extern inline void bgc_fp32_complex_swap(BGC_FP32_Complex* number1, BGC_FP32_Complex* number2);
|
||||||
extern inline void bgc_fp64_complex_swap(BGC_FP64_Complex* number1, BGC_FP64_Complex* number2);
|
extern inline void bgc_fp64_complex_swap(BGC_FP64_Complex* number1, BGC_FP64_Complex* number2);
|
||||||
|
|
||||||
extern inline void bgc_fp64_complex_convert_to_fp32(const BGC_FP64_Complex* source, BGC_FP32_Complex* destination);
|
extern inline void bgc_fp64_complex_convert_to_fp32(BGC_FP32_Complex* destination, const BGC_FP64_Complex* source);
|
||||||
extern inline void bgc_fp32_complex_convert_to_fp64(const BGC_FP32_Complex* source, BGC_FP64_Complex* destination);
|
extern inline void bgc_fp32_complex_convert_to_fp64(BGC_FP64_Complex* destination, const BGC_FP32_Complex* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_revert(BGC_FP32_Complex* number);
|
extern inline void bgc_fp32_complex_revert(BGC_FP32_Complex* number);
|
||||||
extern inline void bgc_fp64_complex_revert(BGC_FP64_Complex* number);
|
extern inline void bgc_fp64_complex_revert(BGC_FP64_Complex* number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_get_reverse(const BGC_FP32_Complex* number, BGC_FP32_Complex* opposite);
|
extern inline void bgc_fp32_complex_get_reverse(BGC_FP32_Complex* reverse, const BGC_FP32_Complex* number);
|
||||||
extern inline void bgc_fp64_complex_get_reverse(const BGC_FP64_Complex* number, BGC_FP64_Complex* opposite);
|
extern inline void bgc_fp64_complex_get_reverse(BGC_FP64_Complex* reverse, const BGC_FP64_Complex* number);
|
||||||
|
|
||||||
extern inline int bgc_fp32_complex_normalize(BGC_FP32_Complex* number);
|
extern inline int bgc_fp32_complex_normalize(BGC_FP32_Complex* number);
|
||||||
extern inline int bgc_fp64_complex_normalize(BGC_FP64_Complex* number);
|
extern inline int bgc_fp64_complex_normalize(BGC_FP64_Complex* number);
|
||||||
|
|
||||||
extern inline int bgc_fp32_complex_get_normalized(const BGC_FP32_Complex* number, BGC_FP32_Complex* normalized);
|
extern inline int bgc_fp32_complex_get_normalized(BGC_FP32_Complex* normalized, const BGC_FP32_Complex* number);
|
||||||
extern inline int bgc_fp64_complex_get_normalized(const BGC_FP64_Complex* number, BGC_FP64_Complex* normalized);
|
extern inline int bgc_fp64_complex_get_normalized(BGC_FP64_Complex* normalized, const BGC_FP64_Complex* number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_conjugate(BGC_FP32_Complex* number);
|
extern inline void bgc_fp32_complex_conjugate(BGC_FP32_Complex* number);
|
||||||
extern inline void bgc_fp64_complex_conjugate(BGC_FP64_Complex* number);
|
extern inline void bgc_fp64_complex_conjugate(BGC_FP64_Complex* number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_get_conjugate(const BGC_FP32_Complex* number, BGC_FP32_Complex* conjugate);
|
extern inline void bgc_fp32_complex_get_conjugate(BGC_FP32_Complex* conjugate, const BGC_FP32_Complex* number);
|
||||||
extern inline void bgc_fp64_complex_get_conjugate(const BGC_FP64_Complex* number, BGC_FP64_Complex* conjugate);
|
extern inline void bgc_fp64_complex_get_conjugate(BGC_FP64_Complex* conjugate, const BGC_FP64_Complex* number);
|
||||||
|
|
||||||
extern inline int bgc_fp32_complex_invert(BGC_FP32_Complex* number);
|
extern inline int bgc_fp32_complex_invert(BGC_FP32_Complex* number);
|
||||||
extern inline int bgc_fp64_complex_invert(BGC_FP64_Complex* number);
|
extern inline int bgc_fp64_complex_invert(BGC_FP64_Complex* number);
|
||||||
|
|
||||||
extern inline int bgc_fp32_complex_get_inverse(const BGC_FP32_Complex* number, BGC_FP32_Complex* inverse);
|
extern inline int bgc_fp32_complex_get_inverse(BGC_FP32_Complex* inverse, const BGC_FP32_Complex* number);
|
||||||
extern inline int bgc_fp64_complex_get_inverse(const BGC_FP64_Complex* number, BGC_FP64_Complex* inverse);
|
extern inline int bgc_fp64_complex_get_inverse(BGC_FP64_Complex* inverse, const BGC_FP64_Complex* number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_get_product(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, BGC_FP32_Complex* product);
|
extern inline void bgc_fp32_complex_get_product(BGC_FP32_Complex* product, const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2);
|
||||||
extern inline void bgc_fp64_complex_get_product(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, BGC_FP64_Complex* product);
|
extern inline void bgc_fp64_complex_get_product(BGC_FP64_Complex* product, const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2);
|
||||||
|
|
||||||
extern inline int bgc_fp32_complex_get_ratio(const BGC_FP32_Complex* divident, const BGC_FP32_Complex* divisor, BGC_FP32_Complex* quotient);
|
extern inline int bgc_fp32_complex_get_ratio(BGC_FP32_Complex* quotient, const BGC_FP32_Complex* divident, const BGC_FP32_Complex* divisor);
|
||||||
extern inline int bgc_fp64_complex_get_ratio(const BGC_FP64_Complex* divident, const BGC_FP64_Complex* divisor, BGC_FP64_Complex* quotient);
|
extern inline int bgc_fp64_complex_get_ratio(BGC_FP64_Complex* quotient, const BGC_FP64_Complex* divident, const BGC_FP64_Complex* divisor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_add(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, BGC_FP32_Complex* sum);
|
extern inline void bgc_fp32_complex_add(BGC_FP32_Complex* sum, const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2);
|
||||||
extern inline void bgc_fp64_complex_add(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, BGC_FP64_Complex* sum);
|
extern inline void bgc_fp64_complex_add(BGC_FP64_Complex* sum, const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_add_scaled(const BGC_FP32_Complex* basic_number, const BGC_FP32_Complex* scalable_number, const float scale, BGC_FP32_Complex* sum);
|
extern inline void bgc_fp32_complex_add_scaled(BGC_FP32_Complex* sum, const BGC_FP32_Complex* basic_number, const BGC_FP32_Complex* scalable_number, const float scale);
|
||||||
extern inline void bgc_fp64_complex_add_scaled(const BGC_FP64_Complex* basic_number, const BGC_FP64_Complex* scalable_number, const double scale, BGC_FP64_Complex* sum);
|
extern inline void bgc_fp64_complex_add_scaled(BGC_FP64_Complex* sum, const BGC_FP64_Complex* basic_number, const BGC_FP64_Complex* scalable_number, const double scale);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_subtract(const BGC_FP32_Complex* minuend, const BGC_FP32_Complex* subtrahend, BGC_FP32_Complex* difference);
|
extern inline void bgc_fp32_complex_subtract(BGC_FP32_Complex* difference, const BGC_FP32_Complex* minuend, const BGC_FP32_Complex* subtrahend);
|
||||||
extern inline void bgc_fp64_complex_subtract(const BGC_FP64_Complex* minuend, const BGC_FP64_Complex* subtrahend, BGC_FP64_Complex* difference);
|
extern inline void bgc_fp64_complex_subtract(BGC_FP64_Complex* difference, const BGC_FP64_Complex* minuend, const BGC_FP64_Complex* subtrahend);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_multiply(const BGC_FP32_Complex* multiplicand, const float multiplier, BGC_FP32_Complex* product);
|
extern inline void bgc_fp32_complex_multiply(BGC_FP32_Complex* product, const BGC_FP32_Complex* multiplicand, const float multiplier);
|
||||||
extern inline void bgc_fp64_complex_multiply(const BGC_FP64_Complex* multiplicand, const double multiplier, BGC_FP64_Complex* product);
|
extern inline void bgc_fp64_complex_multiply(BGC_FP64_Complex* product, const BGC_FP64_Complex* multiplicand, const double multiplier);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_divide(const BGC_FP32_Complex* dividend, const float divisor, BGC_FP32_Complex* quotient);
|
extern inline void bgc_fp32_complex_divide(BGC_FP32_Complex* quotient, const BGC_FP32_Complex* dividend, const float divisor);
|
||||||
extern inline void bgc_fp64_complex_divide(const BGC_FP64_Complex* dividend, const double divisor, BGC_FP64_Complex* quotient);
|
extern inline void bgc_fp64_complex_divide(BGC_FP64_Complex* quotient, const BGC_FP64_Complex* dividend, const double divisor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_get_mean2(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, BGC_FP32_Complex* mean);
|
extern inline void bgc_fp32_complex_get_mean2(BGC_FP32_Complex* mean, const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2);
|
||||||
extern inline void bgc_fp64_complex_get_mean2(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, BGC_FP64_Complex* mean);
|
extern inline void bgc_fp64_complex_get_mean2(BGC_FP64_Complex* mean, const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_get_mean3(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, const BGC_FP32_Complex* number3, BGC_FP32_Complex* mean);
|
extern inline void bgc_fp32_complex_get_mean3(BGC_FP32_Complex* mean, const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, const BGC_FP32_Complex* number3);
|
||||||
extern inline void bgc_fp64_complex_get_mean3(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, const BGC_FP64_Complex* number3, BGC_FP64_Complex* mean);
|
extern inline void bgc_fp64_complex_get_mean3(BGC_FP64_Complex* mean, const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, const BGC_FP64_Complex* number3);
|
||||||
|
|
||||||
extern inline void bgc_fp32_complex_interpolate(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, const float phase, BGC_FP32_Complex* interpolation);
|
extern inline void bgc_fp32_complex_interpolate(BGC_FP32_Complex* interpolation, const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, const float phase);
|
||||||
extern inline void bgc_fp64_complex_interpolate(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, const double phase, BGC_FP64_Complex* interpolation);
|
extern inline void bgc_fp64_complex_interpolate(BGC_FP64_Complex* interpolation, const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, const double phase);
|
||||||
|
|
||||||
extern inline int bgc_fp32_complex_are_close(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2);
|
extern inline int bgc_fp32_complex_are_close(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2);
|
||||||
extern inline int bgc_fp64_complex_are_close(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2);
|
extern inline int bgc_fp64_complex_are_close(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2);
|
||||||
|
|
||||||
// =============== Get Exponation =============== //
|
// =============== Get Exponation =============== //
|
||||||
|
|
||||||
void bgc_fp32_complex_get_exponation(const BGC_FP32_Complex* base, const float real_exponent, const float imaginary_exponent, BGC_FP32_Complex* power)
|
void bgc_fp32_complex_get_exponation(BGC_FP32_Complex* power, const BGC_FP32_Complex* base, const float real_exponent, const float imaginary_exponent)
|
||||||
{
|
{
|
||||||
const float square_modulus = bgc_fp32_complex_get_square_modulus(base);
|
const float square_modulus = bgc_fp32_complex_get_square_modulus(base);
|
||||||
|
|
||||||
|
|
@ -106,7 +106,7 @@ void bgc_fp32_complex_get_exponation(const BGC_FP32_Complex* base, const float r
|
||||||
power->imaginary = power_modulus * sinf(power_angle);
|
power->imaginary = power_modulus * sinf(power_angle);
|
||||||
}
|
}
|
||||||
|
|
||||||
void bgc_fp64_complex_get_exponation(const BGC_FP64_Complex* base, const double real_exponent, const double imaginary_exponent, BGC_FP64_Complex* power)
|
void bgc_fp64_complex_get_exponation(BGC_FP64_Complex* power, const BGC_FP64_Complex* base, const double real_exponent, const double imaginary_exponent)
|
||||||
{
|
{
|
||||||
const double square_modulus = bgc_fp64_complex_get_square_modulus(base);
|
const double square_modulus = bgc_fp64_complex_get_square_modulus(base);
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -32,13 +32,13 @@ inline void bgc_fp64_complex_reset(BGC_FP64_Complex* complex)
|
||||||
|
|
||||||
// ==================== Set ===================== //
|
// ==================== Set ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_complex_make(const float real, const float imaginary, BGC_FP32_Complex* complex)
|
inline void bgc_fp32_complex_make(BGC_FP32_Complex* complex, const float real, const float imaginary)
|
||||||
{
|
{
|
||||||
complex->real = real;
|
complex->real = real;
|
||||||
complex->imaginary = imaginary;
|
complex->imaginary = imaginary;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_make(const double real, const double imaginary, BGC_FP64_Complex* complex)
|
inline void bgc_fp64_complex_make(BGC_FP64_Complex* complex, const double real, const double imaginary)
|
||||||
{
|
{
|
||||||
complex->real = real;
|
complex->real = real;
|
||||||
complex->imaginary = imaginary;
|
complex->imaginary = imaginary;
|
||||||
|
|
@ -90,13 +90,13 @@ inline int bgc_fp64_complex_is_unit(const BGC_FP64_Complex* number)
|
||||||
|
|
||||||
// ==================== Copy ==================== //
|
// ==================== Copy ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_complex_copy(const BGC_FP32_Complex* source, BGC_FP32_Complex* destination)
|
inline void bgc_fp32_complex_copy(BGC_FP32_Complex* destination, const BGC_FP32_Complex* source)
|
||||||
{
|
{
|
||||||
destination->real = source->real;
|
destination->real = source->real;
|
||||||
destination->imaginary = source->imaginary;
|
destination->imaginary = source->imaginary;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_copy(const BGC_FP64_Complex* source, BGC_FP64_Complex* destination)
|
inline void bgc_fp64_complex_copy(BGC_FP64_Complex* destination, const BGC_FP64_Complex* source)
|
||||||
{
|
{
|
||||||
destination->real = source->real;
|
destination->real = source->real;
|
||||||
destination->imaginary = source->imaginary;
|
destination->imaginary = source->imaginary;
|
||||||
|
|
@ -130,13 +130,13 @@ inline void bgc_fp64_complex_swap(BGC_FP64_Complex* number1, BGC_FP64_Complex* n
|
||||||
|
|
||||||
// ================== Convert =================== //
|
// ================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_complex_convert_to_fp32(const BGC_FP64_Complex* source, BGC_FP32_Complex* destination)
|
inline void bgc_fp64_complex_convert_to_fp32(BGC_FP32_Complex* destination, const BGC_FP64_Complex* source)
|
||||||
{
|
{
|
||||||
destination->real = (float)source->real;
|
destination->real = (float)source->real;
|
||||||
destination->imaginary = (float)source->imaginary;
|
destination->imaginary = (float)source->imaginary;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_complex_convert_to_fp64(const BGC_FP32_Complex* source, BGC_FP64_Complex* destination)
|
inline void bgc_fp32_complex_convert_to_fp64(BGC_FP64_Complex* destination, const BGC_FP32_Complex* source)
|
||||||
{
|
{
|
||||||
destination->real = source->real;
|
destination->real = source->real;
|
||||||
destination->imaginary = source->imaginary;
|
destination->imaginary = source->imaginary;
|
||||||
|
|
@ -156,16 +156,16 @@ inline void bgc_fp64_complex_revert(BGC_FP64_Complex* number)
|
||||||
number->imaginary = -number->imaginary;
|
number->imaginary = -number->imaginary;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_complex_get_reverse(const BGC_FP32_Complex* number, BGC_FP32_Complex* opposite)
|
inline void bgc_fp32_complex_get_reverse(BGC_FP32_Complex* reverse, const BGC_FP32_Complex* number)
|
||||||
{
|
{
|
||||||
opposite->real = -number->real;
|
reverse->real = -number->real;
|
||||||
opposite->imaginary = -number->imaginary;
|
reverse->imaginary = -number->imaginary;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_get_reverse(const BGC_FP64_Complex* number, BGC_FP64_Complex* opposite)
|
inline void bgc_fp64_complex_get_reverse(BGC_FP64_Complex* reverse, const BGC_FP64_Complex* number)
|
||||||
{
|
{
|
||||||
opposite->real = -number->real;
|
reverse->real = -number->real;
|
||||||
opposite->imaginary = -number->imaginary;
|
reverse->imaginary = -number->imaginary;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================= Normalize ================== //
|
// ================= Normalize ================== //
|
||||||
|
|
@ -210,7 +210,7 @@ inline int bgc_fp64_complex_normalize(BGC_FP64_Complex* number)
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp32_complex_get_normalized(const BGC_FP32_Complex* number, BGC_FP32_Complex* normalized)
|
inline int bgc_fp32_complex_get_normalized(BGC_FP32_Complex* normalized, const BGC_FP32_Complex* number)
|
||||||
{
|
{
|
||||||
const float square_modulus = bgc_fp32_complex_get_square_modulus(number);
|
const float square_modulus = bgc_fp32_complex_get_square_modulus(number);
|
||||||
|
|
||||||
|
|
@ -234,7 +234,7 @@ inline int bgc_fp32_complex_get_normalized(const BGC_FP32_Complex* number, BGC_F
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_complex_get_normalized(const BGC_FP64_Complex* number, BGC_FP64_Complex* normalized)
|
inline int bgc_fp64_complex_get_normalized(BGC_FP64_Complex* normalized, const BGC_FP64_Complex* number)
|
||||||
{
|
{
|
||||||
const double square_modulus = bgc_fp64_complex_get_square_modulus(number);
|
const double square_modulus = bgc_fp64_complex_get_square_modulus(number);
|
||||||
|
|
||||||
|
|
@ -270,13 +270,13 @@ inline void bgc_fp64_complex_conjugate(BGC_FP64_Complex* number)
|
||||||
number->imaginary = -number->imaginary;
|
number->imaginary = -number->imaginary;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_complex_get_conjugate(const BGC_FP32_Complex* number, BGC_FP32_Complex* conjugate)
|
inline void bgc_fp32_complex_get_conjugate(BGC_FP32_Complex* conjugate, const BGC_FP32_Complex* number)
|
||||||
{
|
{
|
||||||
conjugate->real = number->real;
|
conjugate->real = number->real;
|
||||||
conjugate->imaginary = -number->imaginary;
|
conjugate->imaginary = -number->imaginary;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_get_conjugate(const BGC_FP64_Complex* number, BGC_FP64_Complex* conjugate)
|
inline void bgc_fp64_complex_get_conjugate(BGC_FP64_Complex* conjugate, const BGC_FP64_Complex* number)
|
||||||
{
|
{
|
||||||
conjugate->real = number->real;
|
conjugate->real = number->real;
|
||||||
conjugate->imaginary = -number->imaginary;
|
conjugate->imaginary = -number->imaginary;
|
||||||
|
|
@ -284,7 +284,7 @@ inline void bgc_fp64_complex_get_conjugate(const BGC_FP64_Complex* number, BGC_F
|
||||||
|
|
||||||
// =================== Invert =================== //
|
// =================== Invert =================== //
|
||||||
|
|
||||||
inline int bgc_fp32_complex_get_inverse(const BGC_FP32_Complex* number, BGC_FP32_Complex* inverse)
|
inline int bgc_fp32_complex_get_inverse(BGC_FP32_Complex* inverse, const BGC_FP32_Complex* number)
|
||||||
{
|
{
|
||||||
const float square_modulus = bgc_fp32_complex_get_square_modulus(number);
|
const float square_modulus = bgc_fp32_complex_get_square_modulus(number);
|
||||||
|
|
||||||
|
|
@ -300,7 +300,7 @@ inline int bgc_fp32_complex_get_inverse(const BGC_FP32_Complex* number, BGC_FP32
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_complex_get_inverse(const BGC_FP64_Complex* number, BGC_FP64_Complex* inverse)
|
inline int bgc_fp64_complex_get_inverse(BGC_FP64_Complex* inverse, const BGC_FP64_Complex* number)
|
||||||
{
|
{
|
||||||
const double square_modulus = bgc_fp64_complex_get_square_modulus(number);
|
const double square_modulus = bgc_fp64_complex_get_square_modulus(number);
|
||||||
|
|
||||||
|
|
@ -328,19 +328,19 @@ inline int bgc_fp64_complex_invert(BGC_FP64_Complex* number)
|
||||||
|
|
||||||
// =============== Get Exponation =============== //
|
// =============== Get Exponation =============== //
|
||||||
|
|
||||||
void bgc_fp32_complex_get_exponation(const BGC_FP32_Complex* base, const float real_exponent, const float imaginary_exponent, BGC_FP32_Complex* power);
|
void bgc_fp32_complex_get_exponation(BGC_FP32_Complex* power, const BGC_FP32_Complex* base, const float real_exponent, const float imaginary_exponent);
|
||||||
|
|
||||||
void bgc_fp64_complex_get_exponation(const BGC_FP64_Complex* base, const double real_exponent, const double imaginary_exponent, BGC_FP64_Complex* power);
|
void bgc_fp64_complex_get_exponation(BGC_FP64_Complex* power, const BGC_FP64_Complex* base, const double real_exponent, const double imaginary_exponent);
|
||||||
|
|
||||||
// ==================== Add ===================== //
|
// ==================== Add ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_complex_add(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, BGC_FP32_Complex* sum)
|
inline void bgc_fp32_complex_add(BGC_FP32_Complex* sum, const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2)
|
||||||
{
|
{
|
||||||
sum->real = number1->real + number2->real;
|
sum->real = number1->real + number2->real;
|
||||||
sum->imaginary = number1->imaginary + number2->imaginary;
|
sum->imaginary = number1->imaginary + number2->imaginary;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_add(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, BGC_FP64_Complex* sum)
|
inline void bgc_fp64_complex_add(BGC_FP64_Complex* sum, const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2)
|
||||||
{
|
{
|
||||||
sum->real = number1->real + number2->real;
|
sum->real = number1->real + number2->real;
|
||||||
sum->imaginary = number1->imaginary + number2->imaginary;
|
sum->imaginary = number1->imaginary + number2->imaginary;
|
||||||
|
|
@ -348,13 +348,13 @@ inline void bgc_fp64_complex_add(const BGC_FP64_Complex* number1, const BGC_FP64
|
||||||
|
|
||||||
// ================= Add scaled ================= //
|
// ================= Add scaled ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_complex_add_scaled(const BGC_FP32_Complex* basic_number, const BGC_FP32_Complex* scalable_number, const float scale, BGC_FP32_Complex* sum)
|
inline void bgc_fp32_complex_add_scaled(BGC_FP32_Complex* sum, const BGC_FP32_Complex* basic_number, const BGC_FP32_Complex* scalable_number, const float scale)
|
||||||
{
|
{
|
||||||
sum->real = basic_number->real + scalable_number->real * scale;
|
sum->real = basic_number->real + scalable_number->real * scale;
|
||||||
sum->imaginary = basic_number->imaginary + scalable_number->imaginary * scale;
|
sum->imaginary = basic_number->imaginary + scalable_number->imaginary * scale;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_add_scaled(const BGC_FP64_Complex* basic_number, const BGC_FP64_Complex* scalable_number, const double scale, BGC_FP64_Complex* sum)
|
inline void bgc_fp64_complex_add_scaled(BGC_FP64_Complex* sum, const BGC_FP64_Complex* basic_number, const BGC_FP64_Complex* scalable_number, const double scale)
|
||||||
{
|
{
|
||||||
sum->real = basic_number->real + scalable_number->real * scale;
|
sum->real = basic_number->real + scalable_number->real * scale;
|
||||||
sum->imaginary = basic_number->imaginary + scalable_number->imaginary * scale;
|
sum->imaginary = basic_number->imaginary + scalable_number->imaginary * scale;
|
||||||
|
|
@ -362,7 +362,7 @@ inline void bgc_fp64_complex_add_scaled(const BGC_FP64_Complex* basic_number, co
|
||||||
|
|
||||||
// ================== Subtract ================== //
|
// ================== Subtract ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_complex_subtract(const BGC_FP32_Complex* minuend, const BGC_FP32_Complex* subtrahend, BGC_FP32_Complex* difference)
|
inline void bgc_fp32_complex_subtract(BGC_FP32_Complex* difference, const BGC_FP32_Complex* minuend, const BGC_FP32_Complex* subtrahend)
|
||||||
{
|
{
|
||||||
difference->real = minuend->real - subtrahend->real;
|
difference->real = minuend->real - subtrahend->real;
|
||||||
difference->imaginary = minuend->imaginary - subtrahend->imaginary;
|
difference->imaginary = minuend->imaginary - subtrahend->imaginary;
|
||||||
|
|
@ -376,7 +376,7 @@ inline void bgc_fp64_complex_subtract(const BGC_FP64_Complex* minuend, const BGC
|
||||||
|
|
||||||
// ================== Multiply ================== //
|
// ================== Multiply ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_complex_get_product(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, BGC_FP32_Complex* product)
|
inline void bgc_fp32_complex_get_product(BGC_FP32_Complex* product, const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2)
|
||||||
{
|
{
|
||||||
const float real = number1->real * number2->real - number1->imaginary * number2->imaginary;
|
const float real = number1->real * number2->real - number1->imaginary * number2->imaginary;
|
||||||
const float imaginary = number1->real * number2->imaginary + number1->imaginary * number2->real;
|
const float imaginary = number1->real * number2->imaginary + number1->imaginary * number2->real;
|
||||||
|
|
@ -385,7 +385,7 @@ inline void bgc_fp32_complex_get_product(const BGC_FP32_Complex* number1, const
|
||||||
product->imaginary = imaginary;
|
product->imaginary = imaginary;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_get_product(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, BGC_FP64_Complex* product)
|
inline void bgc_fp64_complex_get_product(BGC_FP64_Complex* product, const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2)
|
||||||
{
|
{
|
||||||
const double real = number1->real * number2->real - number1->imaginary * number2->imaginary;
|
const double real = number1->real * number2->real - number1->imaginary * number2->imaginary;
|
||||||
const double imaginary = number1->real * number2->imaginary + number1->imaginary * number2->real;
|
const double imaginary = number1->real * number2->imaginary + number1->imaginary * number2->real;
|
||||||
|
|
@ -396,13 +396,13 @@ inline void bgc_fp64_complex_get_product(const BGC_FP64_Complex* number1, const
|
||||||
|
|
||||||
// ============= Multiply By Number ============= //
|
// ============= Multiply By Number ============= //
|
||||||
|
|
||||||
inline void bgc_fp32_complex_multiply(const BGC_FP32_Complex* multiplicand, const float multiplier, BGC_FP32_Complex* product)
|
inline void bgc_fp32_complex_multiply(BGC_FP32_Complex* product, const BGC_FP32_Complex* multiplicand, const float multiplier)
|
||||||
{
|
{
|
||||||
product->real = multiplicand->real * multiplier;
|
product->real = multiplicand->real * multiplier;
|
||||||
product->imaginary = multiplicand->imaginary * multiplier;
|
product->imaginary = multiplicand->imaginary * multiplier;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_multiply(const BGC_FP64_Complex* multiplicand, const double multiplier, BGC_FP64_Complex* product)
|
inline void bgc_fp64_complex_multiply(BGC_FP64_Complex* product, const BGC_FP64_Complex* multiplicand, const double multiplier)
|
||||||
{
|
{
|
||||||
product->real = multiplicand->real * multiplier;
|
product->real = multiplicand->real * multiplier;
|
||||||
product->imaginary = multiplicand->imaginary * multiplier;
|
product->imaginary = multiplicand->imaginary * multiplier;
|
||||||
|
|
@ -410,7 +410,7 @@ inline void bgc_fp64_complex_multiply(const BGC_FP64_Complex* multiplicand, cons
|
||||||
|
|
||||||
// =================== Divide =================== //
|
// =================== Divide =================== //
|
||||||
|
|
||||||
inline int bgc_fp32_complex_get_ratio(const BGC_FP32_Complex* divident, const BGC_FP32_Complex* divisor, BGC_FP32_Complex* quotient)
|
inline int bgc_fp32_complex_get_ratio(BGC_FP32_Complex* quotient, const BGC_FP32_Complex* divident, const BGC_FP32_Complex* divisor)
|
||||||
{
|
{
|
||||||
const float square_modulus = bgc_fp32_complex_get_square_modulus(divisor);
|
const float square_modulus = bgc_fp32_complex_get_square_modulus(divisor);
|
||||||
|
|
||||||
|
|
@ -429,7 +429,7 @@ inline int bgc_fp32_complex_get_ratio(const BGC_FP32_Complex* divident, const BG
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_complex_get_ratio(const BGC_FP64_Complex* divident, const BGC_FP64_Complex* divisor, BGC_FP64_Complex* quotient)
|
inline int bgc_fp64_complex_get_ratio(BGC_FP64_Complex* quotient, const BGC_FP64_Complex* divident, const BGC_FP64_Complex* divisor)
|
||||||
{
|
{
|
||||||
const double square_modulus = bgc_fp64_complex_get_square_modulus(divisor);
|
const double square_modulus = bgc_fp64_complex_get_square_modulus(divisor);
|
||||||
|
|
||||||
|
|
@ -450,25 +450,25 @@ inline int bgc_fp64_complex_get_ratio(const BGC_FP64_Complex* divident, const BG
|
||||||
|
|
||||||
// ============== Divide By Number ============== //
|
// ============== Divide By Number ============== //
|
||||||
|
|
||||||
inline void bgc_fp32_complex_divide(const BGC_FP32_Complex* dividend, const float divisor, BGC_FP32_Complex* quotient)
|
inline void bgc_fp32_complex_divide(BGC_FP32_Complex* quotient, const BGC_FP32_Complex* dividend, const float divisor)
|
||||||
{
|
{
|
||||||
bgc_fp32_complex_multiply(dividend, 1.0f / divisor, quotient);
|
bgc_fp32_complex_multiply(quotient, dividend, 1.0f / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_divide(const BGC_FP64_Complex* dividend, const double divisor, BGC_FP64_Complex* quotient)
|
inline void bgc_fp64_complex_divide(BGC_FP64_Complex* quotient, const BGC_FP64_Complex* dividend, const double divisor)
|
||||||
{
|
{
|
||||||
bgc_fp64_complex_multiply(dividend, 1.0 / divisor, quotient);
|
bgc_fp64_complex_multiply(quotient, dividend, 1.0 / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================== Average2 ================== //
|
// ================== Average2 ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_complex_get_mean2(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, BGC_FP32_Complex* mean)
|
inline void bgc_fp32_complex_get_mean2(BGC_FP32_Complex* mean, const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2)
|
||||||
{
|
{
|
||||||
mean->real = (number1->real + number2->real) * 0.5f;
|
mean->real = (number1->real + number2->real) * 0.5f;
|
||||||
mean->imaginary = (number1->imaginary + number2->imaginary) * 0.5f;
|
mean->imaginary = (number1->imaginary + number2->imaginary) * 0.5f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_get_mean2(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, BGC_FP64_Complex* mean)
|
inline void bgc_fp64_complex_get_mean2(BGC_FP64_Complex* mean, const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2)
|
||||||
{
|
{
|
||||||
mean->real = (number1->real + number2->real) * 0.5;
|
mean->real = (number1->real + number2->real) * 0.5;
|
||||||
mean->imaginary = (number1->imaginary + number2->imaginary) * 0.5;
|
mean->imaginary = (number1->imaginary + number2->imaginary) * 0.5;
|
||||||
|
|
@ -476,13 +476,13 @@ inline void bgc_fp64_complex_get_mean2(const BGC_FP64_Complex* number1, const BG
|
||||||
|
|
||||||
// ================== Average3 ================== //
|
// ================== Average3 ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_complex_get_mean3(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, const BGC_FP32_Complex* number3, BGC_FP32_Complex* mean)
|
inline void bgc_fp32_complex_get_mean3(BGC_FP32_Complex* mean, const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, const BGC_FP32_Complex* number3)
|
||||||
{
|
{
|
||||||
mean->real = (number1->real + number2->real + number3->real) * BGC_FP32_ONE_THIRD;
|
mean->real = (number1->real + number2->real + number3->real) * BGC_FP32_ONE_THIRD;
|
||||||
mean->imaginary = (number1->imaginary + number2->imaginary + number3->imaginary) * BGC_FP32_ONE_THIRD;
|
mean->imaginary = (number1->imaginary + number2->imaginary + number3->imaginary) * BGC_FP32_ONE_THIRD;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_get_mean3(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, const BGC_FP64_Complex* number3, BGC_FP64_Complex* mean)
|
inline void bgc_fp64_complex_get_mean3(BGC_FP64_Complex* mean, const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, const BGC_FP64_Complex* number3)
|
||||||
{
|
{
|
||||||
mean->real = (number1->real + number2->real + number3->real) * BGC_FP64_ONE_THIRD;
|
mean->real = (number1->real + number2->real + number3->real) * BGC_FP64_ONE_THIRD;
|
||||||
mean->imaginary = (number1->imaginary + number2->imaginary + number3->imaginary) * BGC_FP64_ONE_THIRD;
|
mean->imaginary = (number1->imaginary + number2->imaginary + number3->imaginary) * BGC_FP64_ONE_THIRD;
|
||||||
|
|
@ -490,7 +490,7 @@ inline void bgc_fp64_complex_get_mean3(const BGC_FP64_Complex* number1, const BG
|
||||||
|
|
||||||
// =================== Linear =================== //
|
// =================== Linear =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_complex_interpolate(const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, const float phase, BGC_FP32_Complex* interpolation)
|
inline void bgc_fp32_complex_interpolate(BGC_FP32_Complex* interpolation, const BGC_FP32_Complex* number1, const BGC_FP32_Complex* number2, const float phase)
|
||||||
{
|
{
|
||||||
const float counter_phase = 1.0f - phase;
|
const float counter_phase = 1.0f - phase;
|
||||||
|
|
||||||
|
|
@ -498,7 +498,7 @@ inline void bgc_fp32_complex_interpolate(const BGC_FP32_Complex* number1, const
|
||||||
interpolation->imaginary = number1->imaginary * counter_phase + number2->imaginary * phase;
|
interpolation->imaginary = number1->imaginary * counter_phase + number2->imaginary * phase;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_complex_interpolate(const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, const double phase, BGC_FP64_Complex* interpolation)
|
inline void bgc_fp64_complex_interpolate(BGC_FP64_Complex* interpolation, const BGC_FP64_Complex* number1, const BGC_FP64_Complex* number2, const double phase)
|
||||||
{
|
{
|
||||||
const double counter_phase = 1.0 - phase;
|
const double counter_phase = 1.0 - phase;
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -7,11 +7,11 @@ const BGC_FP64_CotesNumber BGC_FP64_IDLE_COTES_NUMBER = { 1.0, 0.0 };
|
||||||
extern inline void bgc_fp32_cotes_number_reset(BGC_FP32_CotesNumber* number);
|
extern inline void bgc_fp32_cotes_number_reset(BGC_FP32_CotesNumber* number);
|
||||||
extern inline void bgc_fp64_cotes_number_reset(BGC_FP64_CotesNumber* number);
|
extern inline void bgc_fp64_cotes_number_reset(BGC_FP64_CotesNumber* number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_make(const float x1, const float x2, BGC_FP32_CotesNumber* number);
|
extern inline void bgc_fp32_cotes_number_make(BGC_FP32_CotesNumber* number, const float x1, const float x2);
|
||||||
extern inline void bgc_fp64_cotes_number_make(const double x1, const double x2, BGC_FP64_CotesNumber* number);
|
extern inline void bgc_fp64_cotes_number_make(BGC_FP64_CotesNumber* number, const double x1, const double x2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_make_for_angle(const float angle, const int angle_unit, BGC_FP32_CotesNumber* number);
|
extern inline void bgc_fp32_cotes_number_make_for_angle(BGC_FP32_CotesNumber* number, const float angle, const int angle_unit);
|
||||||
extern inline void bgc_fp64_cotes_number_make_for_angle(const double angle, const int angle_unit, BGC_FP64_CotesNumber* number);
|
extern inline void bgc_fp64_cotes_number_make_for_angle(BGC_FP64_CotesNumber* number, const double angle, const int angle_unit);
|
||||||
|
|
||||||
extern inline int bgc_fp32_cotes_number_is_idle(const BGC_FP32_CotesNumber* number);
|
extern inline int bgc_fp32_cotes_number_is_idle(const BGC_FP32_CotesNumber* number);
|
||||||
extern inline int bgc_fp64_cotes_number_is_idle(const BGC_FP64_CotesNumber* number);
|
extern inline int bgc_fp64_cotes_number_is_idle(const BGC_FP64_CotesNumber* number);
|
||||||
|
|
@ -19,41 +19,41 @@ extern inline int bgc_fp64_cotes_number_is_idle(const BGC_FP64_CotesNumber* numb
|
||||||
extern inline float bgc_fp32_cotes_number_get_angle(const BGC_FP32_CotesNumber* number, const int angle_unit);
|
extern inline float bgc_fp32_cotes_number_get_angle(const BGC_FP32_CotesNumber* number, const int angle_unit);
|
||||||
extern inline double bgc_fp64_cotes_number_get_angle(const BGC_FP64_CotesNumber* number, const int angle_unit);
|
extern inline double bgc_fp64_cotes_number_get_angle(const BGC_FP64_CotesNumber* number, const int angle_unit);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_copy(const BGC_FP32_CotesNumber* source, BGC_FP32_CotesNumber* destination);
|
extern inline void bgc_fp32_cotes_number_copy(BGC_FP32_CotesNumber* destination, const BGC_FP32_CotesNumber* source);
|
||||||
extern inline void bgc_fp64_cotes_number_copy(const BGC_FP64_CotesNumber* source, BGC_FP64_CotesNumber* destination);
|
extern inline void bgc_fp64_cotes_number_copy(BGC_FP64_CotesNumber* destination, const BGC_FP64_CotesNumber* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_swap(BGC_FP32_CotesNumber* number1, BGC_FP32_CotesNumber* number2);
|
extern inline void bgc_fp32_cotes_number_swap(BGC_FP32_CotesNumber* number1, BGC_FP32_CotesNumber* number2);
|
||||||
extern inline void bgc_fp64_cotes_number_swap(BGC_FP64_CotesNumber* number1, BGC_FP64_CotesNumber* number2);
|
extern inline void bgc_fp64_cotes_number_swap(BGC_FP64_CotesNumber* number1, BGC_FP64_CotesNumber* number2);
|
||||||
|
|
||||||
extern inline void bgc_fp64_cotes_number_convert_to_fp32(const BGC_FP64_CotesNumber* source, BGC_FP32_CotesNumber* destination);
|
extern inline void bgc_fp64_cotes_number_convert_to_fp32(BGC_FP32_CotesNumber* destination, const BGC_FP64_CotesNumber* source);
|
||||||
extern inline void bgc_fp32_cotes_number_convert_to_fp64(const BGC_FP32_CotesNumber* source, BGC_FP64_CotesNumber* destination);
|
extern inline void bgc_fp32_cotes_number_convert_to_fp64(BGC_FP64_CotesNumber* destination, const BGC_FP32_CotesNumber* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_revert(BGC_FP32_CotesNumber* number);
|
extern inline void bgc_fp32_cotes_number_revert(BGC_FP32_CotesNumber* number);
|
||||||
extern inline void bgc_fp64_cotes_number_revert(BGC_FP64_CotesNumber* number);
|
extern inline void bgc_fp64_cotes_number_revert(BGC_FP64_CotesNumber* number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_get_reverse(const BGC_FP32_CotesNumber* number, BGC_FP32_CotesNumber* inverse);
|
extern inline void bgc_fp32_cotes_number_get_reverse(BGC_FP32_CotesNumber* reverse, const BGC_FP32_CotesNumber* number);
|
||||||
extern inline void bgc_fp64_cotes_number_get_inverse(const BGC_FP64_CotesNumber* number, BGC_FP64_CotesNumber* inverse);
|
extern inline void bgc_fp64_cotes_number_get_reverse(BGC_FP64_CotesNumber* reverse, const BGC_FP64_CotesNumber* number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_get_exponation(const BGC_FP32_CotesNumber* base, const float exponent, BGC_FP32_CotesNumber* power);
|
extern inline void bgc_fp32_cotes_number_get_exponation(BGC_FP32_CotesNumber* power, const BGC_FP32_CotesNumber* base, const float exponent);
|
||||||
extern inline void bgc_fp64_cotes_number_get_exponation(const BGC_FP64_CotesNumber* base, const double exponent, BGC_FP64_CotesNumber* power);
|
extern inline void bgc_fp64_cotes_number_get_exponation(BGC_FP64_CotesNumber* power, const BGC_FP64_CotesNumber* base, const double exponent);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_combine(const BGC_FP32_CotesNumber* number1, const BGC_FP32_CotesNumber* number2, BGC_FP32_CotesNumber* result);
|
extern inline void bgc_fp32_cotes_number_combine(BGC_FP32_CotesNumber* combination, const BGC_FP32_CotesNumber* number1, const BGC_FP32_CotesNumber* number2);
|
||||||
extern inline void bgc_fp64_cotes_number_combine(const BGC_FP64_CotesNumber* number1, const BGC_FP64_CotesNumber* number2, BGC_FP64_CotesNumber* result);
|
extern inline void bgc_fp64_cotes_number_combine(BGC_FP64_CotesNumber* combination, const BGC_FP64_CotesNumber* number1, const BGC_FP64_CotesNumber* number2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_exclude(const BGC_FP32_CotesNumber* base, const BGC_FP32_CotesNumber* excludant, BGC_FP32_CotesNumber* difference);
|
extern inline void bgc_fp32_cotes_number_exclude(BGC_FP32_CotesNumber* difference, const BGC_FP32_CotesNumber* base, const BGC_FP32_CotesNumber* excludant);
|
||||||
extern inline void bgc_fp64_cotes_number_exclude(const BGC_FP64_CotesNumber* base, const BGC_FP64_CotesNumber* excludant, BGC_FP64_CotesNumber* difference);
|
extern inline void bgc_fp64_cotes_number_exclude(BGC_FP64_CotesNumber* difference, const BGC_FP64_CotesNumber* base, const BGC_FP64_CotesNumber* excludant);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_get_rotation_matrix(const BGC_FP32_CotesNumber* number, BGC_FP32_Matrix2x2* matrix);
|
extern inline void bgc_fp32_cotes_number_get_rotation_matrix(BGC_FP32_Matrix2x2* matrix, const BGC_FP32_CotesNumber* number);
|
||||||
extern inline void bgc_fp64_cotes_number_get_rotation_matrix(const BGC_FP64_CotesNumber* number, BGC_FP64_Matrix2x2* matrix);
|
extern inline void bgc_fp64_cotes_number_get_rotation_matrix(BGC_FP64_Matrix2x2* matrix, const BGC_FP64_CotesNumber* number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_get_reverse_matrix(const BGC_FP32_CotesNumber* number, BGC_FP32_Matrix2x2* matrix);
|
extern inline void bgc_fp32_cotes_number_get_reverse_matrix(BGC_FP32_Matrix2x2* matrix, const BGC_FP32_CotesNumber* number);
|
||||||
extern inline void bgc_fp64_cotes_number_get_reverse_matrix(const BGC_FP64_CotesNumber* number, BGC_FP64_Matrix2x2* matrix);
|
extern inline void bgc_fp64_cotes_number_get_reverse_matrix(BGC_FP64_Matrix2x2* matrix, const BGC_FP64_CotesNumber* number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_turn_vector(const BGC_FP32_CotesNumber* number, const BGC_FP32_Vector2* vector, BGC_FP32_Vector2* result);
|
extern inline void bgc_fp32_cotes_number_turn_vector(BGC_FP32_Vector2* turned_vector, const BGC_FP32_CotesNumber* number, const BGC_FP32_Vector2* vector);
|
||||||
extern inline void bgc_fp64_cotes_number_turn_vector(const BGC_FP64_CotesNumber* number, const BGC_FP64_Vector2* vector, BGC_FP64_Vector2* result);
|
extern inline void bgc_fp64_cotes_number_turn_vector(BGC_FP64_Vector2* turned_vector, const BGC_FP64_CotesNumber* number, const BGC_FP64_Vector2* vector);
|
||||||
|
|
||||||
extern inline void bgc_fp32_cotes_number_turn_vector_back(const BGC_FP32_CotesNumber* number, const BGC_FP32_Vector2* vector, BGC_FP32_Vector2* result);
|
extern inline void bgc_fp32_cotes_number_turn_vector_back(BGC_FP32_Vector2* turned_vector, const BGC_FP32_CotesNumber* number, const BGC_FP32_Vector2* vector);
|
||||||
extern inline void bgc_fp64_cotes_number_turn_vector_back(const BGC_FP64_CotesNumber* number, const BGC_FP64_Vector2* vector, BGC_FP64_Vector2* result);
|
extern inline void bgc_fp64_cotes_number_turn_vector_back(BGC_FP64_Vector2* turned_vector, const BGC_FP64_CotesNumber* number, const BGC_FP64_Vector2* vector);
|
||||||
|
|
||||||
extern inline int bgc_fp32_cotes_number_are_close(const BGC_FP32_CotesNumber* number1, const BGC_FP32_CotesNumber* number2);
|
extern inline int bgc_fp32_cotes_number_are_close(const BGC_FP32_CotesNumber* number1, const BGC_FP32_CotesNumber* number2);
|
||||||
extern inline int bgc_fp64_cotes_number_are_close(const BGC_FP64_CotesNumber* number1, const BGC_FP64_CotesNumber* number2);
|
extern inline int bgc_fp64_cotes_number_are_close(const BGC_FP64_CotesNumber* number1, const BGC_FP64_CotesNumber* number2);
|
||||||
|
|
|
||||||
|
|
@ -41,7 +41,7 @@ inline void bgc_fp64_cotes_number_reset(BGC_FP64_CotesNumber* number)
|
||||||
|
|
||||||
// ================== Set Turn ================== //
|
// ================== Set Turn ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_make_for_angle(const float angle, const int angle_unit, BGC_FP32_CotesNumber* number)
|
inline void bgc_fp32_cotes_number_make_for_angle(BGC_FP32_CotesNumber* number, const float angle, const int angle_unit)
|
||||||
{
|
{
|
||||||
const float radians = bgc_fp32_angle_to_radians(angle, angle_unit);
|
const float radians = bgc_fp32_angle_to_radians(angle, angle_unit);
|
||||||
|
|
||||||
|
|
@ -49,7 +49,7 @@ inline void bgc_fp32_cotes_number_make_for_angle(const float angle, const int an
|
||||||
number->_sin = sinf(radians);
|
number->_sin = sinf(radians);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_make_for_angle(const double angle, const int angle_unit, BGC_FP64_CotesNumber* number)
|
inline void bgc_fp64_cotes_number_make_for_angle(BGC_FP64_CotesNumber* number, const double angle, const int angle_unit)
|
||||||
{
|
{
|
||||||
const double radians = bgc_fp64_angle_to_radians(angle, angle_unit);
|
const double radians = bgc_fp64_angle_to_radians(angle, angle_unit);
|
||||||
|
|
||||||
|
|
@ -76,7 +76,7 @@ void _bgc_fp32_cotes_number_normalize(BGC_FP32_CotesNumber* twin);
|
||||||
|
|
||||||
void _bgc_fp64_cotes_number_normalize(BGC_FP64_CotesNumber* twin);
|
void _bgc_fp64_cotes_number_normalize(BGC_FP64_CotesNumber* twin);
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_make(const float x1, const float x2, BGC_FP32_CotesNumber* number)
|
inline void bgc_fp32_cotes_number_make(BGC_FP32_CotesNumber* number, const float x1, const float x2)
|
||||||
{
|
{
|
||||||
const float square_modulus = x1 * x1 + x2 * x2;
|
const float square_modulus = x1 * x1 + x2 * x2;
|
||||||
|
|
||||||
|
|
@ -88,7 +88,7 @@ inline void bgc_fp32_cotes_number_make(const float x1, const float x2, BGC_FP32_
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_make(const double x1, const double x2, BGC_FP64_CotesNumber* number)
|
inline void bgc_fp64_cotes_number_make(BGC_FP64_CotesNumber* number, const double x1, const double x2)
|
||||||
{
|
{
|
||||||
const double square_modulus = x1 * x1 + x2 * x2;
|
const double square_modulus = x1 * x1 + x2 * x2;
|
||||||
|
|
||||||
|
|
@ -114,13 +114,13 @@ inline double bgc_fp64_cotes_number_get_angle(const BGC_FP64_CotesNumber* number
|
||||||
|
|
||||||
// ==================== Copy ==================== //
|
// ==================== Copy ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_copy(const BGC_FP32_CotesNumber* source, BGC_FP32_CotesNumber* destination)
|
inline void bgc_fp32_cotes_number_copy(BGC_FP32_CotesNumber* destination, const BGC_FP32_CotesNumber* source)
|
||||||
{
|
{
|
||||||
destination->_cos = source->_cos;
|
destination->_cos = source->_cos;
|
||||||
destination->_sin = source->_sin;
|
destination->_sin = source->_sin;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_copy(const BGC_FP64_CotesNumber* source, BGC_FP64_CotesNumber* destination)
|
inline void bgc_fp64_cotes_number_copy(BGC_FP64_CotesNumber* destination, const BGC_FP64_CotesNumber* source)
|
||||||
{
|
{
|
||||||
destination->_cos = source->_cos;
|
destination->_cos = source->_cos;
|
||||||
destination->_sin = source->_sin;
|
destination->_sin = source->_sin;
|
||||||
|
|
@ -154,14 +154,14 @@ inline void bgc_fp64_cotes_number_swap(BGC_FP64_CotesNumber* number1, BGC_FP64_C
|
||||||
|
|
||||||
// ================== Convert =================== //
|
// ================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_convert_to_fp32(const BGC_FP64_CotesNumber* source, BGC_FP32_CotesNumber* destination)
|
inline void bgc_fp64_cotes_number_convert_to_fp32(BGC_FP32_CotesNumber* destination, const BGC_FP64_CotesNumber* source)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_make((float)source->_cos, (float)source->_sin, destination);
|
bgc_fp32_cotes_number_make(destination, (float)source->_cos, (float)source->_sin);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_convert_to_fp64(const BGC_FP32_CotesNumber* source, BGC_FP64_CotesNumber* destination)
|
inline void bgc_fp32_cotes_number_convert_to_fp64(BGC_FP64_CotesNumber* destination, const BGC_FP32_CotesNumber* source)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_make((double)source->_cos, (double)source->_sin, destination);
|
bgc_fp64_cotes_number_make(destination, (double)source->_cos, (double)source->_sin);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Revert =================== //
|
// =================== Revert =================== //
|
||||||
|
|
@ -176,21 +176,21 @@ inline void bgc_fp64_cotes_number_revert(BGC_FP64_CotesNumber* number)
|
||||||
number->_sin = -number->_sin;
|
number->_sin = -number->_sin;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_get_reverse(const BGC_FP32_CotesNumber* number, BGC_FP32_CotesNumber* inverse)
|
inline void bgc_fp32_cotes_number_get_reverse(BGC_FP32_CotesNumber* reverse, const BGC_FP32_CotesNumber* number)
|
||||||
{
|
{
|
||||||
inverse->_cos = number->_cos;
|
reverse->_cos = number->_cos;
|
||||||
inverse->_sin = -number->_sin;
|
reverse->_sin = -number->_sin;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_get_inverse(const BGC_FP64_CotesNumber* number, BGC_FP64_CotesNumber* inverse)
|
inline void bgc_fp64_cotes_number_get_reverse(BGC_FP64_CotesNumber* reverse, const BGC_FP64_CotesNumber* number)
|
||||||
{
|
{
|
||||||
inverse->_cos = number->_cos;
|
reverse->_cos = number->_cos;
|
||||||
inverse->_sin = -number->_sin;
|
reverse->_sin = -number->_sin;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================= Exponation ================= //
|
// ================= Exponation ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_get_exponation(const BGC_FP32_CotesNumber* base, const float exponent, BGC_FP32_CotesNumber* power)
|
inline void bgc_fp32_cotes_number_get_exponation(BGC_FP32_CotesNumber* power, const BGC_FP32_CotesNumber* base, const float exponent)
|
||||||
{
|
{
|
||||||
const float power_angle = exponent * atan2f(base->_sin, base->_cos);
|
const float power_angle = exponent * atan2f(base->_sin, base->_cos);
|
||||||
|
|
||||||
|
|
@ -198,7 +198,7 @@ inline void bgc_fp32_cotes_number_get_exponation(const BGC_FP32_CotesNumber* bas
|
||||||
power->_sin = sinf(power_angle);
|
power->_sin = sinf(power_angle);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_get_exponation(const BGC_FP64_CotesNumber* base, const double exponent, BGC_FP64_CotesNumber* power)
|
inline void bgc_fp64_cotes_number_get_exponation(BGC_FP64_CotesNumber* power, const BGC_FP64_CotesNumber* base, const double exponent)
|
||||||
{
|
{
|
||||||
const double power_angle = exponent * atan2(base->_sin, base->_cos);
|
const double power_angle = exponent * atan2(base->_sin, base->_cos);
|
||||||
|
|
||||||
|
|
@ -208,47 +208,47 @@ inline void bgc_fp64_cotes_number_get_exponation(const BGC_FP64_CotesNumber* bas
|
||||||
|
|
||||||
// ================ Combination ================= //
|
// ================ Combination ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_combine(const BGC_FP32_CotesNumber* number1, const BGC_FP32_CotesNumber* number2, BGC_FP32_CotesNumber* result)
|
inline void bgc_fp32_cotes_number_combine(BGC_FP32_CotesNumber* combination, const BGC_FP32_CotesNumber* number1, const BGC_FP32_CotesNumber* number2)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_make(
|
bgc_fp32_cotes_number_make(
|
||||||
|
combination,
|
||||||
number1->_cos * number2->_cos - number1->_sin * number2->_sin,
|
number1->_cos * number2->_cos - number1->_sin * number2->_sin,
|
||||||
number1->_cos * number2->_sin + number1->_sin * number2->_cos,
|
number1->_cos * number2->_sin + number1->_sin * number2->_cos
|
||||||
result
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_combine(const BGC_FP64_CotesNumber* number1, const BGC_FP64_CotesNumber* number2, BGC_FP64_CotesNumber* result)
|
inline void bgc_fp64_cotes_number_combine(BGC_FP64_CotesNumber* combination, const BGC_FP64_CotesNumber* number1, const BGC_FP64_CotesNumber* number2)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_make(
|
bgc_fp64_cotes_number_make(
|
||||||
|
combination,
|
||||||
number1->_cos * number2->_cos - number1->_sin * number2->_sin,
|
number1->_cos * number2->_cos - number1->_sin * number2->_sin,
|
||||||
number1->_cos * number2->_sin + number1->_sin * number2->_cos,
|
number1->_cos * number2->_sin + number1->_sin * number2->_cos
|
||||||
result
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================= Exclusion ================== //
|
// ================= Exclusion ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_exclude(const BGC_FP32_CotesNumber* base, const BGC_FP32_CotesNumber* excludant, BGC_FP32_CotesNumber* difference)
|
inline void bgc_fp32_cotes_number_exclude(BGC_FP32_CotesNumber* difference, const BGC_FP32_CotesNumber* base, const BGC_FP32_CotesNumber* excludant)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_make(
|
bgc_fp32_cotes_number_make(
|
||||||
|
difference,
|
||||||
base->_cos * excludant->_cos + base->_sin * excludant->_sin,
|
base->_cos * excludant->_cos + base->_sin * excludant->_sin,
|
||||||
base->_sin * excludant->_cos - base->_cos * excludant->_sin,
|
base->_sin * excludant->_cos - base->_cos * excludant->_sin
|
||||||
difference
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_exclude(const BGC_FP64_CotesNumber* base, const BGC_FP64_CotesNumber* excludant, BGC_FP64_CotesNumber* difference)
|
inline void bgc_fp64_cotes_number_exclude(BGC_FP64_CotesNumber* difference, const BGC_FP64_CotesNumber* base, const BGC_FP64_CotesNumber* excludant)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_make(
|
bgc_fp64_cotes_number_make(
|
||||||
|
difference,
|
||||||
base->_cos * excludant->_cos + base->_sin * excludant->_sin,
|
base->_cos * excludant->_cos + base->_sin * excludant->_sin,
|
||||||
base->_sin * excludant->_cos - base->_cos * excludant->_sin,
|
base->_sin * excludant->_cos - base->_cos * excludant->_sin
|
||||||
difference
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============== Rotation Matrix =============== //
|
// ============== Rotation Matrix =============== //
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_get_rotation_matrix(const BGC_FP32_CotesNumber* number, BGC_FP32_Matrix2x2* matrix)
|
inline void bgc_fp32_cotes_number_get_rotation_matrix(BGC_FP32_Matrix2x2* matrix, const BGC_FP32_CotesNumber* number)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = number->_cos;
|
matrix->r1c1 = number->_cos;
|
||||||
matrix->r1c2 = -number->_sin;
|
matrix->r1c2 = -number->_sin;
|
||||||
|
|
@ -256,7 +256,7 @@ inline void bgc_fp32_cotes_number_get_rotation_matrix(const BGC_FP32_CotesNumber
|
||||||
matrix->r2c2 = number->_cos;
|
matrix->r2c2 = number->_cos;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_get_rotation_matrix(const BGC_FP64_CotesNumber* number, BGC_FP64_Matrix2x2* matrix)
|
inline void bgc_fp64_cotes_number_get_rotation_matrix(BGC_FP64_Matrix2x2* matrix, const BGC_FP64_CotesNumber* number)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = number->_cos;
|
matrix->r1c1 = number->_cos;
|
||||||
matrix->r1c2 = -number->_sin;
|
matrix->r1c2 = -number->_sin;
|
||||||
|
|
@ -266,7 +266,7 @@ inline void bgc_fp64_cotes_number_get_rotation_matrix(const BGC_FP64_CotesNumber
|
||||||
|
|
||||||
// ============== Reverse Matrix ================ //
|
// ============== Reverse Matrix ================ //
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_get_reverse_matrix(const BGC_FP32_CotesNumber* number, BGC_FP32_Matrix2x2* matrix)
|
inline void bgc_fp32_cotes_number_get_reverse_matrix(BGC_FP32_Matrix2x2* matrix, const BGC_FP32_CotesNumber* number)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = number->_cos;
|
matrix->r1c1 = number->_cos;
|
||||||
matrix->r1c2 = number->_sin;
|
matrix->r1c2 = number->_sin;
|
||||||
|
|
@ -274,7 +274,7 @@ inline void bgc_fp32_cotes_number_get_reverse_matrix(const BGC_FP32_CotesNumber*
|
||||||
matrix->r2c2 = number->_cos;
|
matrix->r2c2 = number->_cos;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_get_reverse_matrix(const BGC_FP64_CotesNumber* number, BGC_FP64_Matrix2x2* matrix)
|
inline void bgc_fp64_cotes_number_get_reverse_matrix(BGC_FP64_Matrix2x2* matrix, const BGC_FP64_CotesNumber* number)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = number->_cos;
|
matrix->r1c1 = number->_cos;
|
||||||
matrix->r1c2 = number->_sin;
|
matrix->r1c2 = number->_sin;
|
||||||
|
|
@ -284,42 +284,42 @@ inline void bgc_fp64_cotes_number_get_reverse_matrix(const BGC_FP64_CotesNumber*
|
||||||
|
|
||||||
// ================ Turn Vector ================= //
|
// ================ Turn Vector ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_turn_vector(const BGC_FP32_CotesNumber* number, const BGC_FP32_Vector2* vector, BGC_FP32_Vector2* result)
|
inline void bgc_fp32_cotes_number_turn_vector(BGC_FP32_Vector2* turned_vector, const BGC_FP32_CotesNumber* number, const BGC_FP32_Vector2* vector)
|
||||||
{
|
{
|
||||||
const float x1 = number->_cos * vector->x1 - number->_sin * vector->x2;
|
const float x1 = number->_cos * vector->x1 - number->_sin * vector->x2;
|
||||||
const float x2 = number->_sin * vector->x1 + number->_cos * vector->x2;
|
const float x2 = number->_sin * vector->x1 + number->_cos * vector->x2;
|
||||||
|
|
||||||
result->x1 = x1;
|
turned_vector->x1 = x1;
|
||||||
result->x2 = x2;
|
turned_vector->x2 = x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_turn_vector(const BGC_FP64_CotesNumber* number, const BGC_FP64_Vector2* vector, BGC_FP64_Vector2* result)
|
inline void bgc_fp64_cotes_number_turn_vector(BGC_FP64_Vector2* turned_vector, const BGC_FP64_CotesNumber* number, const BGC_FP64_Vector2* vector)
|
||||||
{
|
{
|
||||||
const double x1 = number->_cos * vector->x1 - number->_sin * vector->x2;
|
const double x1 = number->_cos * vector->x1 - number->_sin * vector->x2;
|
||||||
const double x2 = number->_sin * vector->x1 + number->_cos * vector->x2;
|
const double x2 = number->_sin * vector->x1 + number->_cos * vector->x2;
|
||||||
|
|
||||||
result->x1 = x1;
|
turned_vector->x1 = x1;
|
||||||
result->x2 = x2;
|
turned_vector->x2 = x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============ Turn Vector Backward ============ //
|
// ============ Turn Vector Backward ============ //
|
||||||
|
|
||||||
inline void bgc_fp32_cotes_number_turn_vector_back(const BGC_FP32_CotesNumber* number, const BGC_FP32_Vector2* vector, BGC_FP32_Vector2* result)
|
inline void bgc_fp32_cotes_number_turn_vector_back(BGC_FP32_Vector2* turned_vector, const BGC_FP32_CotesNumber* number, const BGC_FP32_Vector2* vector)
|
||||||
{
|
{
|
||||||
const float x1 = number->_sin * vector->x2 + number->_cos * vector->x1;
|
const float x1 = number->_sin * vector->x2 + number->_cos * vector->x1;
|
||||||
const float x2 = number->_cos * vector->x2 - number->_sin * vector->x1;
|
const float x2 = number->_cos * vector->x2 - number->_sin * vector->x1;
|
||||||
|
|
||||||
result->x1 = x1;
|
turned_vector->x1 = x1;
|
||||||
result->x2 = x2;
|
turned_vector->x2 = x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_cotes_number_turn_vector_back(const BGC_FP64_CotesNumber* number, const BGC_FP64_Vector2* vector, BGC_FP64_Vector2* result)
|
inline void bgc_fp64_cotes_number_turn_vector_back(BGC_FP64_Vector2* turned_vector, const BGC_FP64_CotesNumber* number, const BGC_FP64_Vector2* vector)
|
||||||
{
|
{
|
||||||
const double x1 = number->_sin * vector->x2 + number->_cos * vector->x1;
|
const double x1 = number->_sin * vector->x2 + number->_cos * vector->x1;
|
||||||
const double x2 = number->_cos * vector->x2 - number->_sin * vector->x1;
|
const double x2 = number->_cos * vector->x2 - number->_sin * vector->x1;
|
||||||
|
|
||||||
result->x1 = x1;
|
turned_vector->x1 = x1;
|
||||||
result->x2 = x2;
|
turned_vector->x2 = x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================== Are Close ================= //
|
// ================== Are Close ================= //
|
||||||
|
|
|
||||||
25
basic-geometry/matrices.c
Normal file
25
basic-geometry/matrices.c
Normal file
|
|
@ -0,0 +1,25 @@
|
||||||
|
#include "matrices.h"
|
||||||
|
|
||||||
|
extern inline void bgc_fp32_multiply_matrix2x2_by_matrix2x2(BGC_FP32_Matrix2x2* product, const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix2x2* matrix2);
|
||||||
|
extern inline void bgc_fp64_multiply_matrix2x2_by_matrix2x2(BGC_FP64_Matrix2x2* product, const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix2x2* matrix2);
|
||||||
|
|
||||||
|
extern inline void bgc_fp32_multiply_matrix2x2_by_matrix3x2(BGC_FP32_Matrix3x2* product, const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix3x2* matrix2);
|
||||||
|
extern inline void bgc_fp64_multiply_matrix2x2_by_matrix3x2(BGC_FP64_Matrix3x2* product, const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix3x2* matrix2);
|
||||||
|
|
||||||
|
extern inline void bgc_fp32_multiply_matrix2x3_by_matrix2x2(BGC_FP32_Matrix2x3* product, const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix2x2* matrix2);
|
||||||
|
extern inline void bgc_fp64_multiply_matrix2x3_by_matrix2x2(BGC_FP64_Matrix2x3* product, const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix2x2* matrix2);
|
||||||
|
|
||||||
|
extern inline void bgc_fp32_multiply_matrix2x3_by_matrix3x2(BGC_FP32_Matrix3x3* product, const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix3x2* matrix2);
|
||||||
|
extern inline void bgc_fp64_multiply_matrix2x3_by_matrix3x2(BGC_FP64_Matrix3x3* product, const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix3x2* matrix2);
|
||||||
|
|
||||||
|
extern inline void bgc_fp32_multiply_matrix3x2_by_matrix2x3(BGC_FP32_Matrix2x2* product, const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix2x3* matrix2);
|
||||||
|
extern inline void bgc_fp64_multiply_matrix3x2_by_matrix2x3(BGC_FP64_Matrix2x2* product, const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix2x3* matrix2);
|
||||||
|
|
||||||
|
extern inline void bgc_fp32_multiply_matrix3x2_by_matrix3x3(BGC_FP32_Matrix3x2* product, const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix3x3* matrix2);
|
||||||
|
extern inline void bgc_fp64_multiply_matrix3x2_by_matrix3x3(BGC_FP64_Matrix3x2* product, const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix3x3* matrix2);
|
||||||
|
|
||||||
|
extern inline void bgc_fp32_multiply_matrix3x3_by_matrix2x3(BGC_FP32_Matrix2x3* product, const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix2x3* matrix2);
|
||||||
|
extern inline void bgc_fp64_multiply_matrix3x3_by_matrix2x3(BGC_FP64_Matrix2x3* product, const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix2x3* matrix2);
|
||||||
|
|
||||||
|
extern inline void bgc_fp32_multiply_matrix3x3_by_matrix3x3(BGC_FP32_Matrix3x3* product, const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix3x3* matrix2);
|
||||||
|
extern inline void bgc_fp64_multiply_matrix3x3_by_matrix3x3(BGC_FP64_Matrix3x3* product, const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix3x3* matrix2);
|
||||||
|
|
@ -1,5 +1,5 @@
|
||||||
#ifndef _BGC_MATRIX_TYPES_H_
|
#ifndef _BGC_MATRICES_H_
|
||||||
#define _BGC_MATRIX_TYPES_H_
|
#define _BGC_MATRICES_H_
|
||||||
|
|
||||||
// ================== Matrix2x2 ================= //
|
// ================== Matrix2x2 ================= //
|
||||||
|
|
||||||
|
|
@ -55,7 +55,7 @@ typedef struct {
|
||||||
|
|
||||||
// ========== Matrix Product 2x2 at 2x2 ========= //
|
// ========== Matrix Product 2x2 at 2x2 ========= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix2x2_by_matrix2x2(const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix2x2* matrix2, BGC_FP32_Matrix2x2* product)
|
inline void bgc_fp32_multiply_matrix2x2_by_matrix2x2(BGC_FP32_Matrix2x2* product, const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix2x2* matrix2)
|
||||||
{
|
{
|
||||||
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
||||||
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
||||||
|
|
@ -70,7 +70,7 @@ inline void bgc_fp32_multiply_matrix2x2_by_matrix2x2(const BGC_FP32_Matrix2x2* m
|
||||||
product->r2c2 = r2c2;
|
product->r2c2 = r2c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix2x2_by_matrix2x2(const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix2x2* matrix2, BGC_FP64_Matrix2x2* product)
|
inline void bgc_fp64_multiply_matrix2x2_by_matrix2x2(BGC_FP64_Matrix2x2* product, const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix2x2* matrix2)
|
||||||
{
|
{
|
||||||
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
||||||
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
||||||
|
|
@ -87,7 +87,7 @@ inline void bgc_fp64_multiply_matrix2x2_by_matrix2x2(const BGC_FP64_Matrix2x2* m
|
||||||
|
|
||||||
// ========== Matrix Product 2x2 at 3x2 ========= //
|
// ========== Matrix Product 2x2 at 3x2 ========= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix2x2_by_matrix3x2(const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix3x2* matrix2, BGC_FP32_Matrix3x2* product)
|
inline void bgc_fp32_multiply_matrix2x2_by_matrix3x2(BGC_FP32_Matrix3x2* product, const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix3x2* matrix2)
|
||||||
{
|
{
|
||||||
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
||||||
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
||||||
|
|
@ -106,7 +106,7 @@ inline void bgc_fp32_multiply_matrix2x2_by_matrix3x2(const BGC_FP32_Matrix2x2* m
|
||||||
product->r2c3 = r2c3;
|
product->r2c3 = r2c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix2x2_by_matrix3x2(const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix3x2* matrix2, BGC_FP64_Matrix3x2* product)
|
inline void bgc_fp64_multiply_matrix2x2_by_matrix3x2(BGC_FP64_Matrix3x2* product, const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix3x2* matrix2)
|
||||||
{
|
{
|
||||||
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
||||||
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
||||||
|
|
@ -127,7 +127,7 @@ inline void bgc_fp64_multiply_matrix2x2_by_matrix3x2(const BGC_FP64_Matrix2x2* m
|
||||||
|
|
||||||
// ========== Matrix Product 2x3 at 2x2 ========= //
|
// ========== Matrix Product 2x3 at 2x2 ========= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix2x3_by_matrix2x2(const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix2x2* matrix2, BGC_FP32_Matrix2x3* product)
|
inline void bgc_fp32_multiply_matrix2x3_by_matrix2x2(BGC_FP32_Matrix2x3* product, const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix2x2* matrix2)
|
||||||
{
|
{
|
||||||
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
||||||
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
||||||
|
|
@ -148,7 +148,7 @@ inline void bgc_fp32_multiply_matrix2x3_by_matrix2x2(const BGC_FP32_Matrix2x3* m
|
||||||
product->r3c2 = r3c2;
|
product->r3c2 = r3c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix2x3_by_matrix2x2(const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix2x2* matrix2, BGC_FP64_Matrix2x3* product)
|
inline void bgc_fp64_multiply_matrix2x3_by_matrix2x2(BGC_FP64_Matrix2x3* product, const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix2x2* matrix2)
|
||||||
{
|
{
|
||||||
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
||||||
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
||||||
|
|
@ -171,7 +171,7 @@ inline void bgc_fp64_multiply_matrix2x3_by_matrix2x2(const BGC_FP64_Matrix2x3* m
|
||||||
|
|
||||||
// ========== Matrix Product 2x3 at 3x2 ========= //
|
// ========== Matrix Product 2x3 at 3x2 ========= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix2x3_by_matrix3x2(const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix3x2* matrix2, BGC_FP32_Matrix3x3* product)
|
inline void bgc_fp32_multiply_matrix2x3_by_matrix3x2(BGC_FP32_Matrix3x3* product, const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix3x2* matrix2)
|
||||||
{
|
{
|
||||||
product->r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
product->r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
||||||
product->r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
product->r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
||||||
|
|
@ -186,7 +186,7 @@ inline void bgc_fp32_multiply_matrix2x3_by_matrix3x2(const BGC_FP32_Matrix2x3* m
|
||||||
product->r3c3 = matrix1->r3c1 * matrix2->r1c3 + matrix1->r3c2 * matrix2->r2c3;
|
product->r3c3 = matrix1->r3c1 * matrix2->r1c3 + matrix1->r3c2 * matrix2->r2c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix2x3_by_matrix3x2(const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix3x2* matrix2, BGC_FP64_Matrix3x3* product)
|
inline void bgc_fp64_multiply_matrix2x3_by_matrix3x2(BGC_FP64_Matrix3x3* product, const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix3x2* matrix2)
|
||||||
{
|
{
|
||||||
product->r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
product->r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1;
|
||||||
product->r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
product->r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2;
|
||||||
|
|
@ -203,7 +203,7 @@ inline void bgc_fp64_multiply_matrix2x3_by_matrix3x2(const BGC_FP64_Matrix2x3* m
|
||||||
|
|
||||||
// ========== Matrix Product 3x2 at 2x3 ========= //
|
// ========== Matrix Product 3x2 at 2x3 ========= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix3x2_by_matrix2x3(const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix2x3* matrix2, BGC_FP32_Matrix2x2* product)
|
inline void bgc_fp32_multiply_matrix3x2_by_matrix2x3(BGC_FP32_Matrix2x2* product, const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix2x3* matrix2)
|
||||||
{
|
{
|
||||||
product->r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
product->r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
||||||
product->r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
product->r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
||||||
|
|
@ -212,7 +212,7 @@ inline void bgc_fp32_multiply_matrix3x2_by_matrix2x3(const BGC_FP32_Matrix3x2* m
|
||||||
product->r2c2 = matrix1->r2c1 * matrix2->r1c2 + matrix1->r2c2 * matrix2->r2c2 + matrix1->r2c3 * matrix2->r3c2;
|
product->r2c2 = matrix1->r2c1 * matrix2->r1c2 + matrix1->r2c2 * matrix2->r2c2 + matrix1->r2c3 * matrix2->r3c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix3x2_by_matrix2x3(const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix2x3* matrix2, BGC_FP64_Matrix2x2* product)
|
inline void bgc_fp64_multiply_matrix3x2_by_matrix2x3(BGC_FP64_Matrix2x2* product, const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix2x3* matrix2)
|
||||||
{
|
{
|
||||||
product->r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
product->r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
||||||
product->r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
product->r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
||||||
|
|
@ -223,7 +223,7 @@ inline void bgc_fp64_multiply_matrix3x2_by_matrix2x3(const BGC_FP64_Matrix3x2* m
|
||||||
|
|
||||||
// ========== Matrix Product 3x2 at 3x3 ========= //
|
// ========== Matrix Product 3x2 at 3x3 ========= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix3x2_by_matrix3x3(const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix3x3* matrix2, BGC_FP32_Matrix3x2* product)
|
inline void bgc_fp32_multiply_matrix3x2_by_matrix3x3(BGC_FP32_Matrix3x2* product, const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix3x3* matrix2)
|
||||||
{
|
{
|
||||||
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
||||||
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
||||||
|
|
@ -242,7 +242,7 @@ inline void bgc_fp32_multiply_matrix3x2_by_matrix3x3(const BGC_FP32_Matrix3x2* m
|
||||||
product->r2c3 = r2c3;
|
product->r2c3 = r2c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix3x2_by_matrix3x3(const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix3x3* matrix2, BGC_FP64_Matrix3x2* product)
|
inline void bgc_fp64_multiply_matrix3x2_by_matrix3x3(BGC_FP64_Matrix3x2* product, const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix3x3* matrix2)
|
||||||
{
|
{
|
||||||
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
||||||
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
||||||
|
|
@ -263,7 +263,7 @@ inline void bgc_fp64_multiply_matrix3x2_by_matrix3x3(const BGC_FP64_Matrix3x2* m
|
||||||
|
|
||||||
// ========== Matrix Product 3x3 at 2x3 ========= //
|
// ========== Matrix Product 3x3 at 2x3 ========= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix3x3_by_matrix2x3(const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix2x3* matrix2, BGC_FP32_Matrix2x3* product)
|
inline void bgc_fp32_multiply_matrix3x3_by_matrix2x3(BGC_FP32_Matrix2x3* product, const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix2x3* matrix2)
|
||||||
{
|
{
|
||||||
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
||||||
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
||||||
|
|
@ -284,7 +284,7 @@ inline void bgc_fp32_multiply_matrix3x3_by_matrix2x3(const BGC_FP32_Matrix3x3* m
|
||||||
product->r3c2 = r3c2;
|
product->r3c2 = r3c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix3x3_by_matrix2x3(const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix2x3* matrix2, BGC_FP64_Matrix2x3* product)
|
inline void bgc_fp64_multiply_matrix3x3_by_matrix2x3(BGC_FP64_Matrix2x3* product, const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix2x3* matrix2)
|
||||||
{
|
{
|
||||||
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
||||||
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
||||||
|
|
@ -307,7 +307,7 @@ inline void bgc_fp64_multiply_matrix3x3_by_matrix2x3(const BGC_FP64_Matrix3x3* m
|
||||||
|
|
||||||
// ========== Matrix Product 3x3 at 3x3 ========= //
|
// ========== Matrix Product 3x3 at 3x3 ========= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix3x3_by_matrix3x3(const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix3x3* matrix2, BGC_FP32_Matrix3x3* product)
|
inline void bgc_fp32_multiply_matrix3x3_by_matrix3x3(BGC_FP32_Matrix3x3* product, const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix3x3* matrix2)
|
||||||
{
|
{
|
||||||
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
const float r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
||||||
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
const float r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
||||||
|
|
@ -334,7 +334,7 @@ inline void bgc_fp32_multiply_matrix3x3_by_matrix3x3(const BGC_FP32_Matrix3x3* m
|
||||||
product->r3c3 = r3c3;
|
product->r3c3 = r3c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix3x3_by_matrix3x3(const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix3x3* matrix2, BGC_FP64_Matrix3x3* product)
|
inline void bgc_fp64_multiply_matrix3x3_by_matrix3x3(BGC_FP64_Matrix3x3* product, const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix3x3* matrix2)
|
||||||
{
|
{
|
||||||
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
const double r1c1 = matrix1->r1c1 * matrix2->r1c1 + matrix1->r1c2 * matrix2->r2c1 + matrix1->r1c3 * matrix2->r3c1;
|
||||||
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
const double r1c2 = matrix1->r1c1 * matrix2->r1c2 + matrix1->r1c2 * matrix2->r2c2 + matrix1->r1c3 * matrix2->r3c2;
|
||||||
|
|
@ -6,11 +6,11 @@ extern inline void bgc_fp64_matrix2x2_reset(BGC_FP64_Matrix2x2* matrix);
|
||||||
extern inline void bgc_fp32_matrix2x2_make_identity(BGC_FP32_Matrix2x2* matrix);
|
extern inline void bgc_fp32_matrix2x2_make_identity(BGC_FP32_Matrix2x2* matrix);
|
||||||
extern inline void bgc_fp64_matrix2x2_make_identity(BGC_FP64_Matrix2x2* matrix);
|
extern inline void bgc_fp64_matrix2x2_make_identity(BGC_FP64_Matrix2x2* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_make_diagonal(const float d1, const float d2, BGC_FP32_Matrix2x2* matrix);
|
extern inline void bgc_fp32_matrix2x2_make_diagonal(BGC_FP32_Matrix2x2* matrix, const float d1, const float d2);
|
||||||
extern inline void bgc_fp64_matrix2x2_make_diagonal(const double d1, const double d2, BGC_FP64_Matrix2x2* matrix);
|
extern inline void bgc_fp64_matrix2x2_make_diagonal(BGC_FP64_Matrix2x2* matrix, const double d1, const double d2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_make_for_turn(const float angle, const int angle_unit, BGC_FP32_Matrix2x2* matrix);
|
extern inline void bgc_fp32_matrix2x2_make_for_turn(BGC_FP32_Matrix2x2* matrix, const float angle, const int angle_unit);
|
||||||
extern inline void bgc_fp64_matrix2x2_make_for_turn(const double angle, const int angle_unit, BGC_FP64_Matrix2x2* matrix);
|
extern inline void bgc_fp64_matrix2x2_make_for_turn(BGC_FP64_Matrix2x2* matrix, const double angle, const int angle_unit);
|
||||||
|
|
||||||
extern inline float bgc_fp32_matrix2x2_get_determinant(const BGC_FP32_Matrix2x2* matrix);
|
extern inline float bgc_fp32_matrix2x2_get_determinant(const BGC_FP32_Matrix2x2* matrix);
|
||||||
extern inline double bgc_fp64_matrix2x2_get_determinant(const BGC_FP64_Matrix2x2* matrix);
|
extern inline double bgc_fp64_matrix2x2_get_determinant(const BGC_FP64_Matrix2x2* matrix);
|
||||||
|
|
@ -24,17 +24,17 @@ extern inline int bgc_fp64_matrix2x2_is_singular(const BGC_FP64_Matrix2x2* matri
|
||||||
extern inline int bgc_fp32_matrix2x2_is_rotation(const BGC_FP32_Matrix2x2* matrix);
|
extern inline int bgc_fp32_matrix2x2_is_rotation(const BGC_FP32_Matrix2x2* matrix);
|
||||||
extern inline int bgc_fp64_matrix2x2_is_rotation(const BGC_FP64_Matrix2x2* matrix);
|
extern inline int bgc_fp64_matrix2x2_is_rotation(const BGC_FP64_Matrix2x2* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_copy(const BGC_FP32_Matrix2x2* source, BGC_FP32_Matrix2x2* destination);
|
extern inline void bgc_fp32_matrix2x2_copy(BGC_FP32_Matrix2x2* destination, const BGC_FP32_Matrix2x2* source);
|
||||||
extern inline void bgc_fp64_matrix2x2_copy(const BGC_FP64_Matrix2x2* source, BGC_FP64_Matrix2x2* destination);
|
extern inline void bgc_fp64_matrix2x2_copy(BGC_FP64_Matrix2x2* destination, const BGC_FP64_Matrix2x2* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_swap(BGC_FP32_Matrix2x2* matrix1, BGC_FP32_Matrix2x2* matrix2);
|
extern inline void bgc_fp32_matrix2x2_swap(BGC_FP32_Matrix2x2* matrix1, BGC_FP32_Matrix2x2* matrix2);
|
||||||
extern inline void bgc_fp64_matrix2x2_swap(BGC_FP64_Matrix2x2* matrix1, BGC_FP64_Matrix2x2* matrix2);
|
extern inline void bgc_fp64_matrix2x2_swap(BGC_FP64_Matrix2x2* matrix1, BGC_FP64_Matrix2x2* matrix2);
|
||||||
|
|
||||||
extern inline void bgc_fp64_matrix2x2_convert_to_fp32(const BGC_FP64_Matrix2x2* source, BGC_FP32_Matrix2x2* destination);
|
extern inline void bgc_fp64_matrix2x2_convert_to_fp32(BGC_FP32_Matrix2x2* destination, const BGC_FP64_Matrix2x2* source);
|
||||||
extern inline void bgc_fp32_matrix2x2_convert_to_fp64(const BGC_FP32_Matrix2x2* source, BGC_FP64_Matrix2x2* destination);
|
extern inline void bgc_fp32_matrix2x2_convert_to_fp64(BGC_FP64_Matrix2x2* destination, const BGC_FP32_Matrix2x2* source);
|
||||||
|
|
||||||
extern inline int bgc_fp32_matrix2x2_get_inverse(const BGC_FP32_Matrix2x2* matrix, BGC_FP32_Matrix2x2* inverse);
|
extern inline int bgc_fp32_matrix2x2_get_inverse(BGC_FP32_Matrix2x2* inverse, const BGC_FP32_Matrix2x2* matrix);
|
||||||
extern inline int bgc_fp64_matrix2x2_get_inverse(const BGC_FP64_Matrix2x2* matrix, BGC_FP64_Matrix2x2* inverse);
|
extern inline int bgc_fp64_matrix2x2_get_inverse(BGC_FP64_Matrix2x2* inverse, const BGC_FP64_Matrix2x2* matrix);
|
||||||
|
|
||||||
extern inline int bgc_fp32_matrix2x2_invert(BGC_FP32_Matrix2x2* matrix);
|
extern inline int bgc_fp32_matrix2x2_invert(BGC_FP32_Matrix2x2* matrix);
|
||||||
extern inline int bgc_fp64_matrix2x2_invert(BGC_FP64_Matrix2x2* matrix);
|
extern inline int bgc_fp64_matrix2x2_invert(BGC_FP64_Matrix2x2* matrix);
|
||||||
|
|
@ -42,41 +42,41 @@ extern inline int bgc_fp64_matrix2x2_invert(BGC_FP64_Matrix2x2* matrix);
|
||||||
extern inline void bgc_fp32_matrix2x2_transpose(BGC_FP32_Matrix2x2* matrix);
|
extern inline void bgc_fp32_matrix2x2_transpose(BGC_FP32_Matrix2x2* matrix);
|
||||||
extern inline void bgc_fp64_matrix2x2_transpose(BGC_FP64_Matrix2x2* matrix);
|
extern inline void bgc_fp64_matrix2x2_transpose(BGC_FP64_Matrix2x2* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_get_transposed(const BGC_FP32_Matrix2x2* matrix, BGC_FP32_Matrix2x2* transposed);
|
extern inline void bgc_fp32_matrix2x2_get_transposed(BGC_FP32_Matrix2x2* transposed, const BGC_FP32_Matrix2x2* matrix);
|
||||||
extern inline void bgc_fp64_matrix2x2_get_transposed(const BGC_FP64_Matrix2x2* matrix, BGC_FP64_Matrix2x2* transposed);
|
extern inline void bgc_fp64_matrix2x2_get_transposed(BGC_FP64_Matrix2x2* transposed, const BGC_FP64_Matrix2x2* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_get_row(const int number, const BGC_FP32_Matrix2x2* matrix, BGC_FP32_Vector2* row);
|
extern inline void bgc_fp32_matrix2x2_get_row(BGC_FP32_Vector2* row, const BGC_FP32_Matrix2x2* matrix, const int row_number);
|
||||||
extern inline void bgc_fp64_matrix2x2_get_row(const int number, const BGC_FP64_Matrix2x2* matrix, BGC_FP64_Vector2* row);
|
extern inline void bgc_fp64_matrix2x2_get_row(BGC_FP64_Vector2* row, const BGC_FP64_Matrix2x2* matrix, const int row_number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_set_row(const int number, const BGC_FP32_Vector2* row, BGC_FP32_Matrix2x2* matrix);
|
extern inline void bgc_fp32_matrix2x2_set_row(BGC_FP32_Matrix2x2* matrix, const int row_number, const BGC_FP32_Vector2* row);
|
||||||
extern inline void bgc_fp64_matrix2x2_set_row(const int number, const BGC_FP64_Vector2* row, BGC_FP64_Matrix2x2* matrix);
|
extern inline void bgc_fp64_matrix2x2_set_row(BGC_FP64_Matrix2x2* matrix, const int row_number, const BGC_FP64_Vector2* row);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_get_column(const int number, const BGC_FP32_Matrix2x2* matrix, BGC_FP32_Vector2* column);
|
extern inline void bgc_fp32_matrix2x2_get_column(BGC_FP32_Vector2* column, const BGC_FP32_Matrix2x2* matrix, const int column_number);
|
||||||
extern inline void bgc_fp64_matrix2x2_get_column(const int number, const BGC_FP64_Matrix2x2* matrix, BGC_FP64_Vector2* column);
|
extern inline void bgc_fp64_matrix2x2_get_column(BGC_FP64_Vector2* column, const BGC_FP64_Matrix2x2* matrix, const int column_number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_set_column(const int number, const BGC_FP32_Vector2* column, BGC_FP32_Matrix2x2* matrix);
|
extern inline void bgc_fp32_matrix2x2_set_column(BGC_FP32_Matrix2x2* matrix, const int column_number, const BGC_FP32_Vector2* column);
|
||||||
extern inline void bgc_fp64_matrix2x2_set_column(const int number, const BGC_FP64_Vector2* column, BGC_FP64_Matrix2x2* matrix);
|
extern inline void bgc_fp64_matrix2x2_set_column(BGC_FP64_Matrix2x2* matrix, const int column_number, const BGC_FP64_Vector2* column);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_add(const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix2x2* matrix2, BGC_FP32_Matrix2x2* sum);
|
extern inline void bgc_fp32_matrix2x2_add(BGC_FP32_Matrix2x2* sum, const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix2x2* matrix2);
|
||||||
extern inline void bgc_fp64_matrix2x2_add(const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix2x2* matrix2, BGC_FP64_Matrix2x2* sum);
|
extern inline void bgc_fp64_matrix2x2_add(BGC_FP64_Matrix2x2* sum, const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix2x2* matrix2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_add_scaled(const BGC_FP32_Matrix2x2* basic_matrix, const BGC_FP32_Matrix2x2* scalable_matrix, const float scale, BGC_FP32_Matrix2x2* sum);
|
extern 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);
|
||||||
extern inline void bgc_fp64_matrix2x2_add_scaled(const BGC_FP64_Matrix2x2* basic_matrix, const BGC_FP64_Matrix2x2* scalable_matrix, const double scale, BGC_FP64_Matrix2x2* sum);
|
extern 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);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_subtract(const BGC_FP32_Matrix2x2* minuend, const BGC_FP32_Matrix2x2* subtrahend, BGC_FP32_Matrix2x2* difference);
|
extern inline void bgc_fp32_matrix2x2_subtract(BGC_FP32_Matrix2x2* difference, const BGC_FP32_Matrix2x2* minuend, const BGC_FP32_Matrix2x2* subtrahend);
|
||||||
extern inline void bgc_fp64_matrix2x2_subtract(const BGC_FP64_Matrix2x2* minuend, const BGC_FP64_Matrix2x2* subtrahend, BGC_FP64_Matrix2x2* difference);
|
extern inline void bgc_fp64_matrix2x2_subtract(BGC_FP64_Matrix2x2* difference, const BGC_FP64_Matrix2x2* minuend, const BGC_FP64_Matrix2x2* subtrahend);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_multiply(const BGC_FP32_Matrix2x2* multiplicand, const float multiplier, BGC_FP32_Matrix2x2* product);
|
extern inline void bgc_fp32_matrix2x2_multiply(BGC_FP32_Matrix2x2* product, const BGC_FP32_Matrix2x2* multiplicand, const float multiplier);
|
||||||
extern inline void bgc_fp64_matrix2x2_multiply(const BGC_FP64_Matrix2x2* multiplicand, const double multiplier, BGC_FP64_Matrix2x2* product);
|
extern inline void bgc_fp64_matrix2x2_multiply(BGC_FP64_Matrix2x2* product, const BGC_FP64_Matrix2x2* multiplicand, const double multiplier);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_divide(const BGC_FP32_Matrix2x2* dividend, const float divisor, BGC_FP32_Matrix2x2* quotient);
|
extern inline void bgc_fp32_matrix2x2_divide(BGC_FP32_Matrix2x2* quotient, const BGC_FP32_Matrix2x2* dividend, const float divisor);
|
||||||
extern inline void bgc_fp64_matrix2x2_divide(const BGC_FP64_Matrix2x2* dividend, const double divisor, BGC_FP64_Matrix2x2* quotient);
|
extern inline void bgc_fp64_matrix2x2_divide(BGC_FP64_Matrix2x2* quotient, const BGC_FP64_Matrix2x2* dividend, const double divisor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x2_interpolate(const BGC_FP32_Matrix2x2* first, const BGC_FP32_Matrix2x2* second, const float phase, BGC_FP32_Matrix2x2* interpolation);
|
extern inline void bgc_fp32_matrix2x2_interpolate(BGC_FP32_Matrix2x2* interpolation, const BGC_FP32_Matrix2x2* first, const BGC_FP32_Matrix2x2* second, const float phase);
|
||||||
extern inline void bgc_fp64_matrix2x2_interpolate(const BGC_FP64_Matrix2x2* first, const BGC_FP64_Matrix2x2* second, const double phase, BGC_FP64_Matrix2x2* interpolation);
|
extern inline void bgc_fp64_matrix2x2_interpolate(BGC_FP64_Matrix2x2* interpolation, const BGC_FP64_Matrix2x2* first, const BGC_FP64_Matrix2x2* second, const double phase);
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix2x2_by_vector2(const BGC_FP32_Matrix2x2* matrix, const BGC_FP32_Vector2* vector, BGC_FP32_Vector2* product);
|
extern inline void bgc_fp32_multiply_matrix2x2_by_vector2(BGC_FP32_Vector2* product, const BGC_FP32_Matrix2x2* matrix, const BGC_FP32_Vector2* vector);
|
||||||
extern inline void bgc_fp64_multiply_matrix2x2_by_vector2(const BGC_FP64_Matrix2x2* matrix, const BGC_FP64_Vector2* vector, BGC_FP64_Vector2* product);
|
extern inline void bgc_fp64_multiply_matrix2x2_by_vector2(BGC_FP64_Vector2* product, const BGC_FP64_Matrix2x2* matrix, const BGC_FP64_Vector2* vector);
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_vector2_by_matrix2x2(const BGC_FP32_Vector2* vector, const BGC_FP32_Matrix2x2* matrix, BGC_FP32_Vector2* product);
|
extern inline void bgc_fp32_multiply_vector2_by_matrix2x2(BGC_FP32_Vector2* product, const BGC_FP32_Vector2* vector, const BGC_FP32_Matrix2x2* matrix);
|
||||||
extern inline void bgc_fp64_multiply_vector2_by_matrix2x2(const BGC_FP64_Vector2* vector, const BGC_FP64_Matrix2x2* matrix, BGC_FP64_Vector2* product);
|
extern inline void bgc_fp64_multiply_vector2_by_matrix2x2(BGC_FP64_Vector2* product, const BGC_FP64_Vector2* vector, const BGC_FP64_Matrix2x2* matrix);
|
||||||
|
|
|
||||||
|
|
@ -3,7 +3,7 @@
|
||||||
|
|
||||||
#include "angle.h"
|
#include "angle.h"
|
||||||
#include "vector2.h"
|
#include "vector2.h"
|
||||||
#include "matrixes.h"
|
#include "matrices.h"
|
||||||
|
|
||||||
// =================== Reset ==================== //
|
// =================== Reset ==================== //
|
||||||
|
|
||||||
|
|
@ -43,7 +43,7 @@ inline void bgc_fp64_matrix2x2_make_identity(BGC_FP64_Matrix2x2* matrix)
|
||||||
|
|
||||||
// ================ Set Diagonal ================ //
|
// ================ Set Diagonal ================ //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_make_diagonal(const float d1, const float d2, BGC_FP32_Matrix2x2* matrix)
|
inline void bgc_fp32_matrix2x2_make_diagonal(BGC_FP32_Matrix2x2* matrix, const float d1, const float d2)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = d1;
|
matrix->r1c1 = d1;
|
||||||
matrix->r1c2 = 0.0f;
|
matrix->r1c2 = 0.0f;
|
||||||
|
|
@ -51,7 +51,7 @@ inline void bgc_fp32_matrix2x2_make_diagonal(const float d1, const float d2, BGC
|
||||||
matrix->r2c2 = d2;
|
matrix->r2c2 = d2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_make_diagonal(const double d1, const double d2, BGC_FP64_Matrix2x2* matrix)
|
inline void bgc_fp64_matrix2x2_make_diagonal(BGC_FP64_Matrix2x2* matrix, const double d1, const double d2)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = d1;
|
matrix->r1c1 = d1;
|
||||||
matrix->r1c2 = 0.0;
|
matrix->r1c2 = 0.0;
|
||||||
|
|
@ -61,7 +61,7 @@ inline void bgc_fp64_matrix2x2_make_diagonal(const double d1, const double d2, B
|
||||||
|
|
||||||
// ============== Rotation Matrix =============== //
|
// ============== Rotation Matrix =============== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_make_for_turn(const float angle, const int angle_unit, BGC_FP32_Matrix2x2* matrix)
|
inline void bgc_fp32_matrix2x2_make_for_turn(BGC_FP32_Matrix2x2* matrix, const float angle, const int angle_unit)
|
||||||
{
|
{
|
||||||
const float radians = bgc_fp32_angle_to_radians(angle, angle_unit);
|
const float radians = bgc_fp32_angle_to_radians(angle, angle_unit);
|
||||||
const float cosine = cosf(radians);
|
const float cosine = cosf(radians);
|
||||||
|
|
@ -73,7 +73,7 @@ inline void bgc_fp32_matrix2x2_make_for_turn(const float angle, const int angle_
|
||||||
matrix->r2c2 = cosine;
|
matrix->r2c2 = cosine;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_make_for_turn(const double angle, const int angle_unit, BGC_FP64_Matrix2x2* matrix)
|
inline void bgc_fp64_matrix2x2_make_for_turn(BGC_FP64_Matrix2x2* matrix, const double angle, const int angle_unit)
|
||||||
{
|
{
|
||||||
const double radians = bgc_fp64_angle_to_radians(angle, angle_unit);
|
const double radians = bgc_fp64_angle_to_radians(angle, angle_unit);
|
||||||
const double cosine = cos(radians);
|
const double cosine = cos(radians);
|
||||||
|
|
@ -153,7 +153,7 @@ inline int bgc_fp64_matrix2x2_is_rotation(const BGC_FP64_Matrix2x2* matrix)
|
||||||
|
|
||||||
// ==================== Copy ==================== //
|
// ==================== Copy ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_copy(const BGC_FP32_Matrix2x2* source, BGC_FP32_Matrix2x2* destination)
|
inline void bgc_fp32_matrix2x2_copy(BGC_FP32_Matrix2x2* destination, const BGC_FP32_Matrix2x2* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -162,7 +162,7 @@ inline void bgc_fp32_matrix2x2_copy(const BGC_FP32_Matrix2x2* source, BGC_FP32_M
|
||||||
destination->r2c2 = source->r2c2;
|
destination->r2c2 = source->r2c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_copy(const BGC_FP64_Matrix2x2* source, BGC_FP64_Matrix2x2* destination)
|
inline void bgc_fp64_matrix2x2_copy(BGC_FP64_Matrix2x2* destination, const BGC_FP64_Matrix2x2* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -217,7 +217,7 @@ inline void bgc_fp64_matrix2x2_swap(BGC_FP64_Matrix2x2* matrix1, BGC_FP64_Matrix
|
||||||
|
|
||||||
// ================== Convert =================== //
|
// ================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_convert_to_fp32(const BGC_FP64_Matrix2x2* source, BGC_FP32_Matrix2x2* destination)
|
inline void bgc_fp64_matrix2x2_convert_to_fp32(BGC_FP32_Matrix2x2* destination, const BGC_FP64_Matrix2x2* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = (float)source->r1c1;
|
destination->r1c1 = (float)source->r1c1;
|
||||||
destination->r1c2 = (float)source->r1c2;
|
destination->r1c2 = (float)source->r1c2;
|
||||||
|
|
@ -226,7 +226,7 @@ inline void bgc_fp64_matrix2x2_convert_to_fp32(const BGC_FP64_Matrix2x2* source,
|
||||||
destination->r2c2 = (float)source->r2c2;
|
destination->r2c2 = (float)source->r2c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_convert_to_fp64(const BGC_FP32_Matrix2x2* source, BGC_FP64_Matrix2x2* destination)
|
inline void bgc_fp32_matrix2x2_convert_to_fp64(BGC_FP64_Matrix2x2* destination, const BGC_FP32_Matrix2x2* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -237,7 +237,7 @@ inline void bgc_fp32_matrix2x2_convert_to_fp64(const BGC_FP32_Matrix2x2* source,
|
||||||
|
|
||||||
// ================ Get Inverse ================= //
|
// ================ Get Inverse ================= //
|
||||||
|
|
||||||
inline int bgc_fp32_matrix2x2_get_inverse(const BGC_FP32_Matrix2x2* matrix, BGC_FP32_Matrix2x2* inverse)
|
inline int bgc_fp32_matrix2x2_get_inverse(BGC_FP32_Matrix2x2* inverse, const BGC_FP32_Matrix2x2* matrix)
|
||||||
{
|
{
|
||||||
const float determinant = bgc_fp32_matrix2x2_get_determinant(matrix);
|
const float determinant = bgc_fp32_matrix2x2_get_determinant(matrix);
|
||||||
|
|
||||||
|
|
@ -262,7 +262,7 @@ inline int bgc_fp32_matrix2x2_get_inverse(const BGC_FP32_Matrix2x2* matrix, BGC_
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_matrix2x2_get_inverse(const BGC_FP64_Matrix2x2* matrix, BGC_FP64_Matrix2x2* inverse)
|
inline int bgc_fp64_matrix2x2_get_inverse(BGC_FP64_Matrix2x2* inverse, const BGC_FP64_Matrix2x2* matrix)
|
||||||
{
|
{
|
||||||
const double determinant = bgc_fp64_matrix2x2_get_determinant(matrix);
|
const double determinant = bgc_fp64_matrix2x2_get_determinant(matrix);
|
||||||
|
|
||||||
|
|
@ -317,7 +317,7 @@ inline void bgc_fp64_matrix2x2_transpose(BGC_FP64_Matrix2x2* matrix)
|
||||||
|
|
||||||
// =============== Get Transpose ================ //
|
// =============== Get Transpose ================ //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_get_transposed(const BGC_FP32_Matrix2x2* matrix, BGC_FP32_Matrix2x2* transposed)
|
inline void bgc_fp32_matrix2x2_get_transposed(BGC_FP32_Matrix2x2* transposed, const BGC_FP32_Matrix2x2* matrix)
|
||||||
{
|
{
|
||||||
const float r1c2 = matrix->r1c2;
|
const float r1c2 = matrix->r1c2;
|
||||||
|
|
||||||
|
|
@ -328,7 +328,7 @@ inline void bgc_fp32_matrix2x2_get_transposed(const BGC_FP32_Matrix2x2* matrix,
|
||||||
transposed->r2c2 = matrix->r2c2;
|
transposed->r2c2 = matrix->r2c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_get_transposed(const BGC_FP64_Matrix2x2* matrix, BGC_FP64_Matrix2x2* transposed)
|
inline void bgc_fp64_matrix2x2_get_transposed(BGC_FP64_Matrix2x2* transposed, const BGC_FP64_Matrix2x2* matrix)
|
||||||
{
|
{
|
||||||
const double r1c2 = matrix->r1c2;
|
const double r1c2 = matrix->r1c2;
|
||||||
|
|
||||||
|
|
@ -341,15 +341,15 @@ inline void bgc_fp64_matrix2x2_get_transposed(const BGC_FP64_Matrix2x2* matrix,
|
||||||
|
|
||||||
// ================== Get Row =================== //
|
// ================== Get Row =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_get_row(const int number, const BGC_FP32_Matrix2x2* matrix, BGC_FP32_Vector2* row)
|
inline void bgc_fp32_matrix2x2_get_row(BGC_FP32_Vector2* row, const BGC_FP32_Matrix2x2* matrix, const int row_number)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (row_number == 1) {
|
||||||
row->x1 = matrix->r1c1;
|
row->x1 = matrix->r1c1;
|
||||||
row->x2 = matrix->r1c2;
|
row->x2 = matrix->r1c2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (row_number == 2) {
|
||||||
row->x1 = matrix->r2c1;
|
row->x1 = matrix->r2c1;
|
||||||
row->x2 = matrix->r2c2;
|
row->x2 = matrix->r2c2;
|
||||||
return;
|
return;
|
||||||
|
|
@ -359,15 +359,15 @@ inline void bgc_fp32_matrix2x2_get_row(const int number, const BGC_FP32_Matrix2x
|
||||||
row->x2 = 0.0f;
|
row->x2 = 0.0f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_get_row(const int number, const BGC_FP64_Matrix2x2* matrix, BGC_FP64_Vector2* row)
|
inline void bgc_fp64_matrix2x2_get_row(BGC_FP64_Vector2* row, const BGC_FP64_Matrix2x2* matrix, const int row_number)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (row_number == 1) {
|
||||||
row->x1 = matrix->r1c1;
|
row->x1 = matrix->r1c1;
|
||||||
row->x2 = matrix->r1c2;
|
row->x2 = matrix->r1c2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (row_number == 2) {
|
||||||
row->x1 = matrix->r2c1;
|
row->x1 = matrix->r2c1;
|
||||||
row->x2 = matrix->r2c2;
|
row->x2 = matrix->r2c2;
|
||||||
return;
|
return;
|
||||||
|
|
@ -379,29 +379,29 @@ inline void bgc_fp64_matrix2x2_get_row(const int number, const BGC_FP64_Matrix2x
|
||||||
|
|
||||||
// ================== Set Row =================== //
|
// ================== Set Row =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_set_row(const int number, const BGC_FP32_Vector2* row, BGC_FP32_Matrix2x2* matrix)
|
inline void bgc_fp32_matrix2x2_set_row(BGC_FP32_Matrix2x2* matrix, const int row_number, const BGC_FP32_Vector2* row)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (row_number == 1) {
|
||||||
matrix->r1c1 = row->x1;
|
matrix->r1c1 = row->x1;
|
||||||
matrix->r1c2 = row->x2;
|
matrix->r1c2 = row->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (row_number == 2) {
|
||||||
matrix->r2c1 = row->x1;
|
matrix->r2c1 = row->x1;
|
||||||
matrix->r2c2 = row->x2;
|
matrix->r2c2 = row->x2;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_set_row(const int number, const BGC_FP64_Vector2* row, BGC_FP64_Matrix2x2* matrix)
|
inline void bgc_fp64_matrix2x2_set_row(BGC_FP64_Matrix2x2* matrix, const int row_number, const BGC_FP64_Vector2* row)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (row_number == 1) {
|
||||||
matrix->r1c1 = row->x1;
|
matrix->r1c1 = row->x1;
|
||||||
matrix->r1c2 = row->x2;
|
matrix->r1c2 = row->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (row_number == 2) {
|
||||||
matrix->r2c1 = row->x1;
|
matrix->r2c1 = row->x1;
|
||||||
matrix->r2c2 = row->x2;
|
matrix->r2c2 = row->x2;
|
||||||
}
|
}
|
||||||
|
|
@ -409,15 +409,15 @@ inline void bgc_fp64_matrix2x2_set_row(const int number, const BGC_FP64_Vector2*
|
||||||
|
|
||||||
// ================= Get Column ================= //
|
// ================= Get Column ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_get_column(const int number, const BGC_FP32_Matrix2x2* matrix, BGC_FP32_Vector2* column)
|
inline void bgc_fp32_matrix2x2_get_column(BGC_FP32_Vector2* column, const BGC_FP32_Matrix2x2* matrix, const int column_number)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (column_number == 1) {
|
||||||
column->x1 = matrix->r1c1;
|
column->x1 = matrix->r1c1;
|
||||||
column->x2 = matrix->r2c1;
|
column->x2 = matrix->r2c1;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (column_number == 2) {
|
||||||
column->x1 = matrix->r1c2;
|
column->x1 = matrix->r1c2;
|
||||||
column->x2 = matrix->r2c2;
|
column->x2 = matrix->r2c2;
|
||||||
return;
|
return;
|
||||||
|
|
@ -427,15 +427,15 @@ inline void bgc_fp32_matrix2x2_get_column(const int number, const BGC_FP32_Matri
|
||||||
column->x2 = 0.0f;
|
column->x2 = 0.0f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_get_column(const int number, const BGC_FP64_Matrix2x2* matrix, BGC_FP64_Vector2* column)
|
inline void bgc_fp64_matrix2x2_get_column(BGC_FP64_Vector2* column, const BGC_FP64_Matrix2x2* matrix, const int column_number)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (column_number == 1) {
|
||||||
column->x1 = matrix->r1c1;
|
column->x1 = matrix->r1c1;
|
||||||
column->x2 = matrix->r2c1;
|
column->x2 = matrix->r2c1;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (column_number == 2) {
|
||||||
column->x1 = matrix->r1c2;
|
column->x1 = matrix->r1c2;
|
||||||
column->x2 = matrix->r2c2;
|
column->x2 = matrix->r2c2;
|
||||||
return;
|
return;
|
||||||
|
|
@ -447,29 +447,29 @@ inline void bgc_fp64_matrix2x2_get_column(const int number, const BGC_FP64_Matri
|
||||||
|
|
||||||
// ================= Set Column ================= //
|
// ================= Set Column ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_set_column(const int number, const BGC_FP32_Vector2* column, BGC_FP32_Matrix2x2* matrix)
|
inline void bgc_fp32_matrix2x2_set_column(BGC_FP32_Matrix2x2* matrix, const int column_number, const BGC_FP32_Vector2* column)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (column_number == 1) {
|
||||||
matrix->r1c1 = column->x1;
|
matrix->r1c1 = column->x1;
|
||||||
matrix->r2c1 = column->x2;
|
matrix->r2c1 = column->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (column_number == 2) {
|
||||||
matrix->r1c2 = column->x1;
|
matrix->r1c2 = column->x1;
|
||||||
matrix->r2c2 = column->x2;
|
matrix->r2c2 = column->x2;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_set_column(const int number, const BGC_FP64_Vector2* column, BGC_FP64_Matrix2x2* matrix)
|
inline void bgc_fp64_matrix2x2_set_column(BGC_FP64_Matrix2x2* matrix, const int column_number, const BGC_FP64_Vector2* column)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (column_number == 1) {
|
||||||
matrix->r1c1 = column->x1;
|
matrix->r1c1 = column->x1;
|
||||||
matrix->r2c1 = column->x2;
|
matrix->r2c1 = column->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (column_number == 2) {
|
||||||
matrix->r1c2 = column->x1;
|
matrix->r1c2 = column->x1;
|
||||||
matrix->r2c2 = column->x2;
|
matrix->r2c2 = column->x2;
|
||||||
}
|
}
|
||||||
|
|
@ -477,7 +477,7 @@ inline void bgc_fp64_matrix2x2_set_column(const int number, const BGC_FP64_Vecto
|
||||||
|
|
||||||
// ==================== Add ===================== //
|
// ==================== Add ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_add(const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix2x2* matrix2, BGC_FP32_Matrix2x2* sum)
|
inline void bgc_fp32_matrix2x2_add(BGC_FP32_Matrix2x2* sum, const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix2x2* matrix2)
|
||||||
{
|
{
|
||||||
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
||||||
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
||||||
|
|
@ -486,7 +486,7 @@ inline void bgc_fp32_matrix2x2_add(const BGC_FP32_Matrix2x2* matrix1, const BGC_
|
||||||
sum->r2c2 = matrix1->r2c2 + matrix2->r2c2;
|
sum->r2c2 = matrix1->r2c2 + matrix2->r2c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_add(const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix2x2* matrix2, BGC_FP64_Matrix2x2* sum)
|
inline void bgc_fp64_matrix2x2_add(BGC_FP64_Matrix2x2* sum, const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix2x2* matrix2)
|
||||||
{
|
{
|
||||||
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
||||||
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
||||||
|
|
@ -497,7 +497,7 @@ inline void bgc_fp64_matrix2x2_add(const BGC_FP64_Matrix2x2* matrix1, const BGC_
|
||||||
|
|
||||||
// ================= Add scaled ================= //
|
// ================= Add scaled ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_add_scaled(const BGC_FP32_Matrix2x2* basic_matrix, const BGC_FP32_Matrix2x2* scalable_matrix, const float scale, BGC_FP32_Matrix2x2* sum)
|
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->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
||||||
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
||||||
|
|
@ -506,7 +506,7 @@ inline void bgc_fp32_matrix2x2_add_scaled(const BGC_FP32_Matrix2x2* basic_matrix
|
||||||
sum->r2c2 = basic_matrix->r2c2 + scalable_matrix->r2c2 * scale;
|
sum->r2c2 = basic_matrix->r2c2 + scalable_matrix->r2c2 * scale;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_add_scaled(const BGC_FP64_Matrix2x2* basic_matrix, const BGC_FP64_Matrix2x2* scalable_matrix, const double scale, BGC_FP64_Matrix2x2* sum)
|
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->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
||||||
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
||||||
|
|
@ -517,7 +517,7 @@ inline void bgc_fp64_matrix2x2_add_scaled(const BGC_FP64_Matrix2x2* basic_matrix
|
||||||
|
|
||||||
// ================== Subtract ================== //
|
// ================== Subtract ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_subtract(const BGC_FP32_Matrix2x2* minuend, const BGC_FP32_Matrix2x2* subtrahend, BGC_FP32_Matrix2x2* difference)
|
inline void bgc_fp32_matrix2x2_subtract(BGC_FP32_Matrix2x2* difference, const BGC_FP32_Matrix2x2* minuend, const BGC_FP32_Matrix2x2* subtrahend)
|
||||||
{
|
{
|
||||||
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
||||||
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
||||||
|
|
@ -526,7 +526,7 @@ inline void bgc_fp32_matrix2x2_subtract(const BGC_FP32_Matrix2x2* minuend, const
|
||||||
difference->r2c2 = minuend->r2c2 - subtrahend->r2c2;
|
difference->r2c2 = minuend->r2c2 - subtrahend->r2c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_subtract(const BGC_FP64_Matrix2x2* minuend, const BGC_FP64_Matrix2x2* subtrahend, BGC_FP64_Matrix2x2* difference)
|
inline void bgc_fp64_matrix2x2_subtract(BGC_FP64_Matrix2x2* difference, const BGC_FP64_Matrix2x2* minuend, const BGC_FP64_Matrix2x2* subtrahend)
|
||||||
{
|
{
|
||||||
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
||||||
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
||||||
|
|
@ -537,7 +537,7 @@ inline void bgc_fp64_matrix2x2_subtract(const BGC_FP64_Matrix2x2* minuend, const
|
||||||
|
|
||||||
// ================== Multiply ================== //
|
// ================== Multiply ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_multiply(const BGC_FP32_Matrix2x2* multiplicand, const float multiplier, BGC_FP32_Matrix2x2* product)
|
inline void bgc_fp32_matrix2x2_multiply(BGC_FP32_Matrix2x2* product, const BGC_FP32_Matrix2x2* multiplicand, const float multiplier)
|
||||||
{
|
{
|
||||||
product->r1c1 = multiplicand->r1c1 * multiplier;
|
product->r1c1 = multiplicand->r1c1 * multiplier;
|
||||||
product->r1c2 = multiplicand->r1c2 * multiplier;
|
product->r1c2 = multiplicand->r1c2 * multiplier;
|
||||||
|
|
@ -546,7 +546,7 @@ inline void bgc_fp32_matrix2x2_multiply(const BGC_FP32_Matrix2x2* multiplicand,
|
||||||
product->r2c2 = multiplicand->r2c2 * multiplier;
|
product->r2c2 = multiplicand->r2c2 * multiplier;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_multiply(const BGC_FP64_Matrix2x2* multiplicand, const double multiplier, BGC_FP64_Matrix2x2* product)
|
inline void bgc_fp64_matrix2x2_multiply(BGC_FP64_Matrix2x2* product, const BGC_FP64_Matrix2x2* multiplicand, const double multiplier)
|
||||||
{
|
{
|
||||||
product->r1c1 = multiplicand->r1c1 * multiplier;
|
product->r1c1 = multiplicand->r1c1 * multiplier;
|
||||||
product->r1c2 = multiplicand->r1c2 * multiplier;
|
product->r1c2 = multiplicand->r1c2 * multiplier;
|
||||||
|
|
@ -557,19 +557,19 @@ inline void bgc_fp64_matrix2x2_multiply(const BGC_FP64_Matrix2x2* multiplicand,
|
||||||
|
|
||||||
// =================== Divide =================== //
|
// =================== Divide =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_divide(const BGC_FP32_Matrix2x2* dividend, const float divisor, BGC_FP32_Matrix2x2* quotient)
|
inline void bgc_fp32_matrix2x2_divide(BGC_FP32_Matrix2x2* quotient, const BGC_FP32_Matrix2x2* dividend, const float divisor)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix2x2_multiply(dividend, 1.0f / divisor, quotient);
|
bgc_fp32_matrix2x2_multiply(quotient, dividend, 1.0f / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_divide(const BGC_FP64_Matrix2x2* dividend, const double divisor, BGC_FP64_Matrix2x2* quotient)
|
inline void bgc_fp64_matrix2x2_divide(BGC_FP64_Matrix2x2* quotient, const BGC_FP64_Matrix2x2* dividend, const double divisor)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix2x2_multiply(dividend, 1.0 / divisor, quotient);
|
bgc_fp64_matrix2x2_multiply(quotient, dividend, 1.0 / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================ Interpolate ================= //
|
// ================ Interpolate ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x2_interpolate(const BGC_FP32_Matrix2x2* first, const BGC_FP32_Matrix2x2* second, const float phase, BGC_FP32_Matrix2x2* interpolation)
|
inline void bgc_fp32_matrix2x2_interpolate(BGC_FP32_Matrix2x2* interpolation, const BGC_FP32_Matrix2x2* first, const BGC_FP32_Matrix2x2* second, const float phase)
|
||||||
{
|
{
|
||||||
const float counter_phase = 1.0f - phase;
|
const float counter_phase = 1.0f - phase;
|
||||||
|
|
||||||
|
|
@ -580,7 +580,7 @@ inline void bgc_fp32_matrix2x2_interpolate(const BGC_FP32_Matrix2x2* first, cons
|
||||||
interpolation->r2c2 = first->r2c2 * counter_phase + second->r2c2 * phase;
|
interpolation->r2c2 = first->r2c2 * counter_phase + second->r2c2 * phase;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x2_interpolate(const BGC_FP64_Matrix2x2* first, const BGC_FP64_Matrix2x2* second, const double phase, BGC_FP64_Matrix2x2* interpolation)
|
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;
|
const double counter_phase = 1.0 - phase;
|
||||||
|
|
||||||
|
|
@ -593,7 +593,7 @@ inline void bgc_fp64_matrix2x2_interpolate(const BGC_FP64_Matrix2x2* first, cons
|
||||||
|
|
||||||
// ============ Right Vector Product ============ //
|
// ============ Right Vector Product ============ //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix2x2_by_vector2(const BGC_FP32_Matrix2x2* matrix, const BGC_FP32_Vector2* vector, BGC_FP32_Vector2* 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->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
|
const float x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
|
||||||
const float x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
|
const float x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
|
||||||
|
|
@ -602,7 +602,7 @@ inline void bgc_fp32_multiply_matrix2x2_by_vector2(const BGC_FP32_Matrix2x2* mat
|
||||||
product->x2 = x2;
|
product->x2 = x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix2x2_by_vector2(const BGC_FP64_Matrix2x2* matrix, const BGC_FP64_Vector2* vector, BGC_FP64_Vector2* product)
|
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->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
|
const double x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
|
||||||
const double x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
|
const double x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
|
||||||
|
|
@ -613,7 +613,7 @@ inline void bgc_fp64_multiply_matrix2x2_by_vector2(const BGC_FP64_Matrix2x2* mat
|
||||||
|
|
||||||
// ============ Left Vector Product ============= //
|
// ============ Left Vector Product ============= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_vector2_by_matrix2x2(const BGC_FP32_Vector2* vector, const BGC_FP32_Matrix2x2* matrix, BGC_FP32_Vector2* product)
|
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->r1c1 + vector->x2 * matrix->r2c1;
|
const float x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1;
|
||||||
const float x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2;
|
const float x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2;
|
||||||
|
|
@ -622,7 +622,7 @@ inline void bgc_fp32_multiply_vector2_by_matrix2x2(const BGC_FP32_Vector2* vecto
|
||||||
product->x2 = x2;
|
product->x2 = x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_vector2_by_matrix2x2(const BGC_FP64_Vector2* vector, const BGC_FP64_Matrix2x2* matrix, BGC_FP64_Vector2* product)
|
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->r1c1 + vector->x2 * matrix->r2c1;
|
const double x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1;
|
||||||
const double x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2;
|
const double x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2;
|
||||||
|
|
|
||||||
|
|
@ -3,50 +3,50 @@
|
||||||
extern inline void bgc_fp32_matrix2x3_reset(BGC_FP32_Matrix2x3* matrix);
|
extern inline void bgc_fp32_matrix2x3_reset(BGC_FP32_Matrix2x3* matrix);
|
||||||
extern inline void bgc_fp64_matrix2x3_reset(BGC_FP64_Matrix2x3* matrix);
|
extern inline void bgc_fp64_matrix2x3_reset(BGC_FP64_Matrix2x3* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_copy(const BGC_FP32_Matrix2x3* source, BGC_FP32_Matrix2x3* destination);
|
extern inline void bgc_fp32_matrix2x3_copy(BGC_FP32_Matrix2x3* destination, const BGC_FP32_Matrix2x3* source);
|
||||||
extern inline void bgc_fp64_matrix2x3_copy(const BGC_FP64_Matrix2x3* source, BGC_FP64_Matrix2x3* destination);
|
extern inline void bgc_fp64_matrix2x3_copy(BGC_FP64_Matrix2x3* destination, const BGC_FP64_Matrix2x3* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_swap(BGC_FP32_Matrix2x3* matrix1, BGC_FP32_Matrix2x3* matrix2);
|
extern inline void bgc_fp32_matrix2x3_swap(BGC_FP32_Matrix2x3* matrix1, BGC_FP32_Matrix2x3* matrix2);
|
||||||
extern inline void bgc_fp64_matrix2x3_swap(BGC_FP64_Matrix2x3* matrix1, BGC_FP64_Matrix2x3* matrix2);
|
extern inline void bgc_fp64_matrix2x3_swap(BGC_FP64_Matrix2x3* matrix1, BGC_FP64_Matrix2x3* matrix2);
|
||||||
|
|
||||||
extern inline void bgc_fp64_matrix2x3_convert_to_fp32(const BGC_FP64_Matrix2x3* source, BGC_FP32_Matrix2x3* destination);
|
extern inline void bgc_fp32_matrix2x3_convert_to_fp64(BGC_FP64_Matrix2x3* destination, const BGC_FP32_Matrix2x3* source);
|
||||||
extern inline void bgc_fp32_matrix2x3_convert_to_fp64(const BGC_FP32_Matrix2x3* source, BGC_FP64_Matrix2x3* destination);
|
extern inline void bgc_fp64_matrix2x3_convert_to_fp32(BGC_FP32_Matrix2x3* destination, const BGC_FP64_Matrix2x3* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_get_transposed(const BGC_FP32_Matrix3x2* matrix, BGC_FP32_Matrix2x3* transposed);
|
extern inline void bgc_fp32_matrix2x3_get_transposed(BGC_FP32_Matrix2x3* transposed, const BGC_FP32_Matrix3x2* matrix);
|
||||||
extern inline void bgc_fp64_matrix2x3_get_transposed(const BGC_FP64_Matrix3x2* matrix, BGC_FP64_Matrix2x3* transposed);
|
extern inline void bgc_fp64_matrix2x3_get_transposed(BGC_FP64_Matrix2x3* transposed, const BGC_FP64_Matrix3x2* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_get_row(const int number, const BGC_FP32_Matrix2x3* matrix, BGC_FP32_Vector2* row);
|
extern inline void bgc_fp32_matrix2x3_get_row(BGC_FP32_Vector2* row, const BGC_FP32_Matrix2x3* matrix, const int row_number);
|
||||||
extern inline void bgc_fp64_matrix2x3_get_row(const int number, const BGC_FP64_Matrix2x3* matrix, BGC_FP64_Vector2* row);
|
extern inline void bgc_fp64_matrix2x3_get_row(BGC_FP64_Vector2* row, const BGC_FP64_Matrix2x3* matrix, const int row_number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_set_row(const int number, const BGC_FP32_Vector2* row, BGC_FP32_Matrix2x3* matrix);
|
extern inline void bgc_fp32_matrix2x3_set_row(BGC_FP32_Matrix2x3* matrix, const int row_number, const BGC_FP32_Vector2* row);
|
||||||
extern inline void bgc_fp64_matrix2x3_set_row(const int number, const BGC_FP64_Vector2* row, BGC_FP64_Matrix2x3* matrix);
|
extern inline void bgc_fp64_matrix2x3_set_row(BGC_FP64_Matrix2x3* matrix, const int row_number, const BGC_FP64_Vector2* row);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_get_column(const int number, const BGC_FP32_Matrix2x3* matrix, BGC_FP32_Vector3* column);
|
extern inline void bgc_fp32_matrix2x3_get_column(BGC_FP32_Vector3* column, const BGC_FP32_Matrix2x3* matrix, const int column_number);
|
||||||
extern inline void bgc_fp64_matrix2x3_get_column(const int number, const BGC_FP64_Matrix2x3* matrix, BGC_FP64_Vector3* column);
|
extern inline void bgc_fp64_matrix2x3_get_column(BGC_FP64_Vector3* column, const BGC_FP64_Matrix2x3* matrix, const int column_number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_set_column(const int number, const BGC_FP32_Vector3* column, BGC_FP32_Matrix2x3* matrix);
|
extern inline void bgc_fp32_matrix2x3_set_column(BGC_FP32_Matrix2x3* matrix, const int number, const BGC_FP32_Vector3* column);
|
||||||
extern inline void bgc_fp64_matrix2x3_set_column(const int number, const BGC_FP64_Vector3* column, BGC_FP64_Matrix2x3* matrix);
|
extern inline void bgc_fp64_matrix2x3_set_column(BGC_FP64_Matrix2x3* matrix, const int number, const BGC_FP64_Vector3* column);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_add(const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix2x3* matrix2, BGC_FP32_Matrix2x3* sum);
|
extern inline void bgc_fp32_matrix2x3_add(BGC_FP32_Matrix2x3* sum, const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix2x3* matrix2);
|
||||||
extern inline void bgc_fp64_matrix2x3_add(const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix2x3* matrix2, BGC_FP64_Matrix2x3* sum);
|
extern inline void bgc_fp64_matrix2x3_add(BGC_FP64_Matrix2x3* sum, const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix2x3* matrix2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_add_scaled(const BGC_FP32_Matrix2x3* basic_matrix, const BGC_FP32_Matrix2x3* scalable_matrix, const float scale, BGC_FP32_Matrix2x3* sum);
|
extern 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);
|
||||||
extern inline void bgc_fp64_matrix2x3_add_scaled(const BGC_FP64_Matrix2x3* basic_matrix, const BGC_FP64_Matrix2x3* scalable_matrix, const double scale, BGC_FP64_Matrix2x3* sum);
|
extern 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);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_subtract(const BGC_FP32_Matrix2x3* minuend, const BGC_FP32_Matrix2x3* subtrahend, BGC_FP32_Matrix2x3* difference);
|
extern inline void bgc_fp32_matrix2x3_subtract(BGC_FP32_Matrix2x3* difference, const BGC_FP32_Matrix2x3* minuend, const BGC_FP32_Matrix2x3* subtrahend);
|
||||||
extern inline void bgc_fp64_matrix2x3_subtract(const BGC_FP64_Matrix2x3* minuend, const BGC_FP64_Matrix2x3* subtrahend, BGC_FP64_Matrix2x3* difference);
|
extern inline void bgc_fp64_matrix2x3_subtract(BGC_FP64_Matrix2x3* difference, const BGC_FP64_Matrix2x3* minuend, const BGC_FP64_Matrix2x3* subtrahend);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_multiply(const BGC_FP32_Matrix2x3* multiplicand, const float multiplier, BGC_FP32_Matrix2x3* product);
|
extern inline void bgc_fp32_matrix2x3_multiply(BGC_FP32_Matrix2x3* product, const BGC_FP32_Matrix2x3* multiplicand, const float multiplier);
|
||||||
extern inline void bgc_fp64_matrix2x3_multiply(const BGC_FP64_Matrix2x3* multiplicand, const double multiplier, BGC_FP64_Matrix2x3* product);
|
extern inline void bgc_fp64_matrix2x3_multiply(BGC_FP64_Matrix2x3* product, const BGC_FP64_Matrix2x3* multiplicand, const double multiplier);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_divide(const BGC_FP32_Matrix2x3* dividend, const float divisor, BGC_FP32_Matrix2x3* quotient);
|
extern inline void bgc_fp32_matrix2x3_divide(BGC_FP32_Matrix2x3* quotient, const BGC_FP32_Matrix2x3* dividend, const float divisor);
|
||||||
extern inline void bgc_fp64_matrix2x3_divide(const BGC_FP64_Matrix2x3* dividend, const double divisor, BGC_FP64_Matrix2x3* quotient);
|
extern inline void bgc_fp64_matrix2x3_divide(BGC_FP64_Matrix2x3* quotient, const BGC_FP64_Matrix2x3* dividend, const double divisor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix2x3_interpolate(const BGC_FP32_Matrix2x3* first, const BGC_FP32_Matrix2x3* second, const float phase, BGC_FP32_Matrix2x3* interpolation);
|
extern inline void bgc_fp32_matrix2x3_interpolate(BGC_FP32_Matrix2x3* interpolation, const BGC_FP32_Matrix2x3* first, const BGC_FP32_Matrix2x3* second, const float phase);
|
||||||
extern inline void bgc_fp64_matrix2x3_interpolate(const BGC_FP64_Matrix2x3* first, const BGC_FP64_Matrix2x3* second, const double phase, BGC_FP64_Matrix2x3* interpolation);
|
extern inline void bgc_fp64_matrix2x3_interpolate(BGC_FP64_Matrix2x3* interpolation, const BGC_FP64_Matrix2x3* first, const BGC_FP64_Matrix2x3* second, const double phase);
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_vector3_by_matrix2x3(const BGC_FP32_Vector3* vector, const BGC_FP32_Matrix2x3* matrix, BGC_FP32_Vector2* product);
|
extern inline void bgc_fp32_multiply_vector3_by_matrix2x3(BGC_FP32_Vector2* product, const BGC_FP32_Vector3* vector, const BGC_FP32_Matrix2x3* matrix);
|
||||||
extern inline void bgc_fp64_multiply_vector3_by_matrix2x3(const BGC_FP64_Vector3* vector, const BGC_FP64_Matrix2x3* matrix, BGC_FP64_Vector2* product);
|
extern inline void bgc_fp64_multiply_vector3_by_matrix2x3(BGC_FP64_Vector2* product, const BGC_FP64_Vector3* vector, const BGC_FP64_Matrix2x3* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix2x3_by_vector2(const BGC_FP32_Matrix2x3* matrix, const BGC_FP32_Vector2* vector, BGC_FP32_Vector3* product);
|
extern inline void bgc_fp32_multiply_matrix2x3_by_vector2(BGC_FP32_Vector3* product, const BGC_FP32_Matrix2x3* matrix, const BGC_FP32_Vector2* vector);
|
||||||
extern inline void bgc_fp64_multiply_matrix2x3_by_vector2(const BGC_FP64_Matrix2x3* matrix, const BGC_FP64_Vector2* vector, BGC_FP64_Vector3* product);
|
extern inline void bgc_fp64_multiply_matrix2x3_by_vector2(BGC_FP64_Vector3* product, const BGC_FP64_Matrix2x3* matrix, const BGC_FP64_Vector2* vector);
|
||||||
|
|
|
||||||
|
|
@ -3,7 +3,7 @@
|
||||||
|
|
||||||
#include "vector2.h"
|
#include "vector2.h"
|
||||||
#include "vector3.h"
|
#include "vector3.h"
|
||||||
#include "matrixes.h"
|
#include "matrices.h"
|
||||||
|
|
||||||
// =================== Reset ==================== //
|
// =================== Reset ==================== //
|
||||||
|
|
||||||
|
|
@ -33,7 +33,7 @@ inline void bgc_fp64_matrix2x3_reset(BGC_FP64_Matrix2x3* matrix)
|
||||||
|
|
||||||
// ==================== Copy ==================== //
|
// ==================== Copy ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_copy(const BGC_FP32_Matrix2x3* source, BGC_FP32_Matrix2x3* destination)
|
inline void bgc_fp32_matrix2x3_copy(BGC_FP32_Matrix2x3* destination, const BGC_FP32_Matrix2x3* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -45,7 +45,7 @@ inline void bgc_fp32_matrix2x3_copy(const BGC_FP32_Matrix2x3* source, BGC_FP32_M
|
||||||
destination->r3c2 = source->r3c2;
|
destination->r3c2 = source->r3c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_copy(const BGC_FP64_Matrix2x3* source, BGC_FP64_Matrix2x3* destination)
|
inline void bgc_fp64_matrix2x3_copy(BGC_FP64_Matrix2x3* destination, const BGC_FP64_Matrix2x3* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -121,7 +121,7 @@ inline void bgc_fp64_matrix2x3_swap(BGC_FP64_Matrix2x3* matrix1, BGC_FP64_Matrix
|
||||||
|
|
||||||
// ================== Convert =================== //
|
// ================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_convert_to_fp32(const BGC_FP64_Matrix2x3* source, BGC_FP32_Matrix2x3* destination)
|
inline void bgc_fp64_matrix2x3_convert_to_fp32(BGC_FP32_Matrix2x3* destination, const BGC_FP64_Matrix2x3* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = (float)source->r1c1;
|
destination->r1c1 = (float)source->r1c1;
|
||||||
destination->r1c2 = (float)source->r1c2;
|
destination->r1c2 = (float)source->r1c2;
|
||||||
|
|
@ -133,7 +133,7 @@ inline void bgc_fp64_matrix2x3_convert_to_fp32(const BGC_FP64_Matrix2x3* source,
|
||||||
destination->r3c2 = (float)source->r3c2;
|
destination->r3c2 = (float)source->r3c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_convert_to_fp64(const BGC_FP32_Matrix2x3* source, BGC_FP64_Matrix2x3* destination)
|
inline void bgc_fp32_matrix2x3_convert_to_fp64(BGC_FP64_Matrix2x3* destination, const BGC_FP32_Matrix2x3* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -147,7 +147,7 @@ inline void bgc_fp32_matrix2x3_convert_to_fp64(const BGC_FP32_Matrix2x3* source,
|
||||||
|
|
||||||
// ================= Transpose ================== //
|
// ================= Transpose ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_get_transposed(const BGC_FP32_Matrix3x2* matrix, BGC_FP32_Matrix2x3* transposed)
|
inline void bgc_fp32_matrix2x3_get_transposed(BGC_FP32_Matrix2x3* transposed, const BGC_FP32_Matrix3x2* matrix)
|
||||||
{
|
{
|
||||||
transposed->r1c1 = matrix->r1c1;
|
transposed->r1c1 = matrix->r1c1;
|
||||||
transposed->r1c2 = matrix->r2c1;
|
transposed->r1c2 = matrix->r2c1;
|
||||||
|
|
@ -159,7 +159,7 @@ inline void bgc_fp32_matrix2x3_get_transposed(const BGC_FP32_Matrix3x2* matrix,
|
||||||
transposed->r3c2 = matrix->r2c3;
|
transposed->r3c2 = matrix->r2c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_get_transposed(const BGC_FP64_Matrix3x2* matrix, BGC_FP64_Matrix2x3* transposed)
|
inline void bgc_fp64_matrix2x3_get_transposed(BGC_FP64_Matrix2x3* transposed, const BGC_FP64_Matrix3x2* matrix)
|
||||||
{
|
{
|
||||||
transposed->r1c1 = matrix->r1c1;
|
transposed->r1c1 = matrix->r1c1;
|
||||||
transposed->r1c2 = matrix->r2c1;
|
transposed->r1c2 = matrix->r2c1;
|
||||||
|
|
@ -173,21 +173,21 @@ inline void bgc_fp64_matrix2x3_get_transposed(const BGC_FP64_Matrix3x2* matrix,
|
||||||
|
|
||||||
// ================== Get Row =================== //
|
// ================== Get Row =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_get_row(const int number, const BGC_FP32_Matrix2x3* matrix, BGC_FP32_Vector2* row)
|
inline void bgc_fp32_matrix2x3_get_row(BGC_FP32_Vector2* row, const BGC_FP32_Matrix2x3* matrix, const int row_number)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (row_number == 1) {
|
||||||
row->x1 = matrix->r1c1;
|
row->x1 = matrix->r1c1;
|
||||||
row->x2 = matrix->r1c2;
|
row->x2 = matrix->r1c2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (row_number == 2) {
|
||||||
row->x1 = matrix->r2c1;
|
row->x1 = matrix->r2c1;
|
||||||
row->x2 = matrix->r2c2;
|
row->x2 = matrix->r2c2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3) {
|
if (row_number == 3) {
|
||||||
row->x1 = matrix->r3c1;
|
row->x1 = matrix->r3c1;
|
||||||
row->x2 = matrix->r3c2;
|
row->x2 = matrix->r3c2;
|
||||||
return;
|
return;
|
||||||
|
|
@ -197,21 +197,21 @@ inline void bgc_fp32_matrix2x3_get_row(const int number, const BGC_FP32_Matrix2x
|
||||||
row->x2 = 0.0f;
|
row->x2 = 0.0f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_get_row(const int number, const BGC_FP64_Matrix2x3* matrix, BGC_FP64_Vector2* row)
|
inline void bgc_fp64_matrix2x3_get_row(BGC_FP64_Vector2* row, const BGC_FP64_Matrix2x3* matrix, const int row_number)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (row_number == 1) {
|
||||||
row->x1 = matrix->r1c1;
|
row->x1 = matrix->r1c1;
|
||||||
row->x2 = matrix->r1c2;
|
row->x2 = matrix->r1c2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (row_number == 2) {
|
||||||
row->x1 = matrix->r2c1;
|
row->x1 = matrix->r2c1;
|
||||||
row->x2 = matrix->r2c2;
|
row->x2 = matrix->r2c2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3) {
|
if (row_number == 3) {
|
||||||
row->x1 = matrix->r3c1;
|
row->x1 = matrix->r3c1;
|
||||||
row->x2 = matrix->r3c2;
|
row->x2 = matrix->r3c2;
|
||||||
return;
|
return;
|
||||||
|
|
@ -223,41 +223,41 @@ inline void bgc_fp64_matrix2x3_get_row(const int number, const BGC_FP64_Matrix2x
|
||||||
|
|
||||||
// ================== Set Row =================== //
|
// ================== Set Row =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_set_row(const int number, const BGC_FP32_Vector2* row, BGC_FP32_Matrix2x3* matrix)
|
inline void bgc_fp32_matrix2x3_set_row(BGC_FP32_Matrix2x3* matrix, const int row_number, const BGC_FP32_Vector2* row)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (row_number == 1) {
|
||||||
matrix->r1c1 = row->x1;
|
matrix->r1c1 = row->x1;
|
||||||
matrix->r1c2 = row->x2;
|
matrix->r1c2 = row->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (row_number == 2) {
|
||||||
matrix->r2c1 = row->x1;
|
matrix->r2c1 = row->x1;
|
||||||
matrix->r2c2 = row->x2;
|
matrix->r2c2 = row->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3) {
|
if (row_number == 3) {
|
||||||
matrix->r3c1 = row->x1;
|
matrix->r3c1 = row->x1;
|
||||||
matrix->r3c2 = row->x2;
|
matrix->r3c2 = row->x2;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_set_row(const int number, const BGC_FP64_Vector2* row, BGC_FP64_Matrix2x3* matrix)
|
inline void bgc_fp64_matrix2x3_set_row(BGC_FP64_Matrix2x3* matrix, const int row_number, const BGC_FP64_Vector2* row)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (row_number == 1) {
|
||||||
matrix->r1c1 = row->x1;
|
matrix->r1c1 = row->x1;
|
||||||
matrix->r1c2 = row->x2;
|
matrix->r1c2 = row->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (row_number == 2) {
|
||||||
matrix->r2c1 = row->x1;
|
matrix->r2c1 = row->x1;
|
||||||
matrix->r2c2 = row->x2;
|
matrix->r2c2 = row->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3) {
|
if (row_number == 3) {
|
||||||
matrix->r3c1 = row->x1;
|
matrix->r3c1 = row->x1;
|
||||||
matrix->r3c2 = row->x2;
|
matrix->r3c2 = row->x2;
|
||||||
}
|
}
|
||||||
|
|
@ -265,32 +265,32 @@ inline void bgc_fp64_matrix2x3_set_row(const int number, const BGC_FP64_Vector2*
|
||||||
|
|
||||||
// ================= Get Column ================= //
|
// ================= Get Column ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_get_column(const int number, const BGC_FP32_Matrix2x3* matrix, BGC_FP32_Vector3* column)
|
inline void bgc_fp32_matrix2x3_get_column(BGC_FP32_Vector3* column, const BGC_FP32_Matrix2x3* matrix, const int column_number)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (column_number == 1) {
|
||||||
column->x1 = matrix->r1c1;
|
column->x1 = matrix->r1c1;
|
||||||
column->x2 = matrix->r2c1;
|
column->x2 = matrix->r2c1;
|
||||||
column->x3 = matrix->r3c1;
|
column->x3 = matrix->r3c1;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (column_number == 2) {
|
||||||
column->x1 = matrix->r1c2;
|
column->x1 = matrix->r1c2;
|
||||||
column->x2 = matrix->r2c2;
|
column->x2 = matrix->r2c2;
|
||||||
column->x3 = matrix->r3c2;
|
column->x3 = matrix->r3c2;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_get_column(const int number, const BGC_FP64_Matrix2x3* matrix, BGC_FP64_Vector3* column)
|
inline void bgc_fp64_matrix2x3_get_column(BGC_FP64_Vector3* column, const BGC_FP64_Matrix2x3* matrix, const int column_number)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (column_number == 1) {
|
||||||
column->x1 = matrix->r1c1;
|
column->x1 = matrix->r1c1;
|
||||||
column->x2 = matrix->r2c1;
|
column->x2 = matrix->r2c1;
|
||||||
column->x3 = matrix->r3c1;
|
column->x3 = matrix->r3c1;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (column_number == 2) {
|
||||||
column->x1 = matrix->r1c2;
|
column->x1 = matrix->r1c2;
|
||||||
column->x2 = matrix->r2c2;
|
column->x2 = matrix->r2c2;
|
||||||
column->x3 = matrix->r3c2;
|
column->x3 = matrix->r3c2;
|
||||||
|
|
@ -299,32 +299,32 @@ inline void bgc_fp64_matrix2x3_get_column(const int number, const BGC_FP64_Matri
|
||||||
|
|
||||||
// ================= Set Column ================= //
|
// ================= Set Column ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_set_column(const int number, const BGC_FP32_Vector3* column, BGC_FP32_Matrix2x3* matrix)
|
inline void bgc_fp32_matrix2x3_set_column(BGC_FP32_Matrix2x3* matrix, const int column_number, const BGC_FP32_Vector3* column)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (column_number == 1) {
|
||||||
matrix->r1c1 = column->x1;
|
matrix->r1c1 = column->x1;
|
||||||
matrix->r2c1 = column->x2;
|
matrix->r2c1 = column->x2;
|
||||||
matrix->r3c1 = column->x3;
|
matrix->r3c1 = column->x3;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (column_number == 2) {
|
||||||
matrix->r1c2 = column->x1;
|
matrix->r1c2 = column->x1;
|
||||||
matrix->r2c2 = column->x2;
|
matrix->r2c2 = column->x2;
|
||||||
matrix->r3c2 = column->x3;
|
matrix->r3c2 = column->x3;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_set_column(const int number, const BGC_FP64_Vector3* column, BGC_FP64_Matrix2x3* matrix)
|
inline void bgc_fp64_matrix2x3_set_column(BGC_FP64_Matrix2x3* matrix, const int column_number, const BGC_FP64_Vector3* column)
|
||||||
{
|
{
|
||||||
if (number == 1) {
|
if (column_number == 1) {
|
||||||
matrix->r1c1 = column->x1;
|
matrix->r1c1 = column->x1;
|
||||||
matrix->r2c1 = column->x2;
|
matrix->r2c1 = column->x2;
|
||||||
matrix->r3c1 = column->x3;
|
matrix->r3c1 = column->x3;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2) {
|
if (column_number == 2) {
|
||||||
matrix->r1c2 = column->x1;
|
matrix->r1c2 = column->x1;
|
||||||
matrix->r2c2 = column->x2;
|
matrix->r2c2 = column->x2;
|
||||||
matrix->r3c2 = column->x3;
|
matrix->r3c2 = column->x3;
|
||||||
|
|
@ -333,7 +333,7 @@ inline void bgc_fp64_matrix2x3_set_column(const int number, const BGC_FP64_Vecto
|
||||||
|
|
||||||
// ==================== Add ===================== //
|
// ==================== Add ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_add(const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix2x3* matrix2, BGC_FP32_Matrix2x3* sum)
|
inline void bgc_fp32_matrix2x3_add(BGC_FP32_Matrix2x3* sum, const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix2x3* matrix2)
|
||||||
{
|
{
|
||||||
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
||||||
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
||||||
|
|
@ -345,7 +345,7 @@ inline void bgc_fp32_matrix2x3_add(const BGC_FP32_Matrix2x3* matrix1, const BGC_
|
||||||
sum->r3c2 = matrix1->r3c2 + matrix2->r3c2;
|
sum->r3c2 = matrix1->r3c2 + matrix2->r3c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_add(const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix2x3* matrix2, BGC_FP64_Matrix2x3* sum)
|
inline void bgc_fp64_matrix2x3_add(BGC_FP64_Matrix2x3* sum, const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix2x3* matrix2)
|
||||||
{
|
{
|
||||||
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
||||||
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
||||||
|
|
@ -359,7 +359,7 @@ inline void bgc_fp64_matrix2x3_add(const BGC_FP64_Matrix2x3* matrix1, const BGC_
|
||||||
|
|
||||||
// ================= Add scaled ================= //
|
// ================= Add scaled ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_add_scaled(const BGC_FP32_Matrix2x3* basic_matrix, const BGC_FP32_Matrix2x3* scalable_matrix, const float scale, BGC_FP32_Matrix2x3* sum)
|
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->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
||||||
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
||||||
|
|
@ -371,7 +371,7 @@ inline void bgc_fp32_matrix2x3_add_scaled(const BGC_FP32_Matrix2x3* basic_matrix
|
||||||
sum->r3c2 = basic_matrix->r3c2 + scalable_matrix->r3c2 * scale;
|
sum->r3c2 = basic_matrix->r3c2 + scalable_matrix->r3c2 * scale;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_add_scaled(const BGC_FP64_Matrix2x3* basic_matrix, const BGC_FP64_Matrix2x3* scalable_matrix, const double scale, BGC_FP64_Matrix2x3* sum)
|
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->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
||||||
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
||||||
|
|
@ -385,7 +385,7 @@ inline void bgc_fp64_matrix2x3_add_scaled(const BGC_FP64_Matrix2x3* basic_matrix
|
||||||
|
|
||||||
// ================== Subtract ================== //
|
// ================== Subtract ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_subtract(const BGC_FP32_Matrix2x3* minuend, const BGC_FP32_Matrix2x3* subtrahend, BGC_FP32_Matrix2x3* difference)
|
inline void bgc_fp32_matrix2x3_subtract(BGC_FP32_Matrix2x3* difference, const BGC_FP32_Matrix2x3* minuend, const BGC_FP32_Matrix2x3* subtrahend)
|
||||||
{
|
{
|
||||||
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
||||||
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
||||||
|
|
@ -397,7 +397,7 @@ inline void bgc_fp32_matrix2x3_subtract(const BGC_FP32_Matrix2x3* minuend, const
|
||||||
difference->r3c2 = minuend->r3c2 - subtrahend->r3c2;
|
difference->r3c2 = minuend->r3c2 - subtrahend->r3c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_subtract(const BGC_FP64_Matrix2x3* minuend, const BGC_FP64_Matrix2x3* subtrahend, BGC_FP64_Matrix2x3* difference)
|
inline void bgc_fp64_matrix2x3_subtract(BGC_FP64_Matrix2x3* difference, const BGC_FP64_Matrix2x3* minuend, const BGC_FP64_Matrix2x3* subtrahend)
|
||||||
{
|
{
|
||||||
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
||||||
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
||||||
|
|
@ -411,7 +411,7 @@ inline void bgc_fp64_matrix2x3_subtract(const BGC_FP64_Matrix2x3* minuend, const
|
||||||
|
|
||||||
// ================== Multiply ================== //
|
// ================== Multiply ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_multiply(const BGC_FP32_Matrix2x3* multiplicand, const float multiplier, BGC_FP32_Matrix2x3* product)
|
inline void bgc_fp32_matrix2x3_multiply(BGC_FP32_Matrix2x3* product, const BGC_FP32_Matrix2x3* multiplicand, const float multiplier)
|
||||||
{
|
{
|
||||||
product->r1c1 = multiplicand->r1c1 * multiplier;
|
product->r1c1 = multiplicand->r1c1 * multiplier;
|
||||||
product->r1c2 = multiplicand->r1c2 * multiplier;
|
product->r1c2 = multiplicand->r1c2 * multiplier;
|
||||||
|
|
@ -423,7 +423,7 @@ inline void bgc_fp32_matrix2x3_multiply(const BGC_FP32_Matrix2x3* multiplicand,
|
||||||
product->r3c2 = multiplicand->r3c2 * multiplier;
|
product->r3c2 = multiplicand->r3c2 * multiplier;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_multiply(const BGC_FP64_Matrix2x3* multiplicand, const double multiplier, BGC_FP64_Matrix2x3* product)
|
inline void bgc_fp64_matrix2x3_multiply(BGC_FP64_Matrix2x3* product, const BGC_FP64_Matrix2x3* multiplicand, const double multiplier)
|
||||||
{
|
{
|
||||||
product->r1c1 = multiplicand->r1c1 * multiplier;
|
product->r1c1 = multiplicand->r1c1 * multiplier;
|
||||||
product->r1c2 = multiplicand->r1c2 * multiplier;
|
product->r1c2 = multiplicand->r1c2 * multiplier;
|
||||||
|
|
@ -437,19 +437,19 @@ inline void bgc_fp64_matrix2x3_multiply(const BGC_FP64_Matrix2x3* multiplicand,
|
||||||
|
|
||||||
// =================== Divide =================== //
|
// =================== Divide =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_divide(const BGC_FP32_Matrix2x3* dividend, const float divisor, BGC_FP32_Matrix2x3* quotient)
|
inline void bgc_fp32_matrix2x3_divide(BGC_FP32_Matrix2x3* quotient, const BGC_FP32_Matrix2x3* dividend, const float divisor)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix2x3_multiply(dividend, 1.0f / divisor, quotient);
|
bgc_fp32_matrix2x3_multiply(quotient, dividend, 1.0f / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_divide(const BGC_FP64_Matrix2x3* dividend, const double divisor, BGC_FP64_Matrix2x3* quotient)
|
inline void bgc_fp64_matrix2x3_divide(BGC_FP64_Matrix2x3* quotient, const BGC_FP64_Matrix2x3* dividend, const double divisor)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix2x3_multiply(dividend, 1.0 / divisor, quotient);
|
bgc_fp64_matrix2x3_multiply(quotient, dividend, 1.0 / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================ Interpolate ================= //
|
// ================ Interpolate ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix2x3_interpolate(const BGC_FP32_Matrix2x3* first, const BGC_FP32_Matrix2x3* second, const float phase, BGC_FP32_Matrix2x3* interpolation)
|
inline void bgc_fp32_matrix2x3_interpolate(BGC_FP32_Matrix2x3* interpolation, const BGC_FP32_Matrix2x3* first, const BGC_FP32_Matrix2x3* second, const float phase)
|
||||||
{
|
{
|
||||||
const float couter_phase = 1.0f - phase;
|
const float couter_phase = 1.0f - phase;
|
||||||
|
|
||||||
|
|
@ -463,7 +463,7 @@ inline void bgc_fp32_matrix2x3_interpolate(const BGC_FP32_Matrix2x3* first, cons
|
||||||
interpolation->r3c2 = first->r3c2 * couter_phase + second->r3c2 * phase;
|
interpolation->r3c2 = first->r3c2 * couter_phase + second->r3c2 * phase;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix2x3_interpolate(const BGC_FP64_Matrix2x3* first, const BGC_FP64_Matrix2x3* second, const double phase, BGC_FP64_Matrix2x3* interpolation)
|
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;
|
const double couter_phase = 1.0 - phase;
|
||||||
|
|
||||||
|
|
@ -479,13 +479,13 @@ inline void bgc_fp64_matrix2x3_interpolate(const BGC_FP64_Matrix2x3* first, cons
|
||||||
|
|
||||||
// ============ Left Vector Product ============= //
|
// ============ Left Vector Product ============= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_vector3_by_matrix2x3(const BGC_FP32_Vector3* vector, const BGC_FP32_Matrix2x3* matrix, BGC_FP32_Vector2* 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->r1c1 + vector->x2 * matrix->r2c1 + vector->x3 * matrix->r3c1;
|
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;
|
product->x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2 + vector->x3 * matrix->r3c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_vector3_by_matrix2x3(const BGC_FP64_Vector3* vector, const BGC_FP64_Matrix2x3* matrix, BGC_FP64_Vector2* product)
|
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->r1c1 + vector->x2 * matrix->r2c1 + vector->x3 * matrix->r3c1;
|
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;
|
product->x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2 + vector->x3 * matrix->r3c2;
|
||||||
|
|
@ -493,14 +493,14 @@ inline void bgc_fp64_multiply_vector3_by_matrix2x3(const BGC_FP64_Vector3* vecto
|
||||||
|
|
||||||
// ============ Right Vector Product ============ //
|
// ============ Right Vector Product ============ //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix2x3_by_vector2(const BGC_FP32_Matrix2x3* matrix, const BGC_FP32_Vector2* vector, BGC_FP32_Vector3* 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->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
|
product->x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
|
||||||
product->x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
|
product->x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
|
||||||
product->x3 = matrix->r3c1 * vector->x1 + matrix->r3c2 * vector->x2;
|
product->x3 = matrix->r3c1 * vector->x1 + matrix->r3c2 * vector->x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix2x3_by_vector2(const BGC_FP64_Matrix2x3* matrix, const BGC_FP64_Vector2* vector, BGC_FP64_Vector3* product)
|
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->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
|
product->x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2;
|
||||||
product->x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
|
product->x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2;
|
||||||
|
|
|
||||||
|
|
@ -3,50 +3,50 @@
|
||||||
extern inline void bgc_fp32_matrix3x2_reset(BGC_FP32_Matrix3x2* matrix);
|
extern inline void bgc_fp32_matrix3x2_reset(BGC_FP32_Matrix3x2* matrix);
|
||||||
extern inline void bgc_fp64_matrix3x2_reset(BGC_FP64_Matrix3x2* matrix);
|
extern inline void bgc_fp64_matrix3x2_reset(BGC_FP64_Matrix3x2* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_copy(const BGC_FP32_Matrix3x2* source, BGC_FP32_Matrix3x2* destination);
|
extern inline void bgc_fp32_matrix3x2_copy(BGC_FP32_Matrix3x2* destination, const BGC_FP32_Matrix3x2* source);
|
||||||
extern inline void bgc_fp64_matrix3x2_copy(const BGC_FP64_Matrix3x2* source, BGC_FP64_Matrix3x2* destination);
|
extern inline void bgc_fp64_matrix3x2_copy(BGC_FP64_Matrix3x2* destination, const BGC_FP64_Matrix3x2* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_swap(BGC_FP32_Matrix3x2* matrix1, BGC_FP32_Matrix3x2* matrix2);
|
extern inline void bgc_fp32_matrix3x2_swap(BGC_FP32_Matrix3x2* matrix1, BGC_FP32_Matrix3x2* matrix2);
|
||||||
extern inline void bgc_fp64_matrix3x2_swap(BGC_FP64_Matrix3x2* matrix1, BGC_FP64_Matrix3x2* matrix2);
|
extern inline void bgc_fp64_matrix3x2_swap(BGC_FP64_Matrix3x2* matrix1, BGC_FP64_Matrix3x2* matrix2);
|
||||||
|
|
||||||
extern inline void bgc_fp64_matrix3x2_convert_to_fp32(const BGC_FP64_Matrix3x2* source, BGC_FP32_Matrix3x2* destination);
|
extern inline void bgc_fp32_matrix3x2_convert_to_fp64(BGC_FP64_Matrix3x2* destination, const BGC_FP32_Matrix3x2* source);
|
||||||
extern inline void bgc_fp32_matrix3x2_convert_to_fp64(const BGC_FP32_Matrix3x2* source, BGC_FP64_Matrix3x2* destination);
|
extern inline void bgc_fp64_matrix3x2_convert_to_fp32(BGC_FP32_Matrix3x2* destination, const BGC_FP64_Matrix3x2* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_get_transposed(const BGC_FP32_Matrix2x3* matrix, BGC_FP32_Matrix3x2* transposed);
|
extern inline void bgc_fp32_matrix3x2_get_transposed(BGC_FP32_Matrix3x2* transposed, const BGC_FP32_Matrix2x3* matrix);
|
||||||
extern inline void bgc_fp64_matrix3x2_get_transposed(const BGC_FP64_Matrix2x3* matrix, BGC_FP64_Matrix3x2* transposed);
|
extern inline void bgc_fp64_matrix3x2_get_transposed(BGC_FP64_Matrix3x2* transposed, const BGC_FP64_Matrix2x3* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_get_row(const int number, const BGC_FP32_Matrix3x2* matrix, BGC_FP32_Vector3* row);
|
extern inline void bgc_fp32_matrix3x2_get_row(BGC_FP32_Vector3* row, const BGC_FP32_Matrix3x2* matrix, const int row_number);
|
||||||
extern inline void bgc_fp64_matrix3x2_get_row(const int number, const BGC_FP64_Matrix3x2* matrix, BGC_FP64_Vector3* row);
|
extern inline void bgc_fp64_matrix3x2_get_row(BGC_FP64_Vector3* row, const BGC_FP64_Matrix3x2* matrix, const int row_number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_set_row(const int number, const BGC_FP32_Vector3* row, BGC_FP32_Matrix3x2* matrix);
|
extern inline void bgc_fp32_matrix3x2_set_row(BGC_FP32_Matrix3x2* matrix, const int row_number, const BGC_FP32_Vector3* row);
|
||||||
extern inline void bgc_fp64_matrix3x2_set_row(const int number, const BGC_FP64_Vector3* row, BGC_FP64_Matrix3x2* matrix);
|
extern inline void bgc_fp64_matrix3x2_set_row(BGC_FP64_Matrix3x2* matrix, const int row_number, const BGC_FP64_Vector3* row);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_get_column(const int number, const BGC_FP32_Matrix3x2* matrix, BGC_FP32_Vector2* column);
|
extern inline void bgc_fp32_matrix3x2_get_column(BGC_FP32_Vector2* column, const BGC_FP32_Matrix3x2* matrix, const int column_number);
|
||||||
extern inline void bgc_fp64_matrix3x2_get_column(const int number, const BGC_FP64_Matrix3x2* matrix, BGC_FP64_Vector2* column);
|
extern inline void bgc_fp64_matrix3x2_get_column(BGC_FP64_Vector2* column, const BGC_FP64_Matrix3x2* matrix, const int column_number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_set_column(const int number, const BGC_FP32_Vector2* column, BGC_FP32_Matrix3x2* matrix);
|
extern inline void bgc_fp32_matrix3x2_set_column(BGC_FP32_Matrix3x2* matrix, const int column_number, const BGC_FP32_Vector2* column);
|
||||||
extern inline void bgc_fp64_matrix3x2_set_column(const int number, const BGC_FP64_Vector2* column, BGC_FP64_Matrix3x2* matrix);
|
extern inline void bgc_fp64_matrix3x2_set_column(BGC_FP64_Matrix3x2* matrix, const int column_number, const BGC_FP64_Vector2* column);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_add(const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix3x2* matrix2, BGC_FP32_Matrix3x2* sum);
|
extern inline void bgc_fp32_matrix3x2_add(BGC_FP32_Matrix3x2* sum, const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix3x2* matrix2);
|
||||||
extern inline void bgc_fp64_matrix3x2_add(const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix3x2* matrix2, BGC_FP64_Matrix3x2* sum);
|
extern inline void bgc_fp64_matrix3x2_add(BGC_FP64_Matrix3x2* sum, const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix3x2* matrix2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_add_scaled(const BGC_FP32_Matrix3x2* basic_matrix, const BGC_FP32_Matrix3x2* scalable_matrix, const float scale, BGC_FP32_Matrix3x2* sum);
|
extern inline void bgc_fp32_matrix3x2_add_scaled(BGC_FP32_Matrix3x2* sum, const BGC_FP32_Matrix3x2* basic_matrix, const BGC_FP32_Matrix3x2* scalable_matrix, const float scale);
|
||||||
extern inline void bgc_fp64_matrix3x2_add_scaled(const BGC_FP64_Matrix3x2* basic_matrix, const BGC_FP64_Matrix3x2* scalable_matrix, const double scale, BGC_FP64_Matrix3x2* sum);
|
extern inline void bgc_fp64_matrix3x2_add_scaled(BGC_FP64_Matrix3x2* sum, const BGC_FP64_Matrix3x2* basic_matrix, const BGC_FP64_Matrix3x2* scalable_matrix, const double scale);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_subtract(const BGC_FP32_Matrix3x2* minuend, const BGC_FP32_Matrix3x2* subtrahend, BGC_FP32_Matrix3x2* difference);
|
extern inline void bgc_fp32_matrix3x2_subtract(BGC_FP32_Matrix3x2* difference, const BGC_FP32_Matrix3x2* minuend, const BGC_FP32_Matrix3x2* subtrahend);
|
||||||
extern inline void bgc_fp64_matrix3x2_subtract(const BGC_FP64_Matrix3x2* minuend, const BGC_FP64_Matrix3x2* subtrahend, BGC_FP64_Matrix3x2* difference);
|
extern inline void bgc_fp64_matrix3x2_subtract(BGC_FP64_Matrix3x2* difference, const BGC_FP64_Matrix3x2* minuend, const BGC_FP64_Matrix3x2* subtrahend);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_multiply(const BGC_FP32_Matrix3x2* multiplicand, const float multiplier, BGC_FP32_Matrix3x2* product);
|
extern inline void bgc_fp32_matrix3x2_multiply(BGC_FP32_Matrix3x2* product, const BGC_FP32_Matrix3x2* multiplicand, const float multiplier);
|
||||||
extern inline void bgc_fp64_matrix3x2_multiply(const BGC_FP64_Matrix3x2* multiplicand, const double multiplier, BGC_FP64_Matrix3x2* product);
|
extern inline void bgc_fp64_matrix3x2_multiply(BGC_FP64_Matrix3x2* product, const BGC_FP64_Matrix3x2* multiplicand, const double multiplier);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_divide(const BGC_FP32_Matrix3x2* dividend, const float divisor, BGC_FP32_Matrix3x2* quotient);
|
extern inline void bgc_fp32_matrix3x2_divide(BGC_FP32_Matrix3x2* quotient, const BGC_FP32_Matrix3x2* dividend, const float divisor);
|
||||||
extern inline void bgc_fp64_matrix3x2_divide(const BGC_FP64_Matrix3x2* dividend, const double divisor, BGC_FP64_Matrix3x2* quotient);
|
extern inline void bgc_fp64_matrix3x2_divide(BGC_FP64_Matrix3x2* quotient, const BGC_FP64_Matrix3x2* dividend, const double divisor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x2_interpolate(const BGC_FP32_Matrix3x2* first, const BGC_FP32_Matrix3x2* second, const float phase, BGC_FP32_Matrix3x2* interpolation);
|
extern inline void bgc_fp32_matrix3x2_interpolate(BGC_FP32_Matrix3x2* interpolation, const BGC_FP32_Matrix3x2* first, const BGC_FP32_Matrix3x2* second, const float phase);
|
||||||
extern inline void bgc_fp64_matrix3x2_interpolate(const BGC_FP64_Matrix3x2* first, const BGC_FP64_Matrix3x2* second, const double phase, BGC_FP64_Matrix3x2* interpolation);
|
extern inline void bgc_fp64_matrix3x2_interpolate(BGC_FP64_Matrix3x2* interpolation, const BGC_FP64_Matrix3x2* first, const BGC_FP64_Matrix3x2* second, const double phase);
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_vector2_by_matrix3x2(const BGC_FP32_Vector2* vector, const BGC_FP32_Matrix3x2* matrix, BGC_FP32_Vector3* product);
|
extern inline void bgc_fp32_multiply_vector2_by_matrix3x2(BGC_FP32_Vector3* product, const BGC_FP32_Vector2* vector, const BGC_FP32_Matrix3x2* matrix);
|
||||||
extern inline void bgc_fp64_multiply_vector2_by_matrix3x2(const BGC_FP64_Vector2* vector, const BGC_FP64_Matrix3x2* matrix, BGC_FP64_Vector3* product);
|
extern inline void bgc_fp64_multiply_vector2_by_matrix3x2(BGC_FP64_Vector3* product, const BGC_FP64_Vector2* vector, const BGC_FP64_Matrix3x2* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix3x2_by_vector3(const BGC_FP32_Matrix3x2* matrix, const BGC_FP32_Vector3* vector, BGC_FP32_Vector2* product);
|
extern inline void bgc_fp32_multiply_matrix3x2_by_vector3(BGC_FP32_Vector2* product, const BGC_FP32_Matrix3x2* matrix, const BGC_FP32_Vector3* vector);
|
||||||
extern inline void bgc_fp64_multiply_matrix3x2_by_vector3(const BGC_FP64_Matrix3x2* matrix, const BGC_FP64_Vector3* vector, BGC_FP64_Vector2* product);
|
extern inline void bgc_fp64_multiply_matrix3x2_by_vector3(BGC_FP64_Vector2* product, const BGC_FP64_Matrix3x2* matrix, const BGC_FP64_Vector3* vector);
|
||||||
|
|
|
||||||
|
|
@ -3,7 +3,7 @@
|
||||||
|
|
||||||
#include "vector2.h"
|
#include "vector2.h"
|
||||||
#include "vector3.h"
|
#include "vector3.h"
|
||||||
#include "matrixes.h"
|
#include "matrices.h"
|
||||||
|
|
||||||
// =================== Reset ==================== //
|
// =================== Reset ==================== //
|
||||||
|
|
||||||
|
|
@ -31,7 +31,7 @@ inline void bgc_fp64_matrix3x2_reset(BGC_FP64_Matrix3x2* matrix)
|
||||||
|
|
||||||
// ==================== Copy ==================== //
|
// ==================== Copy ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_copy(const BGC_FP32_Matrix3x2* source, BGC_FP32_Matrix3x2* destination)
|
inline void bgc_fp32_matrix3x2_copy(BGC_FP32_Matrix3x2* destination, const BGC_FP32_Matrix3x2* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -42,7 +42,7 @@ inline void bgc_fp32_matrix3x2_copy(const BGC_FP32_Matrix3x2* source, BGC_FP32_M
|
||||||
destination->r2c3 = source->r2c3;
|
destination->r2c3 = source->r2c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_copy(const BGC_FP64_Matrix3x2* source, BGC_FP64_Matrix3x2* destination)
|
inline void bgc_fp64_matrix3x2_copy(BGC_FP64_Matrix3x2* destination, const BGC_FP64_Matrix3x2* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -111,7 +111,7 @@ inline void bgc_fp64_matrix3x2_swap(BGC_FP64_Matrix3x2* matrix1, BGC_FP64_Matrix
|
||||||
|
|
||||||
// ================== Convert =================== //
|
// ================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_convert_to_fp32(const BGC_FP64_Matrix3x2* source, BGC_FP32_Matrix3x2* destination)
|
inline void bgc_fp64_matrix3x2_convert_to_fp32(BGC_FP32_Matrix3x2* destination, const BGC_FP64_Matrix3x2* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = (float)source->r1c1;
|
destination->r1c1 = (float)source->r1c1;
|
||||||
destination->r1c2 = (float)source->r1c2;
|
destination->r1c2 = (float)source->r1c2;
|
||||||
|
|
@ -122,7 +122,7 @@ inline void bgc_fp64_matrix3x2_convert_to_fp32(const BGC_FP64_Matrix3x2* source,
|
||||||
destination->r2c3 = (float)source->r2c3;
|
destination->r2c3 = (float)source->r2c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_convert_to_fp64(const BGC_FP32_Matrix3x2* source, BGC_FP64_Matrix3x2* destination)
|
inline void bgc_fp32_matrix3x2_convert_to_fp64(BGC_FP64_Matrix3x2* destination, const BGC_FP32_Matrix3x2* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -135,7 +135,7 @@ inline void bgc_fp32_matrix3x2_convert_to_fp64(const BGC_FP32_Matrix3x2* source,
|
||||||
|
|
||||||
// ================= Transpose ================== //
|
// ================= Transpose ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_get_transposed(const BGC_FP32_Matrix2x3* matrix, BGC_FP32_Matrix3x2* transposed)
|
inline void bgc_fp32_matrix3x2_get_transposed(BGC_FP32_Matrix3x2* transposed, const BGC_FP32_Matrix2x3* matrix)
|
||||||
{
|
{
|
||||||
transposed->r1c1 = matrix->r1c1;
|
transposed->r1c1 = matrix->r1c1;
|
||||||
transposed->r1c2 = matrix->r2c1;
|
transposed->r1c2 = matrix->r2c1;
|
||||||
|
|
@ -146,7 +146,7 @@ inline void bgc_fp32_matrix3x2_get_transposed(const BGC_FP32_Matrix2x3* matrix,
|
||||||
transposed->r2c3 = matrix->r3c2;
|
transposed->r2c3 = matrix->r3c2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_get_transposed(const BGC_FP64_Matrix2x3* matrix, BGC_FP64_Matrix3x2* transposed)
|
inline void bgc_fp64_matrix3x2_get_transposed(BGC_FP64_Matrix3x2* transposed, const BGC_FP64_Matrix2x3* matrix)
|
||||||
{
|
{
|
||||||
transposed->r1c1 = matrix->r1c1;
|
transposed->r1c1 = matrix->r1c1;
|
||||||
transposed->r1c2 = matrix->r2c1;
|
transposed->r1c2 = matrix->r2c1;
|
||||||
|
|
@ -159,9 +159,9 @@ inline void bgc_fp64_matrix3x2_get_transposed(const BGC_FP64_Matrix2x3* matrix,
|
||||||
|
|
||||||
// ================== Get Row =================== //
|
// ================== Get Row =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_get_row(const int number, const BGC_FP32_Matrix3x2* matrix, BGC_FP32_Vector3* row)
|
inline void bgc_fp32_matrix3x2_get_row(BGC_FP32_Vector3* row, const BGC_FP32_Matrix3x2* matrix, const int row_number)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (row_number == 1)
|
||||||
{
|
{
|
||||||
row->x1 = matrix->r1c1;
|
row->x1 = matrix->r1c1;
|
||||||
row->x2 = matrix->r1c2;
|
row->x2 = matrix->r1c2;
|
||||||
|
|
@ -169,7 +169,7 @@ inline void bgc_fp32_matrix3x2_get_row(const int number, const BGC_FP32_Matrix3x
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (row_number == 2)
|
||||||
{
|
{
|
||||||
row->x1 = matrix->r2c1;
|
row->x1 = matrix->r2c1;
|
||||||
row->x2 = matrix->r2c2;
|
row->x2 = matrix->r2c2;
|
||||||
|
|
@ -182,9 +182,9 @@ inline void bgc_fp32_matrix3x2_get_row(const int number, const BGC_FP32_Matrix3x
|
||||||
row->x3 = 0.0f;
|
row->x3 = 0.0f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_get_row(const int number, const BGC_FP64_Matrix3x2* matrix, BGC_FP64_Vector3* row)
|
inline void bgc_fp64_matrix3x2_get_row(BGC_FP64_Vector3* row, const BGC_FP64_Matrix3x2* matrix, const int row_number)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (row_number == 1)
|
||||||
{
|
{
|
||||||
row->x1 = matrix->r1c1;
|
row->x1 = matrix->r1c1;
|
||||||
row->x2 = matrix->r1c2;
|
row->x2 = matrix->r1c2;
|
||||||
|
|
@ -192,7 +192,7 @@ inline void bgc_fp64_matrix3x2_get_row(const int number, const BGC_FP64_Matrix3x
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (row_number == 2)
|
||||||
{
|
{
|
||||||
row->x1 = matrix->r2c1;
|
row->x1 = matrix->r2c1;
|
||||||
row->x2 = matrix->r2c2;
|
row->x2 = matrix->r2c2;
|
||||||
|
|
@ -207,9 +207,9 @@ inline void bgc_fp64_matrix3x2_get_row(const int number, const BGC_FP64_Matrix3x
|
||||||
|
|
||||||
// ================== Set Row =================== //
|
// ================== Set Row =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_set_row(const int number, const BGC_FP32_Vector3* row, BGC_FP32_Matrix3x2* matrix)
|
inline void bgc_fp32_matrix3x2_set_row(BGC_FP32_Matrix3x2* matrix, const int row_number, const BGC_FP32_Vector3* row)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (row_number == 1)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = row->x1;
|
matrix->r1c1 = row->x1;
|
||||||
matrix->r1c2 = row->x2;
|
matrix->r1c2 = row->x2;
|
||||||
|
|
@ -217,7 +217,7 @@ inline void bgc_fp32_matrix3x2_set_row(const int number, const BGC_FP32_Vector3*
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (row_number == 2)
|
||||||
{
|
{
|
||||||
matrix->r2c1 = row->x1;
|
matrix->r2c1 = row->x1;
|
||||||
matrix->r2c2 = row->x2;
|
matrix->r2c2 = row->x2;
|
||||||
|
|
@ -225,9 +225,9 @@ inline void bgc_fp32_matrix3x2_set_row(const int number, const BGC_FP32_Vector3*
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_set_row(const int number, const BGC_FP64_Vector3* row, BGC_FP64_Matrix3x2* matrix)
|
inline void bgc_fp64_matrix3x2_set_row(BGC_FP64_Matrix3x2* matrix, const int row_number, const BGC_FP64_Vector3* row)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (row_number == 1)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = row->x1;
|
matrix->r1c1 = row->x1;
|
||||||
matrix->r1c2 = row->x2;
|
matrix->r1c2 = row->x2;
|
||||||
|
|
@ -235,7 +235,7 @@ inline void bgc_fp64_matrix3x2_set_row(const int number, const BGC_FP64_Vector3*
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (row_number == 2)
|
||||||
{
|
{
|
||||||
matrix->r2c1 = row->x1;
|
matrix->r2c1 = row->x1;
|
||||||
matrix->r2c2 = row->x2;
|
matrix->r2c2 = row->x2;
|
||||||
|
|
@ -245,23 +245,23 @@ inline void bgc_fp64_matrix3x2_set_row(const int number, const BGC_FP64_Vector3*
|
||||||
|
|
||||||
// ================= Get Column ================= //
|
// ================= Get Column ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_get_column(const int number, const BGC_FP32_Matrix3x2* matrix, BGC_FP32_Vector2* column)
|
inline void bgc_fp32_matrix3x2_get_column(BGC_FP32_Vector2* column, const BGC_FP32_Matrix3x2* matrix, const int column_number)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (column_number == 1)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c1;
|
column->x1 = matrix->r1c1;
|
||||||
column->x2 = matrix->r2c1;
|
column->x2 = matrix->r2c1;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (column_number == 2)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c2;
|
column->x1 = matrix->r1c2;
|
||||||
column->x2 = matrix->r2c2;
|
column->x2 = matrix->r2c2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (column_number == 3)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c3;
|
column->x1 = matrix->r1c3;
|
||||||
column->x2 = matrix->r2c3;
|
column->x2 = matrix->r2c3;
|
||||||
|
|
@ -272,23 +272,23 @@ inline void bgc_fp32_matrix3x2_get_column(const int number, const BGC_FP32_Matri
|
||||||
column->x2 = 0.0f;
|
column->x2 = 0.0f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_get_column(const int number, const BGC_FP64_Matrix3x2* matrix, BGC_FP64_Vector2* column)
|
inline void bgc_fp64_matrix3x2_get_column(BGC_FP64_Vector2* column, const BGC_FP64_Matrix3x2* matrix, const int column_number)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (column_number == 1)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c1;
|
column->x1 = matrix->r1c1;
|
||||||
column->x2 = matrix->r2c1;
|
column->x2 = matrix->r2c1;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (column_number == 2)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c2;
|
column->x1 = matrix->r1c2;
|
||||||
column->x2 = matrix->r2c2;
|
column->x2 = matrix->r2c2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (column_number == 3)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c3;
|
column->x1 = matrix->r1c3;
|
||||||
column->x2 = matrix->r2c3;
|
column->x2 = matrix->r2c3;
|
||||||
|
|
@ -301,46 +301,46 @@ inline void bgc_fp64_matrix3x2_get_column(const int number, const BGC_FP64_Matri
|
||||||
|
|
||||||
// ================= Set Column ================= //
|
// ================= Set Column ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_set_column(const int number, const BGC_FP32_Vector2* column, BGC_FP32_Matrix3x2* matrix)
|
inline void bgc_fp32_matrix3x2_set_column(BGC_FP32_Matrix3x2* matrix, const int column_number, const BGC_FP32_Vector2* column)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (column_number == 1)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = column->x1;
|
matrix->r1c1 = column->x1;
|
||||||
matrix->r2c1 = column->x2;
|
matrix->r2c1 = column->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (column_number == 2)
|
||||||
{
|
{
|
||||||
matrix->r1c2 = column->x1;
|
matrix->r1c2 = column->x1;
|
||||||
matrix->r2c2 = column->x2;
|
matrix->r2c2 = column->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (column_number == 3)
|
||||||
{
|
{
|
||||||
matrix->r1c3 = column->x1;
|
matrix->r1c3 = column->x1;
|
||||||
matrix->r2c3 = column->x2;
|
matrix->r2c3 = column->x2;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_set_column(const int number, const BGC_FP64_Vector2* column, BGC_FP64_Matrix3x2* matrix)
|
inline void bgc_fp64_matrix3x2_set_column(BGC_FP64_Matrix3x2* matrix, const int column_number, const BGC_FP64_Vector2* column)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (column_number == 1)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = column->x1;
|
matrix->r1c1 = column->x1;
|
||||||
matrix->r2c1 = column->x2;
|
matrix->r2c1 = column->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (column_number == 2)
|
||||||
{
|
{
|
||||||
matrix->r1c2 = column->x1;
|
matrix->r1c2 = column->x1;
|
||||||
matrix->r2c2 = column->x2;
|
matrix->r2c2 = column->x2;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (column_number == 3)
|
||||||
{
|
{
|
||||||
matrix->r1c3 = column->x1;
|
matrix->r1c3 = column->x1;
|
||||||
matrix->r2c3 = column->x2;
|
matrix->r2c3 = column->x2;
|
||||||
|
|
@ -349,7 +349,7 @@ inline void bgc_fp64_matrix3x2_set_column(const int number, const BGC_FP64_Vecto
|
||||||
|
|
||||||
// ==================== Add ===================== //
|
// ==================== Add ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_add(const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix3x2* matrix2, BGC_FP32_Matrix3x2* sum)
|
inline void bgc_fp32_matrix3x2_add(BGC_FP32_Matrix3x2* sum, const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix3x2* matrix2)
|
||||||
{
|
{
|
||||||
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
||||||
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
||||||
|
|
@ -360,7 +360,7 @@ inline void bgc_fp32_matrix3x2_add(const BGC_FP32_Matrix3x2* matrix1, const BGC_
|
||||||
sum->r2c3 = matrix1->r2c3 + matrix2->r2c3;
|
sum->r2c3 = matrix1->r2c3 + matrix2->r2c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_add(const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix3x2* matrix2, BGC_FP64_Matrix3x2* sum)
|
inline void bgc_fp64_matrix3x2_add(BGC_FP64_Matrix3x2* sum, const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix3x2* matrix2)
|
||||||
{
|
{
|
||||||
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
||||||
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
||||||
|
|
@ -373,7 +373,7 @@ inline void bgc_fp64_matrix3x2_add(const BGC_FP64_Matrix3x2* matrix1, const BGC_
|
||||||
|
|
||||||
// ================= Add scaled ================= //
|
// ================= Add scaled ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_add_scaled(const BGC_FP32_Matrix3x2* basic_matrix, const BGC_FP32_Matrix3x2* scalable_matrix, const float scale, BGC_FP32_Matrix3x2* sum)
|
inline void bgc_fp32_matrix3x2_add_scaled(BGC_FP32_Matrix3x2* sum, const BGC_FP32_Matrix3x2* basic_matrix, const BGC_FP32_Matrix3x2* scalable_matrix, const float scale)
|
||||||
{
|
{
|
||||||
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
||||||
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
||||||
|
|
@ -384,7 +384,7 @@ inline void bgc_fp32_matrix3x2_add_scaled(const BGC_FP32_Matrix3x2* basic_matrix
|
||||||
sum->r2c3 = basic_matrix->r2c3 + scalable_matrix->r2c3 * scale;
|
sum->r2c3 = basic_matrix->r2c3 + scalable_matrix->r2c3 * scale;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_add_scaled(const BGC_FP64_Matrix3x2* basic_matrix, const BGC_FP64_Matrix3x2* scalable_matrix, const double scale, BGC_FP64_Matrix3x2* sum)
|
inline void bgc_fp64_matrix3x2_add_scaled(BGC_FP64_Matrix3x2* sum, const BGC_FP64_Matrix3x2* basic_matrix, const BGC_FP64_Matrix3x2* scalable_matrix, const double scale)
|
||||||
{
|
{
|
||||||
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
||||||
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
||||||
|
|
@ -397,7 +397,7 @@ inline void bgc_fp64_matrix3x2_add_scaled(const BGC_FP64_Matrix3x2* basic_matrix
|
||||||
|
|
||||||
// ================== Subtract ================== //
|
// ================== Subtract ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_subtract(const BGC_FP32_Matrix3x2* minuend, const BGC_FP32_Matrix3x2* subtrahend, BGC_FP32_Matrix3x2* difference)
|
inline void bgc_fp32_matrix3x2_subtract(BGC_FP32_Matrix3x2* difference, const BGC_FP32_Matrix3x2* minuend, const BGC_FP32_Matrix3x2* subtrahend)
|
||||||
{
|
{
|
||||||
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
||||||
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
||||||
|
|
@ -408,7 +408,7 @@ inline void bgc_fp32_matrix3x2_subtract(const BGC_FP32_Matrix3x2* minuend, const
|
||||||
difference->r2c3 = minuend->r2c3 - subtrahend->r2c3;
|
difference->r2c3 = minuend->r2c3 - subtrahend->r2c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_subtract(const BGC_FP64_Matrix3x2* minuend, const BGC_FP64_Matrix3x2* subtrahend, BGC_FP64_Matrix3x2* difference)
|
inline void bgc_fp64_matrix3x2_subtract(BGC_FP64_Matrix3x2* difference, const BGC_FP64_Matrix3x2* minuend, const BGC_FP64_Matrix3x2* subtrahend)
|
||||||
{
|
{
|
||||||
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
||||||
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
||||||
|
|
@ -421,7 +421,7 @@ inline void bgc_fp64_matrix3x2_subtract(const BGC_FP64_Matrix3x2* minuend, const
|
||||||
|
|
||||||
// ================== Multiply ================== //
|
// ================== Multiply ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_multiply(const BGC_FP32_Matrix3x2* multiplicand, const float multiplier, BGC_FP32_Matrix3x2* product)
|
inline void bgc_fp32_matrix3x2_multiply(BGC_FP32_Matrix3x2* product, const BGC_FP32_Matrix3x2* multiplicand, const float multiplier)
|
||||||
{
|
{
|
||||||
product->r1c1 = multiplicand->r1c1 * multiplier;
|
product->r1c1 = multiplicand->r1c1 * multiplier;
|
||||||
product->r1c2 = multiplicand->r1c2 * multiplier;
|
product->r1c2 = multiplicand->r1c2 * multiplier;
|
||||||
|
|
@ -432,7 +432,7 @@ inline void bgc_fp32_matrix3x2_multiply(const BGC_FP32_Matrix3x2* multiplicand,
|
||||||
product->r2c3 = multiplicand->r2c3 * multiplier;
|
product->r2c3 = multiplicand->r2c3 * multiplier;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_multiply(const BGC_FP64_Matrix3x2* multiplicand, const double multiplier, BGC_FP64_Matrix3x2* product)
|
inline void bgc_fp64_matrix3x2_multiply(BGC_FP64_Matrix3x2* product, const BGC_FP64_Matrix3x2* multiplicand, const double multiplier)
|
||||||
{
|
{
|
||||||
product->r1c1 = multiplicand->r1c1 * multiplier;
|
product->r1c1 = multiplicand->r1c1 * multiplier;
|
||||||
product->r1c2 = multiplicand->r1c2 * multiplier;
|
product->r1c2 = multiplicand->r1c2 * multiplier;
|
||||||
|
|
@ -445,19 +445,19 @@ inline void bgc_fp64_matrix3x2_multiply(const BGC_FP64_Matrix3x2* multiplicand,
|
||||||
|
|
||||||
// =================== Divide =================== //
|
// =================== Divide =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_divide(const BGC_FP32_Matrix3x2* dividend, const float divisor, BGC_FP32_Matrix3x2* quotient)
|
inline void bgc_fp32_matrix3x2_divide(BGC_FP32_Matrix3x2* quotient, const BGC_FP32_Matrix3x2* dividend, const float divisor)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix3x2_multiply(dividend, 1.0f / divisor, quotient);
|
bgc_fp32_matrix3x2_multiply(quotient, dividend, 1.0f / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_divide(const BGC_FP64_Matrix3x2* dividend, const double divisor, BGC_FP64_Matrix3x2* quotient)
|
inline void bgc_fp64_matrix3x2_divide(BGC_FP64_Matrix3x2* quotient, const BGC_FP64_Matrix3x2* dividend, const double divisor)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix3x2_multiply(dividend, 1.0 / divisor, quotient);
|
bgc_fp64_matrix3x2_multiply(quotient, dividend, 1.0 / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================ Interpolate ================= //
|
// ================ Interpolate ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x2_interpolate(const BGC_FP32_Matrix3x2* first, const BGC_FP32_Matrix3x2* second, const float phase, BGC_FP32_Matrix3x2* interpolation)
|
inline void bgc_fp32_matrix3x2_interpolate(BGC_FP32_Matrix3x2* interpolation, const BGC_FP32_Matrix3x2* first, const BGC_FP32_Matrix3x2* second, const float phase)
|
||||||
{
|
{
|
||||||
const float couter_phase = 1.0f - phase;
|
const float couter_phase = 1.0f - phase;
|
||||||
|
|
||||||
|
|
@ -470,7 +470,7 @@ inline void bgc_fp32_matrix3x2_interpolate(const BGC_FP32_Matrix3x2* first, cons
|
||||||
interpolation->r2c3 = first->r2c3 * couter_phase + second->r2c3 * phase;
|
interpolation->r2c3 = first->r2c3 * couter_phase + second->r2c3 * phase;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x2_interpolate(const BGC_FP64_Matrix3x2* first, const BGC_FP64_Matrix3x2* second, const double phase, BGC_FP64_Matrix3x2* interpolation)
|
inline void bgc_fp64_matrix3x2_interpolate(BGC_FP64_Matrix3x2* interpolation, const BGC_FP64_Matrix3x2* first, const BGC_FP64_Matrix3x2* second, const double phase)
|
||||||
{
|
{
|
||||||
const double couter_phase = 1.0 - phase;
|
const double couter_phase = 1.0 - phase;
|
||||||
|
|
||||||
|
|
@ -485,14 +485,14 @@ inline void bgc_fp64_matrix3x2_interpolate(const BGC_FP64_Matrix3x2* first, cons
|
||||||
|
|
||||||
// ============ Left Vector Product ============= //
|
// ============ Left Vector Product ============= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_vector2_by_matrix3x2(const BGC_FP32_Vector2* vector, const BGC_FP32_Matrix3x2* matrix, BGC_FP32_Vector3* product)
|
inline void bgc_fp32_multiply_vector2_by_matrix3x2(BGC_FP32_Vector3* product, const BGC_FP32_Vector2* vector, const BGC_FP32_Matrix3x2* matrix)
|
||||||
{
|
{
|
||||||
product->x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1;
|
product->x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1;
|
||||||
product->x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2;
|
product->x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2;
|
||||||
product->x3 = vector->x1 * matrix->r1c3 + vector->x2 * matrix->r2c3;
|
product->x3 = vector->x1 * matrix->r1c3 + vector->x2 * matrix->r2c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_vector2_by_matrix3x2(const BGC_FP64_Vector2* vector, const BGC_FP64_Matrix3x2* matrix, BGC_FP64_Vector3* product)
|
inline void bgc_fp64_multiply_vector2_by_matrix3x2(BGC_FP64_Vector3* product, const BGC_FP64_Vector2* vector, const BGC_FP64_Matrix3x2* matrix)
|
||||||
{
|
{
|
||||||
product->x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1;
|
product->x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1;
|
||||||
product->x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2;
|
product->x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2;
|
||||||
|
|
@ -501,13 +501,13 @@ inline void bgc_fp64_multiply_vector2_by_matrix3x2(const BGC_FP64_Vector2* vecto
|
||||||
|
|
||||||
// ============ Right Vector Product ============ //
|
// ============ Right Vector Product ============ //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix3x2_by_vector3(const BGC_FP32_Matrix3x2* matrix, const BGC_FP32_Vector3* vector, BGC_FP32_Vector2* product)
|
inline void bgc_fp32_multiply_matrix3x2_by_vector3(BGC_FP32_Vector2* product, const BGC_FP32_Matrix3x2* matrix, const BGC_FP32_Vector3* vector)
|
||||||
{
|
{
|
||||||
product->x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2 + matrix->r1c3 * vector->x3;
|
product->x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2 + matrix->r1c3 * vector->x3;
|
||||||
product->x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2 + matrix->r2c3 * vector->x3;
|
product->x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2 + matrix->r2c3 * vector->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix3x2_by_vector3(const BGC_FP64_Matrix3x2* matrix, const BGC_FP64_Vector3* vector, BGC_FP64_Vector2* product)
|
inline void bgc_fp64_multiply_matrix3x2_by_vector3(BGC_FP64_Vector2* product, const BGC_FP64_Matrix3x2* matrix, const BGC_FP64_Vector3* vector)
|
||||||
{
|
{
|
||||||
product->x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2 + matrix->r1c3 * vector->x3;
|
product->x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2 + matrix->r1c3 * vector->x3;
|
||||||
product->x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2 + matrix->r2c3 * vector->x3;
|
product->x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2 + matrix->r2c3 * vector->x3;
|
||||||
|
|
|
||||||
|
|
@ -6,17 +6,17 @@ extern inline void bgc_fp64_matrix3x3_reset(BGC_FP64_Matrix3x3* matrix);
|
||||||
extern inline void bgc_fp32_matrix3x3_make_identity(BGC_FP32_Matrix3x3* matrix);
|
extern inline void bgc_fp32_matrix3x3_make_identity(BGC_FP32_Matrix3x3* matrix);
|
||||||
extern inline void bgc_fp64_matrix3x3_make_identity(BGC_FP64_Matrix3x3* matrix);
|
extern inline void bgc_fp64_matrix3x3_make_identity(BGC_FP64_Matrix3x3* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_make_diagonal(const float d1, const float d2, const float d3, BGC_FP32_Matrix3x3* matrix);
|
extern inline void bgc_fp32_matrix3x3_make_diagonal(BGC_FP32_Matrix3x3* matrix, const float d1, const float d2, const float d3);
|
||||||
extern inline void bgc_fp64_matrix3x3_make_diagonal(const double d1, const double d2, const double d3, BGC_FP64_Matrix3x3* matrix);
|
extern inline void bgc_fp64_matrix3x3_make_diagonal(BGC_FP64_Matrix3x3* matrix, const double d1, const double d2, const double d3);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_copy(const BGC_FP32_Matrix3x3* source, BGC_FP32_Matrix3x3* destination);
|
extern inline void bgc_fp32_matrix3x3_copy(BGC_FP32_Matrix3x3* destination, const BGC_FP32_Matrix3x3* source);
|
||||||
extern inline void bgc_fp64_matrix3x3_copy(const BGC_FP64_Matrix3x3* source, BGC_FP64_Matrix3x3* destination);
|
extern inline void bgc_fp64_matrix3x3_copy(BGC_FP64_Matrix3x3* destination, const BGC_FP64_Matrix3x3* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_swap(BGC_FP32_Matrix3x3* matrix1, BGC_FP32_Matrix3x3* matrix2);
|
extern inline void bgc_fp32_matrix3x3_swap(BGC_FP32_Matrix3x3* matrix1, BGC_FP32_Matrix3x3* matrix2);
|
||||||
extern inline void bgc_fp64_matrix3x3_swap(BGC_FP64_Matrix3x3* matrix1, BGC_FP64_Matrix3x3* matrix2);
|
extern inline void bgc_fp64_matrix3x3_swap(BGC_FP64_Matrix3x3* matrix1, BGC_FP64_Matrix3x3* matrix2);
|
||||||
|
|
||||||
extern inline void bgc_fp64_matrix3x3_convert_to_fp32(const BGC_FP64_Matrix3x3* source, BGC_FP32_Matrix3x3* destination);
|
extern inline void bgc_fp64_matrix3x3_convert_to_fp32(BGC_FP32_Matrix3x3* destination, const BGC_FP64_Matrix3x3* source);
|
||||||
extern inline void bgc_fp32_matrix3x3_convert_to_fp64(const BGC_FP32_Matrix3x3* source, BGC_FP64_Matrix3x3* destination);
|
extern inline void bgc_fp32_matrix3x3_convert_to_fp64(BGC_FP64_Matrix3x3* destination, const BGC_FP32_Matrix3x3* source);
|
||||||
|
|
||||||
extern inline float bgc_fp32_matrix3x3_get_determinant(const BGC_FP32_Matrix3x3* matrix);
|
extern inline float bgc_fp32_matrix3x3_get_determinant(const BGC_FP32_Matrix3x3* matrix);
|
||||||
extern inline double bgc_fp64_matrix3x3_get_determinant(const BGC_FP64_Matrix3x3* matrix);
|
extern inline double bgc_fp64_matrix3x3_get_determinant(const BGC_FP64_Matrix3x3* matrix);
|
||||||
|
|
@ -36,48 +36,48 @@ extern inline int bgc_fp64_matrix3x3_invert(BGC_FP64_Matrix3x3* matrix);
|
||||||
extern inline void bgc_fp32_matrix3x3_transpose(BGC_FP32_Matrix3x3* matrix);
|
extern inline void bgc_fp32_matrix3x3_transpose(BGC_FP32_Matrix3x3* matrix);
|
||||||
extern inline void bgc_fp64_matrix3x3_transpose(BGC_FP64_Matrix3x3* matrix);
|
extern inline void bgc_fp64_matrix3x3_transpose(BGC_FP64_Matrix3x3* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_get_transposed(const BGC_FP32_Matrix3x3* matrix, BGC_FP32_Matrix3x3* transposed);
|
extern inline void bgc_fp32_matrix3x3_get_transposed(BGC_FP32_Matrix3x3* transposed, const BGC_FP32_Matrix3x3* matrix);
|
||||||
extern inline void bgc_fp64_matrix3x3_get_transposed(const BGC_FP64_Matrix3x3* matrix, BGC_FP64_Matrix3x3* transposed);
|
extern inline void bgc_fp64_matrix3x3_get_transposed(BGC_FP64_Matrix3x3* transposed, const BGC_FP64_Matrix3x3* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_get_row(const int number, const BGC_FP32_Matrix3x3* matrix, BGC_FP32_Vector3* row);
|
extern inline void bgc_fp32_matrix3x3_get_row(BGC_FP32_Vector3* row, const BGC_FP32_Matrix3x3* matrix, const int row_number);
|
||||||
extern inline void bgc_fp64_matrix3x3_get_row(const int number, const BGC_FP64_Matrix3x3* matrix, BGC_FP64_Vector3* row);
|
extern inline void bgc_fp64_matrix3x3_get_row(BGC_FP64_Vector3* row, const BGC_FP64_Matrix3x3* matrix, const int row_number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_set_row(const int number, const BGC_FP32_Vector3* row, BGC_FP32_Matrix3x3* matrix);
|
extern inline void bgc_fp32_matrix3x3_set_row(BGC_FP32_Matrix3x3* matrix, const int row_number, const BGC_FP32_Vector3* row);
|
||||||
extern inline void bgc_fp64_matrix3x3_set_row(const int number, const BGC_FP64_Vector3* row, BGC_FP64_Matrix3x3* matrix);
|
extern inline void bgc_fp64_matrix3x3_set_row(BGC_FP64_Matrix3x3* matrix, const int row_number, const BGC_FP64_Vector3* row);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_get_column(const int number, const BGC_FP32_Matrix3x3* matrix, BGC_FP32_Vector3* column);
|
extern inline void bgc_fp32_matrix3x3_get_column(BGC_FP32_Vector3* column, const BGC_FP32_Matrix3x3* matrix, const int column_number);
|
||||||
extern inline void bgc_fp64_matrix3x3_get_column(const int number, const BGC_FP64_Matrix3x3* matrix, BGC_FP64_Vector3* column);
|
extern inline void bgc_fp64_matrix3x3_get_column(BGC_FP64_Vector3* column, const BGC_FP64_Matrix3x3* matrix, const int column_number);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_set_column(const int number, const BGC_FP32_Vector3* column, BGC_FP32_Matrix3x3* matrix);
|
extern inline void bgc_fp32_matrix3x3_set_column(BGC_FP32_Matrix3x3* matrix, const int column_number, const BGC_FP32_Vector3* column);
|
||||||
extern inline void bgc_fp64_matrix3x3_set_column(const int number, const BGC_FP64_Vector3* column, BGC_FP64_Matrix3x3* matrix);
|
extern inline void bgc_fp64_matrix3x3_set_column(BGC_FP64_Matrix3x3* matrix, const int column_number, const BGC_FP64_Vector3* column);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_add(const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix3x3* matrix2, BGC_FP32_Matrix3x3* sum);
|
extern inline void bgc_fp32_matrix3x3_add(BGC_FP32_Matrix3x3* sum, const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix3x3* matrix2);
|
||||||
extern inline void bgc_fp64_matrix3x3_add(const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix3x3* matrix2, BGC_FP64_Matrix3x3* sum);
|
extern inline void bgc_fp64_matrix3x3_add(BGC_FP64_Matrix3x3* sum, const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix3x3* matrix2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_add_scaled(const BGC_FP32_Matrix3x3* basic_matrix, const BGC_FP32_Matrix3x3* scalable_matrix, const float scale, BGC_FP32_Matrix3x3* sum);
|
extern inline void bgc_fp32_matrix3x3_add_scaled(BGC_FP32_Matrix3x3* sum, const BGC_FP32_Matrix3x3* basic_matrix, const BGC_FP32_Matrix3x3* scalable_matrix, const float scale);
|
||||||
extern inline void bgc_fp64_matrix3x3_add_scaled(const BGC_FP64_Matrix3x3* basic_matrix, const BGC_FP64_Matrix3x3* scalable_matrix, const double scale, BGC_FP64_Matrix3x3* sum);
|
extern inline void bgc_fp64_matrix3x3_add_scaled(BGC_FP64_Matrix3x3* sum, const BGC_FP64_Matrix3x3* basic_matrix, const BGC_FP64_Matrix3x3* scalable_matrix, const double scale);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_subtract(const BGC_FP32_Matrix3x3* minuend, const BGC_FP32_Matrix3x3* subtrahend, BGC_FP32_Matrix3x3* difference);
|
extern inline void bgc_fp32_matrix3x3_subtract(BGC_FP32_Matrix3x3* difference, const BGC_FP32_Matrix3x3* minuend, const BGC_FP32_Matrix3x3* subtrahend);
|
||||||
extern inline void bgc_fp64_matrix3x3_subtract(const BGC_FP64_Matrix3x3* minuend, const BGC_FP64_Matrix3x3* subtrahend, BGC_FP64_Matrix3x3* difference);
|
extern inline void bgc_fp64_matrix3x3_subtract(BGC_FP64_Matrix3x3* difference, const BGC_FP64_Matrix3x3* minuend, const BGC_FP64_Matrix3x3* subtrahend);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_multiply(const BGC_FP32_Matrix3x3* multiplicand, const float multiplier, BGC_FP32_Matrix3x3* product);
|
extern inline void bgc_fp32_matrix3x3_multiply(BGC_FP32_Matrix3x3* product, const BGC_FP32_Matrix3x3* multiplicand, const float multiplier);
|
||||||
extern inline void bgc_fp64_matrix3x3_multiply(const BGC_FP64_Matrix3x3* multiplicand, const double multiplier, BGC_FP64_Matrix3x3* product);
|
extern inline void bgc_fp64_matrix3x3_multiply(BGC_FP64_Matrix3x3* product, const BGC_FP64_Matrix3x3* multiplicand, const double multiplier);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_divide(const BGC_FP32_Matrix3x3* dividend, const float divisor, BGC_FP32_Matrix3x3* quotient);
|
extern inline void bgc_fp32_matrix3x3_divide(BGC_FP32_Matrix3x3* quotient, const BGC_FP32_Matrix3x3* dividend, const float divisor);
|
||||||
extern inline void bgc_fp64_matrix3x3_divide(const BGC_FP64_Matrix3x3* dividend, const double divisor, BGC_FP64_Matrix3x3* quotient);
|
extern inline void bgc_fp64_matrix3x3_divide(BGC_FP64_Matrix3x3* quotient, const BGC_FP64_Matrix3x3* dividend, const double divisor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_matrix3x3_interpolate(const BGC_FP32_Matrix3x3* first, const BGC_FP32_Matrix3x3* second, const float phase, BGC_FP32_Matrix3x3* interpolation);
|
extern inline void bgc_fp32_matrix3x3_interpolate(BGC_FP32_Matrix3x3* interpolation, const BGC_FP32_Matrix3x3* first, const BGC_FP32_Matrix3x3* second, const float phase);
|
||||||
extern inline void bgc_fp64_matrix3x3_interpolate(const BGC_FP64_Matrix3x3* first, const BGC_FP64_Matrix3x3* second, const double phase, BGC_FP64_Matrix3x3* interpolation);
|
extern inline void bgc_fp64_matrix3x3_interpolate(BGC_FP64_Matrix3x3* interpolation, const BGC_FP64_Matrix3x3* first, const BGC_FP64_Matrix3x3* second, const double phase);
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_vector3_by_matrix3x3(const BGC_FP32_Vector3* vector, const BGC_FP32_Matrix3x3* matrix, BGC_FP32_Vector3* result);
|
extern inline void bgc_fp32_multiply_vector3_by_matrix3x3(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* vector, const BGC_FP32_Matrix3x3* matrix);
|
||||||
extern inline void bgc_fp64_multiply_vector3_by_matrix3x3(const BGC_FP64_Vector3* vector, const BGC_FP64_Matrix3x3* matrix, BGC_FP64_Vector3* result);
|
extern inline void bgc_fp64_multiply_vector3_by_matrix3x3(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* vector, const BGC_FP64_Matrix3x3* matrix);
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix3x3_by_vector3(const BGC_FP32_Matrix3x3* matrix, const BGC_FP32_Vector3* vector, BGC_FP32_Vector3* result);
|
extern inline void bgc_fp32_multiply_matrix3x3_by_vector3(BGC_FP32_Vector3* product, const BGC_FP32_Matrix3x3* matrix, const BGC_FP32_Vector3* vector);
|
||||||
extern inline void bgc_fp64_multiply_matrix3x3_by_vector3(const BGC_FP64_Matrix3x3* matrix, const BGC_FP64_Vector3* vector, BGC_FP64_Vector3* result);
|
extern inline void bgc_fp64_multiply_matrix3x3_by_vector3(BGC_FP64_Vector3* product, const BGC_FP64_Matrix3x3* matrix, const BGC_FP64_Vector3* vector);
|
||||||
|
|
||||||
// ================ Get Inverse ================= //
|
// ================ Get Inverse ================= //
|
||||||
|
|
||||||
int bgc_fp32_matrix3x3_get_inverse(const BGC_FP32_Matrix3x3* matrix, BGC_FP32_Matrix3x3* inverse)
|
int bgc_fp32_matrix3x3_get_inverse(BGC_FP32_Matrix3x3* inverse, const BGC_FP32_Matrix3x3* matrix)
|
||||||
{
|
{
|
||||||
const float determinant = bgc_fp32_matrix3x3_get_determinant(matrix);
|
const float determinant = bgc_fp32_matrix3x3_get_determinant(matrix);
|
||||||
|
|
||||||
|
|
@ -114,7 +114,7 @@ int bgc_fp32_matrix3x3_get_inverse(const BGC_FP32_Matrix3x3* matrix, BGC_FP32_Ma
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
int bgc_fp64_matrix3x3_get_inverse(const BGC_FP64_Matrix3x3* matrix, BGC_FP64_Matrix3x3* inverse)
|
int bgc_fp64_matrix3x3_get_inverse(BGC_FP64_Matrix3x3* inverse, const BGC_FP64_Matrix3x3* matrix)
|
||||||
{
|
{
|
||||||
const double determinant = bgc_fp64_matrix3x3_get_determinant(matrix);
|
const double determinant = bgc_fp64_matrix3x3_get_determinant(matrix);
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -2,7 +2,7 @@
|
||||||
#define _BGC_MATRIX3X3_H_
|
#define _BGC_MATRIX3X3_H_
|
||||||
|
|
||||||
#include "vector3.h"
|
#include "vector3.h"
|
||||||
#include "matrixes.h"
|
#include "matrices.h"
|
||||||
|
|
||||||
// =================== Reset ==================== //
|
// =================== Reset ==================== //
|
||||||
|
|
||||||
|
|
@ -70,7 +70,7 @@ inline void bgc_fp64_matrix3x3_make_identity(BGC_FP64_Matrix3x3* matrix)
|
||||||
|
|
||||||
// ================ Set Diagonal ================ //
|
// ================ Set Diagonal ================ //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_make_diagonal(const float d1, const float d2, const float d3, BGC_FP32_Matrix3x3* matrix)
|
inline void bgc_fp32_matrix3x3_make_diagonal(BGC_FP32_Matrix3x3* matrix, const float d1, const float d2, const float d3)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = d1;
|
matrix->r1c1 = d1;
|
||||||
matrix->r1c2 = 0.0f;
|
matrix->r1c2 = 0.0f;
|
||||||
|
|
@ -85,7 +85,7 @@ inline void bgc_fp32_matrix3x3_make_diagonal(const float d1, const float d2, con
|
||||||
matrix->r3c3 = d2;
|
matrix->r3c3 = d2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_make_diagonal(const double d1, const double d2, const double d3, BGC_FP64_Matrix3x3* matrix)
|
inline void bgc_fp64_matrix3x3_make_diagonal(BGC_FP64_Matrix3x3* matrix, const double d1, const double d2, const double d3)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = d1;
|
matrix->r1c1 = d1;
|
||||||
matrix->r1c2 = 0.0;
|
matrix->r1c2 = 0.0;
|
||||||
|
|
@ -102,7 +102,7 @@ inline void bgc_fp64_matrix3x3_make_diagonal(const double d1, const double d2, c
|
||||||
|
|
||||||
// ==================== Copy ==================== //
|
// ==================== Copy ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_copy(const BGC_FP32_Matrix3x3* source, BGC_FP32_Matrix3x3* destination)
|
inline void bgc_fp32_matrix3x3_copy(BGC_FP32_Matrix3x3* destination, const BGC_FP32_Matrix3x3* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -117,7 +117,7 @@ inline void bgc_fp32_matrix3x3_copy(const BGC_FP32_Matrix3x3* source, BGC_FP32_M
|
||||||
destination->r3c3 = source->r3c3;
|
destination->r3c3 = source->r3c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_copy(const BGC_FP64_Matrix3x3* source, BGC_FP64_Matrix3x3* destination)
|
inline void bgc_fp64_matrix3x3_copy(BGC_FP64_Matrix3x3* destination, const BGC_FP64_Matrix3x3* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -214,7 +214,7 @@ inline void bgc_fp64_matrix3x3_swap(BGC_FP64_Matrix3x3* matrix1, BGC_FP64_Matrix
|
||||||
|
|
||||||
// ================== Convert =================== //
|
// ================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_convert_to_fp32(const BGC_FP64_Matrix3x3* source, BGC_FP32_Matrix3x3* destination)
|
inline void bgc_fp64_matrix3x3_convert_to_fp32(BGC_FP32_Matrix3x3* destination, const BGC_FP64_Matrix3x3* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = (float)source->r1c1;
|
destination->r1c1 = (float)source->r1c1;
|
||||||
destination->r1c2 = (float)source->r1c2;
|
destination->r1c2 = (float)source->r1c2;
|
||||||
|
|
@ -229,7 +229,7 @@ inline void bgc_fp64_matrix3x3_convert_to_fp32(const BGC_FP64_Matrix3x3* source,
|
||||||
destination->r3c3 = (float)source->r3c3;
|
destination->r3c3 = (float)source->r3c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_convert_to_fp64(const BGC_FP32_Matrix3x3* source, BGC_FP64_Matrix3x3* destination)
|
inline void bgc_fp32_matrix3x3_convert_to_fp64(BGC_FP64_Matrix3x3* destination, const BGC_FP32_Matrix3x3* source)
|
||||||
{
|
{
|
||||||
destination->r1c1 = source->r1c1;
|
destination->r1c1 = source->r1c1;
|
||||||
destination->r1c2 = source->r1c2;
|
destination->r1c2 = source->r1c2;
|
||||||
|
|
@ -330,9 +330,9 @@ inline int bgc_fp64_matrix3x3_is_rotation(const BGC_FP64_Matrix3x3* matrix)
|
||||||
|
|
||||||
// ================ Get Inverse ================= //
|
// ================ Get Inverse ================= //
|
||||||
|
|
||||||
int bgc_fp32_matrix3x3_get_inverse(const BGC_FP32_Matrix3x3* matrix, BGC_FP32_Matrix3x3* inverse);
|
int bgc_fp32_matrix3x3_get_inverse(BGC_FP32_Matrix3x3* inverse, const BGC_FP32_Matrix3x3* matrix);
|
||||||
|
|
||||||
int bgc_fp64_matrix3x3_get_inverse(const BGC_FP64_Matrix3x3* matrix, BGC_FP64_Matrix3x3* inverse);
|
int bgc_fp64_matrix3x3_get_inverse(BGC_FP64_Matrix3x3* inverse, const BGC_FP64_Matrix3x3* matrix);
|
||||||
|
|
||||||
// =================== Invert =================== //
|
// =================== Invert =================== //
|
||||||
|
|
||||||
|
|
@ -380,7 +380,7 @@ inline void bgc_fp64_matrix3x3_transpose(BGC_FP64_Matrix3x3* matrix)
|
||||||
|
|
||||||
// =============== Get Transpose ================ //
|
// =============== Get Transpose ================ //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_get_transposed(const BGC_FP32_Matrix3x3* matrix, BGC_FP32_Matrix3x3* transposed)
|
inline void bgc_fp32_matrix3x3_get_transposed(BGC_FP32_Matrix3x3* transposed, const BGC_FP32_Matrix3x3* matrix)
|
||||||
{
|
{
|
||||||
transposed->r1c1 = matrix->r1c1;
|
transposed->r1c1 = matrix->r1c1;
|
||||||
transposed->r2c2 = matrix->r2c2;
|
transposed->r2c2 = matrix->r2c2;
|
||||||
|
|
@ -399,7 +399,7 @@ inline void bgc_fp32_matrix3x3_get_transposed(const BGC_FP32_Matrix3x3* matrix,
|
||||||
transposed->r3c2 = r2c3;
|
transposed->r3c2 = r2c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_get_transposed(const BGC_FP64_Matrix3x3* matrix, BGC_FP64_Matrix3x3* transposed)
|
inline void bgc_fp64_matrix3x3_get_transposed(BGC_FP64_Matrix3x3* transposed, const BGC_FP64_Matrix3x3* matrix)
|
||||||
{
|
{
|
||||||
transposed->r1c1 = matrix->r1c1;
|
transposed->r1c1 = matrix->r1c1;
|
||||||
transposed->r2c2 = matrix->r2c2;
|
transposed->r2c2 = matrix->r2c2;
|
||||||
|
|
@ -420,9 +420,9 @@ inline void bgc_fp64_matrix3x3_get_transposed(const BGC_FP64_Matrix3x3* matrix,
|
||||||
|
|
||||||
// ================== Get Row -================== //
|
// ================== Get Row -================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_get_row(const int number, const BGC_FP32_Matrix3x3* matrix, BGC_FP32_Vector3* row)
|
inline void bgc_fp32_matrix3x3_get_row(BGC_FP32_Vector3* row, const BGC_FP32_Matrix3x3* matrix, const int row_number)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (row_number == 1)
|
||||||
{
|
{
|
||||||
row->x1 = matrix->r1c1;
|
row->x1 = matrix->r1c1;
|
||||||
row->x2 = matrix->r1c2;
|
row->x2 = matrix->r1c2;
|
||||||
|
|
@ -430,7 +430,7 @@ inline void bgc_fp32_matrix3x3_get_row(const int number, const BGC_FP32_Matrix3x
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (row_number == 2)
|
||||||
{
|
{
|
||||||
row->x1 = matrix->r2c1;
|
row->x1 = matrix->r2c1;
|
||||||
row->x2 = matrix->r2c2;
|
row->x2 = matrix->r2c2;
|
||||||
|
|
@ -438,7 +438,7 @@ inline void bgc_fp32_matrix3x3_get_row(const int number, const BGC_FP32_Matrix3x
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (row_number == 3)
|
||||||
{
|
{
|
||||||
row->x1 = matrix->r3c1;
|
row->x1 = matrix->r3c1;
|
||||||
row->x2 = matrix->r3c2;
|
row->x2 = matrix->r3c2;
|
||||||
|
|
@ -451,9 +451,9 @@ inline void bgc_fp32_matrix3x3_get_row(const int number, const BGC_FP32_Matrix3x
|
||||||
row->x3 = 0.0f;
|
row->x3 = 0.0f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_get_row(const int number, const BGC_FP64_Matrix3x3* matrix, BGC_FP64_Vector3* row)
|
inline void bgc_fp64_matrix3x3_get_row(BGC_FP64_Vector3* row, const BGC_FP64_Matrix3x3* matrix, const int row_number)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (row_number == 1)
|
||||||
{
|
{
|
||||||
row->x1 = matrix->r1c1;
|
row->x1 = matrix->r1c1;
|
||||||
row->x2 = matrix->r1c2;
|
row->x2 = matrix->r1c2;
|
||||||
|
|
@ -461,7 +461,7 @@ inline void bgc_fp64_matrix3x3_get_row(const int number, const BGC_FP64_Matrix3x
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (row_number == 2)
|
||||||
{
|
{
|
||||||
row->x1 = matrix->r2c1;
|
row->x1 = matrix->r2c1;
|
||||||
row->x2 = matrix->r2c2;
|
row->x2 = matrix->r2c2;
|
||||||
|
|
@ -469,7 +469,7 @@ inline void bgc_fp64_matrix3x3_get_row(const int number, const BGC_FP64_Matrix3x
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (row_number == 3)
|
||||||
{
|
{
|
||||||
row->x1 = matrix->r3c1;
|
row->x1 = matrix->r3c1;
|
||||||
row->x2 = matrix->r3c2;
|
row->x2 = matrix->r3c2;
|
||||||
|
|
@ -484,9 +484,9 @@ inline void bgc_fp64_matrix3x3_get_row(const int number, const BGC_FP64_Matrix3x
|
||||||
|
|
||||||
// ================== Set Row =================== //
|
// ================== Set Row =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_set_row(const int number, const BGC_FP32_Vector3* row, BGC_FP32_Matrix3x3* matrix)
|
inline void bgc_fp32_matrix3x3_set_row(BGC_FP32_Matrix3x3* matrix, const int row_number, const BGC_FP32_Vector3* row)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (row_number == 1)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = row->x1;
|
matrix->r1c1 = row->x1;
|
||||||
matrix->r1c2 = row->x2;
|
matrix->r1c2 = row->x2;
|
||||||
|
|
@ -494,7 +494,7 @@ inline void bgc_fp32_matrix3x3_set_row(const int number, const BGC_FP32_Vector3*
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (row_number == 2)
|
||||||
{
|
{
|
||||||
matrix->r2c1 = row->x1;
|
matrix->r2c1 = row->x1;
|
||||||
matrix->r2c2 = row->x2;
|
matrix->r2c2 = row->x2;
|
||||||
|
|
@ -502,7 +502,7 @@ inline void bgc_fp32_matrix3x3_set_row(const int number, const BGC_FP32_Vector3*
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (row_number == 3)
|
||||||
{
|
{
|
||||||
matrix->r3c1 = row->x1;
|
matrix->r3c1 = row->x1;
|
||||||
matrix->r3c2 = row->x2;
|
matrix->r3c2 = row->x2;
|
||||||
|
|
@ -510,9 +510,9 @@ inline void bgc_fp32_matrix3x3_set_row(const int number, const BGC_FP32_Vector3*
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_set_row(const int number, const BGC_FP64_Vector3* row, BGC_FP64_Matrix3x3* matrix)
|
inline void bgc_fp64_matrix3x3_set_row(BGC_FP64_Matrix3x3* matrix, const int row_number, const BGC_FP64_Vector3* row)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (row_number == 1)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = row->x1;
|
matrix->r1c1 = row->x1;
|
||||||
matrix->r1c2 = row->x2;
|
matrix->r1c2 = row->x2;
|
||||||
|
|
@ -520,7 +520,7 @@ inline void bgc_fp64_matrix3x3_set_row(const int number, const BGC_FP64_Vector3*
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (row_number == 2)
|
||||||
{
|
{
|
||||||
matrix->r2c1 = row->x1;
|
matrix->r2c1 = row->x1;
|
||||||
matrix->r2c2 = row->x2;
|
matrix->r2c2 = row->x2;
|
||||||
|
|
@ -528,7 +528,7 @@ inline void bgc_fp64_matrix3x3_set_row(const int number, const BGC_FP64_Vector3*
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (row_number == 3)
|
||||||
{
|
{
|
||||||
matrix->r3c1 = row->x1;
|
matrix->r3c1 = row->x1;
|
||||||
matrix->r3c2 = row->x2;
|
matrix->r3c2 = row->x2;
|
||||||
|
|
@ -538,9 +538,9 @@ inline void bgc_fp64_matrix3x3_set_row(const int number, const BGC_FP64_Vector3*
|
||||||
|
|
||||||
// ================= Get Column ================= //
|
// ================= Get Column ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_get_column(const int number, const BGC_FP32_Matrix3x3* matrix, BGC_FP32_Vector3* column)
|
inline void bgc_fp32_matrix3x3_get_column(BGC_FP32_Vector3* column, const BGC_FP32_Matrix3x3* matrix, const int column_number)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (column_number == 1)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c1;
|
column->x1 = matrix->r1c1;
|
||||||
column->x2 = matrix->r2c1;
|
column->x2 = matrix->r2c1;
|
||||||
|
|
@ -548,7 +548,7 @@ inline void bgc_fp32_matrix3x3_get_column(const int number, const BGC_FP32_Matri
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (column_number == 2)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c2;
|
column->x1 = matrix->r1c2;
|
||||||
column->x2 = matrix->r2c2;
|
column->x2 = matrix->r2c2;
|
||||||
|
|
@ -556,7 +556,7 @@ inline void bgc_fp32_matrix3x3_get_column(const int number, const BGC_FP32_Matri
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (column_number == 3)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c3;
|
column->x1 = matrix->r1c3;
|
||||||
column->x2 = matrix->r2c3;
|
column->x2 = matrix->r2c3;
|
||||||
|
|
@ -569,9 +569,9 @@ inline void bgc_fp32_matrix3x3_get_column(const int number, const BGC_FP32_Matri
|
||||||
column->x3 = 0.0f;
|
column->x3 = 0.0f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_get_column(const int number, const BGC_FP64_Matrix3x3* matrix, BGC_FP64_Vector3* column)
|
inline void bgc_fp64_matrix3x3_get_column(BGC_FP64_Vector3* column, const BGC_FP64_Matrix3x3* matrix, const int column_number)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (column_number == 1)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c1;
|
column->x1 = matrix->r1c1;
|
||||||
column->x2 = matrix->r2c1;
|
column->x2 = matrix->r2c1;
|
||||||
|
|
@ -579,7 +579,7 @@ inline void bgc_fp64_matrix3x3_get_column(const int number, const BGC_FP64_Matri
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (column_number == 2)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c2;
|
column->x1 = matrix->r1c2;
|
||||||
column->x2 = matrix->r2c2;
|
column->x2 = matrix->r2c2;
|
||||||
|
|
@ -587,7 +587,7 @@ inline void bgc_fp64_matrix3x3_get_column(const int number, const BGC_FP64_Matri
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (column_number == 3)
|
||||||
{
|
{
|
||||||
column->x1 = matrix->r1c3;
|
column->x1 = matrix->r1c3;
|
||||||
column->x2 = matrix->r2c3;
|
column->x2 = matrix->r2c3;
|
||||||
|
|
@ -602,9 +602,9 @@ inline void bgc_fp64_matrix3x3_get_column(const int number, const BGC_FP64_Matri
|
||||||
|
|
||||||
// ================= Set Column ================= //
|
// ================= Set Column ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_set_column(const int number, const BGC_FP32_Vector3* column, BGC_FP32_Matrix3x3* matrix)
|
inline void bgc_fp32_matrix3x3_set_column(BGC_FP32_Matrix3x3* matrix, const int column_number, const BGC_FP32_Vector3* column)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (column_number == 1)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = column->x1;
|
matrix->r1c1 = column->x1;
|
||||||
matrix->r2c1 = column->x2;
|
matrix->r2c1 = column->x2;
|
||||||
|
|
@ -612,7 +612,7 @@ inline void bgc_fp32_matrix3x3_set_column(const int number, const BGC_FP32_Vecto
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (column_number == 2)
|
||||||
{
|
{
|
||||||
matrix->r1c2 = column->x1;
|
matrix->r1c2 = column->x1;
|
||||||
matrix->r2c2 = column->x2;
|
matrix->r2c2 = column->x2;
|
||||||
|
|
@ -620,7 +620,7 @@ inline void bgc_fp32_matrix3x3_set_column(const int number, const BGC_FP32_Vecto
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (column_number == 3)
|
||||||
{
|
{
|
||||||
matrix->r1c3 = column->x1;
|
matrix->r1c3 = column->x1;
|
||||||
matrix->r2c3 = column->x2;
|
matrix->r2c3 = column->x2;
|
||||||
|
|
@ -628,9 +628,9 @@ inline void bgc_fp32_matrix3x3_set_column(const int number, const BGC_FP32_Vecto
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_set_column(const int number, const BGC_FP64_Vector3* column, BGC_FP64_Matrix3x3* matrix)
|
inline void bgc_fp64_matrix3x3_set_column(BGC_FP64_Matrix3x3* matrix, const int column_number, const BGC_FP64_Vector3* column)
|
||||||
{
|
{
|
||||||
if (number == 1)
|
if (column_number == 1)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = column->x1;
|
matrix->r1c1 = column->x1;
|
||||||
matrix->r2c1 = column->x2;
|
matrix->r2c1 = column->x2;
|
||||||
|
|
@ -638,7 +638,7 @@ inline void bgc_fp64_matrix3x3_set_column(const int number, const BGC_FP64_Vecto
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 2)
|
if (column_number == 2)
|
||||||
{
|
{
|
||||||
matrix->r1c2 = column->x1;
|
matrix->r1c2 = column->x1;
|
||||||
matrix->r2c2 = column->x2;
|
matrix->r2c2 = column->x2;
|
||||||
|
|
@ -646,7 +646,7 @@ inline void bgc_fp64_matrix3x3_set_column(const int number, const BGC_FP64_Vecto
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (number == 3)
|
if (column_number == 3)
|
||||||
{
|
{
|
||||||
matrix->r1c3 = column->x1;
|
matrix->r1c3 = column->x1;
|
||||||
matrix->r2c3 = column->x2;
|
matrix->r2c3 = column->x2;
|
||||||
|
|
@ -656,7 +656,7 @@ inline void bgc_fp64_matrix3x3_set_column(const int number, const BGC_FP64_Vecto
|
||||||
|
|
||||||
// ==================== Add ===================== //
|
// ==================== Add ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_add(const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix3x3* matrix2, BGC_FP32_Matrix3x3* sum)
|
inline void bgc_fp32_matrix3x3_add(BGC_FP32_Matrix3x3* sum, const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix3x3* matrix2)
|
||||||
{
|
{
|
||||||
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
||||||
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
||||||
|
|
@ -671,7 +671,7 @@ inline void bgc_fp32_matrix3x3_add(const BGC_FP32_Matrix3x3* matrix1, const BGC_
|
||||||
sum->r3c3 = matrix1->r3c3 + matrix2->r3c3;
|
sum->r3c3 = matrix1->r3c3 + matrix2->r3c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_add(const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix3x3* matrix2, BGC_FP64_Matrix3x3* sum)
|
inline void bgc_fp64_matrix3x3_add(BGC_FP64_Matrix3x3* sum, const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix3x3* matrix2)
|
||||||
{
|
{
|
||||||
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
sum->r1c1 = matrix1->r1c1 + matrix2->r1c1;
|
||||||
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
sum->r1c2 = matrix1->r1c2 + matrix2->r1c2;
|
||||||
|
|
@ -688,7 +688,7 @@ inline void bgc_fp64_matrix3x3_add(const BGC_FP64_Matrix3x3* matrix1, const BGC_
|
||||||
|
|
||||||
// ================= Add scaled ================= //
|
// ================= Add scaled ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_add_scaled(const BGC_FP32_Matrix3x3* basic_matrix, const BGC_FP32_Matrix3x3* scalable_matrix, const float scale, BGC_FP32_Matrix3x3* sum)
|
inline void bgc_fp32_matrix3x3_add_scaled(BGC_FP32_Matrix3x3* sum, const BGC_FP32_Matrix3x3* basic_matrix, const BGC_FP32_Matrix3x3* scalable_matrix, const float scale)
|
||||||
{
|
{
|
||||||
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
||||||
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
||||||
|
|
@ -703,7 +703,7 @@ inline void bgc_fp32_matrix3x3_add_scaled(const BGC_FP32_Matrix3x3* basic_matrix
|
||||||
sum->r3c3 = basic_matrix->r3c3 + scalable_matrix->r3c3 * scale;
|
sum->r3c3 = basic_matrix->r3c3 + scalable_matrix->r3c3 * scale;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_add_scaled(const BGC_FP64_Matrix3x3* basic_matrix, const BGC_FP64_Matrix3x3* scalable_matrix, const double scale, BGC_FP64_Matrix3x3* sum)
|
inline void bgc_fp64_matrix3x3_add_scaled(BGC_FP64_Matrix3x3* sum, const BGC_FP64_Matrix3x3* basic_matrix, const BGC_FP64_Matrix3x3* scalable_matrix, const double scale)
|
||||||
{
|
{
|
||||||
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
sum->r1c1 = basic_matrix->r1c1 + scalable_matrix->r1c1 * scale;
|
||||||
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
sum->r1c2 = basic_matrix->r1c2 + scalable_matrix->r1c2 * scale;
|
||||||
|
|
@ -720,7 +720,7 @@ inline void bgc_fp64_matrix3x3_add_scaled(const BGC_FP64_Matrix3x3* basic_matrix
|
||||||
|
|
||||||
// ================== Subtract ================== //
|
// ================== Subtract ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_subtract(const BGC_FP32_Matrix3x3* minuend, const BGC_FP32_Matrix3x3* subtrahend, BGC_FP32_Matrix3x3* difference)
|
inline void bgc_fp32_matrix3x3_subtract(BGC_FP32_Matrix3x3* difference, const BGC_FP32_Matrix3x3* minuend, const BGC_FP32_Matrix3x3* subtrahend)
|
||||||
{
|
{
|
||||||
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
||||||
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
||||||
|
|
@ -735,7 +735,7 @@ inline void bgc_fp32_matrix3x3_subtract(const BGC_FP32_Matrix3x3* minuend, const
|
||||||
difference->r3c3 = minuend->r3c3 - subtrahend->r3c3;
|
difference->r3c3 = minuend->r3c3 - subtrahend->r3c3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_subtract(const BGC_FP64_Matrix3x3* minuend, const BGC_FP64_Matrix3x3* subtrahend, BGC_FP64_Matrix3x3* difference)
|
inline void bgc_fp64_matrix3x3_subtract(BGC_FP64_Matrix3x3* difference, const BGC_FP64_Matrix3x3* minuend, const BGC_FP64_Matrix3x3* subtrahend)
|
||||||
{
|
{
|
||||||
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
difference->r1c1 = minuend->r1c1 - subtrahend->r1c1;
|
||||||
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
difference->r1c2 = minuend->r1c2 - subtrahend->r1c2;
|
||||||
|
|
@ -752,7 +752,7 @@ inline void bgc_fp64_matrix3x3_subtract(const BGC_FP64_Matrix3x3* minuend, const
|
||||||
|
|
||||||
// ================== Multiply ================== //
|
// ================== Multiply ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_multiply(const BGC_FP32_Matrix3x3* multiplicand, const float multiplier, BGC_FP32_Matrix3x3* product)
|
inline void bgc_fp32_matrix3x3_multiply(BGC_FP32_Matrix3x3* product, const BGC_FP32_Matrix3x3* multiplicand, const float multiplier)
|
||||||
{
|
{
|
||||||
product->r1c1 = multiplicand->r1c1 * multiplier;
|
product->r1c1 = multiplicand->r1c1 * multiplier;
|
||||||
product->r1c2 = multiplicand->r1c2 * multiplier;
|
product->r1c2 = multiplicand->r1c2 * multiplier;
|
||||||
|
|
@ -767,7 +767,7 @@ inline void bgc_fp32_matrix3x3_multiply(const BGC_FP32_Matrix3x3* multiplicand,
|
||||||
product->r3c3 = multiplicand->r3c3 * multiplier;
|
product->r3c3 = multiplicand->r3c3 * multiplier;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_multiply(const BGC_FP64_Matrix3x3* multiplicand, const double multiplier, BGC_FP64_Matrix3x3* product)
|
inline void bgc_fp64_matrix3x3_multiply(BGC_FP64_Matrix3x3* product, const BGC_FP64_Matrix3x3* multiplicand, const double multiplier)
|
||||||
{
|
{
|
||||||
product->r1c1 = multiplicand->r1c1 * multiplier;
|
product->r1c1 = multiplicand->r1c1 * multiplier;
|
||||||
product->r1c2 = multiplicand->r1c2 * multiplier;
|
product->r1c2 = multiplicand->r1c2 * multiplier;
|
||||||
|
|
@ -784,19 +784,19 @@ inline void bgc_fp64_matrix3x3_multiply(const BGC_FP64_Matrix3x3* multiplicand,
|
||||||
|
|
||||||
// =================== Divide =================== //
|
// =================== Divide =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_divide(const BGC_FP32_Matrix3x3* dividend, const float divisor, BGC_FP32_Matrix3x3* quotient)
|
inline void bgc_fp32_matrix3x3_divide(BGC_FP32_Matrix3x3* quotient, const BGC_FP32_Matrix3x3* dividend, const float divisor)
|
||||||
{
|
{
|
||||||
bgc_fp32_matrix3x3_multiply(dividend, 1.0f / divisor, quotient);
|
bgc_fp32_matrix3x3_multiply(quotient, dividend, 1.0f / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_divide(const BGC_FP64_Matrix3x3* dividend, const double divisor, BGC_FP64_Matrix3x3* quotient)
|
inline void bgc_fp64_matrix3x3_divide(BGC_FP64_Matrix3x3* quotient, const BGC_FP64_Matrix3x3* dividend, const double divisor)
|
||||||
{
|
{
|
||||||
bgc_fp64_matrix3x3_multiply(dividend, 1.0 / divisor, quotient);
|
bgc_fp64_matrix3x3_multiply(quotient, dividend, 1.0 / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================ Interpolate ================= //
|
// ================ Interpolate ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_matrix3x3_interpolate(const BGC_FP32_Matrix3x3* first, const BGC_FP32_Matrix3x3* second, const float phase, BGC_FP32_Matrix3x3* interpolation)
|
inline void bgc_fp32_matrix3x3_interpolate(BGC_FP32_Matrix3x3* interpolation, const BGC_FP32_Matrix3x3* first, const BGC_FP32_Matrix3x3* second, const float phase)
|
||||||
{
|
{
|
||||||
const float counter_phase = 1.0f - phase;
|
const float counter_phase = 1.0f - phase;
|
||||||
|
|
||||||
|
|
@ -813,7 +813,7 @@ inline void bgc_fp32_matrix3x3_interpolate(const BGC_FP32_Matrix3x3* first, cons
|
||||||
interpolation->r3c3 = first->r3c3 * counter_phase + second->r3c3 * phase;
|
interpolation->r3c3 = first->r3c3 * counter_phase + second->r3c3 * phase;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_matrix3x3_interpolate(const BGC_FP64_Matrix3x3* first, const BGC_FP64_Matrix3x3* second, const double phase, BGC_FP64_Matrix3x3* interpolation)
|
inline void bgc_fp64_matrix3x3_interpolate(BGC_FP64_Matrix3x3* interpolation, const BGC_FP64_Matrix3x3* first, const BGC_FP64_Matrix3x3* second, const double phase)
|
||||||
{
|
{
|
||||||
const double counter_phase = 1.0 - phase;
|
const double counter_phase = 1.0 - phase;
|
||||||
|
|
||||||
|
|
@ -832,50 +832,50 @@ inline void bgc_fp64_matrix3x3_interpolate(const BGC_FP64_Matrix3x3* first, cons
|
||||||
|
|
||||||
// ============ Left Vector Product ============= //
|
// ============ Left Vector Product ============= //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_vector3_by_matrix3x3(const BGC_FP32_Vector3* vector, const BGC_FP32_Matrix3x3* matrix, BGC_FP32_Vector3* result)
|
inline void bgc_fp32_multiply_vector3_by_matrix3x3(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* vector, const BGC_FP32_Matrix3x3* matrix)
|
||||||
{
|
{
|
||||||
const float x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1 + vector->x3 * matrix->r3c1;
|
const float x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1 + vector->x3 * matrix->r3c1;
|
||||||
const float x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2 + vector->x3 * matrix->r3c2;
|
const float x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2 + vector->x3 * matrix->r3c2;
|
||||||
const float x3 = vector->x1 * matrix->r1c3 + vector->x2 * matrix->r2c3 + vector->x3 * matrix->r3c3;
|
const float x3 = vector->x1 * matrix->r1c3 + vector->x2 * matrix->r2c3 + vector->x3 * matrix->r3c3;
|
||||||
|
|
||||||
result->x1 = x1;
|
product->x1 = x1;
|
||||||
result->x2 = x2;
|
product->x2 = x2;
|
||||||
result->x3 = x3;
|
product->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_vector3_by_matrix3x3(const BGC_FP64_Vector3* vector, const BGC_FP64_Matrix3x3* matrix, BGC_FP64_Vector3* result)
|
inline void bgc_fp64_multiply_vector3_by_matrix3x3(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* vector, const BGC_FP64_Matrix3x3* matrix)
|
||||||
{
|
{
|
||||||
const double x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1 + vector->x3 * matrix->r3c1;
|
const double x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1 + vector->x3 * matrix->r3c1;
|
||||||
const double x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2 + vector->x3 * matrix->r3c2;
|
const double x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2 + vector->x3 * matrix->r3c2;
|
||||||
const double x3 = vector->x1 * matrix->r1c3 + vector->x2 * matrix->r2c3 + vector->x3 * matrix->r3c3;
|
const double x3 = vector->x1 * matrix->r1c3 + vector->x2 * matrix->r2c3 + vector->x3 * matrix->r3c3;
|
||||||
|
|
||||||
result->x1 = x1;
|
product->x1 = x1;
|
||||||
result->x2 = x2;
|
product->x2 = x2;
|
||||||
result->x3 = x3;
|
product->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============ Right Vector Product ============ //
|
// ============ Right Vector Product ============ //
|
||||||
|
|
||||||
inline void bgc_fp32_multiply_matrix3x3_by_vector3(const BGC_FP32_Matrix3x3* matrix, const BGC_FP32_Vector3* vector, BGC_FP32_Vector3* result)
|
inline void bgc_fp32_multiply_matrix3x3_by_vector3(BGC_FP32_Vector3* product, const BGC_FP32_Matrix3x3* matrix, const BGC_FP32_Vector3* vector)
|
||||||
{
|
{
|
||||||
const float x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2 + matrix->r1c3 * vector->x3;
|
const float x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2 + matrix->r1c3 * vector->x3;
|
||||||
const float x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2 + matrix->r2c3 * vector->x3;
|
const float x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2 + matrix->r2c3 * vector->x3;
|
||||||
const float x3 = matrix->r3c1 * vector->x1 + matrix->r3c2 * vector->x2 + matrix->r3c3 * vector->x3;
|
const float x3 = matrix->r3c1 * vector->x1 + matrix->r3c2 * vector->x2 + matrix->r3c3 * vector->x3;
|
||||||
|
|
||||||
result->x1 = x1;
|
product->x1 = x1;
|
||||||
result->x2 = x2;
|
product->x2 = x2;
|
||||||
result->x3 = x3;
|
product->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_multiply_matrix3x3_by_vector3(const BGC_FP64_Matrix3x3* matrix, const BGC_FP64_Vector3* vector, BGC_FP64_Vector3* result)
|
inline void bgc_fp64_multiply_matrix3x3_by_vector3(BGC_FP64_Vector3* product, const BGC_FP64_Matrix3x3* matrix, const BGC_FP64_Vector3* vector)
|
||||||
{
|
{
|
||||||
const double x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2 + matrix->r1c3 * vector->x3;
|
const double x1 = matrix->r1c1 * vector->x1 + matrix->r1c2 * vector->x2 + matrix->r1c3 * vector->x3;
|
||||||
const double x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2 + matrix->r2c3 * vector->x3;
|
const double x2 = matrix->r2c1 * vector->x1 + matrix->r2c2 * vector->x2 + matrix->r2c3 * vector->x3;
|
||||||
const double x3 = matrix->r3c1 * vector->x1 + matrix->r3c2 * vector->x2 + matrix->r3c3 * vector->x3;
|
const double x3 = matrix->r3c1 * vector->x1 + matrix->r3c2 * vector->x2 + matrix->r3c3 * vector->x3;
|
||||||
|
|
||||||
result->x1 = x1;
|
product->x1 = x1;
|
||||||
result->x2 = x2;
|
product->x2 = x2;
|
||||||
result->x3 = x3;
|
product->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
||||||
|
|
@ -1,25 +0,0 @@
|
||||||
#include "matrixes.h"
|
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix2x2_by_matrix2x2(const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix2x2* matrix2, BGC_FP32_Matrix2x2* product);
|
|
||||||
extern inline void bgc_fp64_multiply_matrix2x2_by_matrix2x2(const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix2x2* matrix2, BGC_FP64_Matrix2x2* product);
|
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix2x2_by_matrix3x2(const BGC_FP32_Matrix2x2* matrix1, const BGC_FP32_Matrix3x2* matrix2, BGC_FP32_Matrix3x2* product);
|
|
||||||
extern inline void bgc_fp64_multiply_matrix2x2_by_matrix3x2(const BGC_FP64_Matrix2x2* matrix1, const BGC_FP64_Matrix3x2* matrix2, BGC_FP64_Matrix3x2* product);
|
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix2x3_by_matrix2x2(const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix2x2* matrix2, BGC_FP32_Matrix2x3* product);
|
|
||||||
extern inline void bgc_fp64_multiply_matrix2x3_by_matrix2x2(const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix2x2* matrix2, BGC_FP64_Matrix2x3* product);
|
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix2x3_by_matrix3x2(const BGC_FP32_Matrix2x3* matrix1, const BGC_FP32_Matrix3x2* matrix2, BGC_FP32_Matrix3x3* product);
|
|
||||||
extern inline void bgc_fp64_multiply_matrix2x3_by_matrix3x2(const BGC_FP64_Matrix2x3* matrix1, const BGC_FP64_Matrix3x2* matrix2, BGC_FP64_Matrix3x3* product);
|
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix3x2_by_matrix2x3(const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix2x3* matrix2, BGC_FP32_Matrix2x2* product);
|
|
||||||
extern inline void bgc_fp64_multiply_matrix3x2_by_matrix2x3(const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix2x3* matrix2, BGC_FP64_Matrix2x2* product);
|
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix3x2_by_matrix3x3(const BGC_FP32_Matrix3x2* matrix1, const BGC_FP32_Matrix3x3* matrix2, BGC_FP32_Matrix3x2* product);
|
|
||||||
extern inline void bgc_fp64_multiply_matrix3x2_by_matrix3x3(const BGC_FP64_Matrix3x2* matrix1, const BGC_FP64_Matrix3x3* matrix2, BGC_FP64_Matrix3x2* product);
|
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix3x3_by_matrix2x3(const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix2x3* matrix2, BGC_FP32_Matrix2x3* product);
|
|
||||||
extern inline void bgc_fp64_multiply_matrix3x3_by_matrix2x3(const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix2x3* matrix2, BGC_FP64_Matrix2x3* product);
|
|
||||||
|
|
||||||
extern inline void bgc_fp32_multiply_matrix3x3_by_matrix3x3(const BGC_FP32_Matrix3x3* matrix1, const BGC_FP32_Matrix3x3* matrix2, BGC_FP32_Matrix3x3* product);
|
|
||||||
extern inline void bgc_fp64_multiply_matrix3x3_by_matrix3x3(const BGC_FP64_Matrix3x3* matrix1, const BGC_FP64_Matrix3x3* matrix2, BGC_FP64_Matrix3x3* product);
|
|
||||||
|
|
@ -1,49 +1,49 @@
|
||||||
#include "position2.h"
|
#include "position2.h"
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_reset(BGC_FP32_Position2 * node);
|
extern inline void bgc_fp32_position2_reset(BGC_FP32_Position2* node);
|
||||||
extern inline void bgc_fp64_position2_reset(BGC_FP64_Position2 * node);
|
extern inline void bgc_fp64_position2_reset(BGC_FP64_Position2* node);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_make(const BGC_FP32_CotesNumber * turn, const BGC_FP32_Vector2 * shift, BGC_FP32_Position2 * position);
|
extern inline void bgc_fp32_position2_make(BGC_FP32_Position2* position, const BGC_FP32_CotesNumber* turn, const BGC_FP32_Vector2* shift);
|
||||||
extern inline void bgc_fp64_position2_make(const BGC_FP64_CotesNumber * turn, const BGC_FP64_Vector2 * shift, BGC_FP64_Position2 * position);
|
extern inline void bgc_fp64_position2_make(BGC_FP64_Position2* position, const BGC_FP64_CotesNumber* turn, const BGC_FP64_Vector2* shift);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_copy(const BGC_FP32_Position2 * source, BGC_FP32_Position2 * destination);
|
extern inline void bgc_fp32_position2_copy(BGC_FP32_Position2* destination, const BGC_FP32_Position2* source);
|
||||||
extern inline void bgc_fp64_position2_copy(const BGC_FP64_Position2 * source, BGC_FP64_Position2 * destination);
|
extern inline void bgc_fp64_position2_copy(BGC_FP64_Position2* destination, const BGC_FP64_Position2* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_swap(BGC_FP32_Position2 * first, BGC_FP32_Position2 * second);
|
extern inline void bgc_fp32_position2_swap(BGC_FP32_Position2* first, BGC_FP32_Position2* second);
|
||||||
extern inline void bgc_fp64_position2_swap(BGC_FP64_Position2 * first, BGC_FP64_Position2 * second);
|
extern inline void bgc_fp64_position2_swap(BGC_FP64_Position2* first, BGC_FP64_Position2* second);
|
||||||
|
|
||||||
extern inline void bgc_fp64_position2_convert_to_fp32(const BGC_FP64_Position2 * source, BGC_FP32_Position2 * destination);
|
extern inline void bgc_fp64_position2_convert_to_fp32(BGC_FP32_Position2* destination, const BGC_FP64_Position2* source);
|
||||||
extern inline void bgc_fp32_position2_convert_to_fp64(const BGC_FP32_Position2 * source, BGC_FP64_Position2 * destination);
|
extern inline void bgc_fp32_position2_convert_to_fp64(BGC_FP64_Position2* destination, const BGC_FP32_Position2* source);
|
||||||
|
|
||||||
extern inline int bgc_fp32_position2_is_idle(const BGC_FP32_Position2 * position);
|
extern inline int bgc_fp32_position2_is_idle(const BGC_FP32_Position2* position);
|
||||||
extern inline int bgc_fp64_position2_is_idle(const BGC_FP64_Position2 * position);
|
extern inline int bgc_fp64_position2_is_idle(const BGC_FP64_Position2* position);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_invert(BGC_FP32_Position2 * position);
|
extern inline void bgc_fp32_position2_invert(BGC_FP32_Position2* position);
|
||||||
extern inline void bgc_fp64_position2_invert(BGC_FP64_Position2 * position);
|
extern inline void bgc_fp64_position2_invert(BGC_FP64_Position2* position);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_get_inverse(const BGC_FP32_Position2 * position, BGC_FP32_Position2 * inverted);
|
extern inline void bgc_fp32_position2_get_inverse(BGC_FP32_Position2* inverted, const BGC_FP32_Position2* position);
|
||||||
extern inline void bgc_fp64_position2_get_inverse(const BGC_FP64_Position2 * position, BGC_FP64_Position2 * inverted);
|
extern inline void bgc_fp64_position2_get_inverse(BGC_FP64_Position2* inverted, const BGC_FP64_Position2* position);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_combine(const BGC_FP32_Position2 * first, const BGC_FP32_Position2 * second, BGC_FP32_Position2 * combination);
|
extern inline void bgc_fp32_position2_combine(BGC_FP32_Position2* combination, const BGC_FP32_Position2* first, const BGC_FP32_Position2* second);
|
||||||
extern inline void bgc_fp64_position2_combine(const BGC_FP64_Position2 * first, const BGC_FP64_Position2 * second, BGC_FP64_Position2 * combination);
|
extern inline void bgc_fp64_position2_combine(BGC_FP64_Position2* combination, const BGC_FP64_Position2* first, const BGC_FP64_Position2* second);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_exclude(const BGC_FP32_Position2 * base, const BGC_FP32_Position2 * excludand, BGC_FP32_Position2 * difference);
|
extern inline void bgc_fp32_position2_exclude(BGC_FP32_Position2* difference, const BGC_FP32_Position2* base, const BGC_FP32_Position2* excludand);
|
||||||
extern inline void bgc_fp64_position2_exclude(const BGC_FP64_Position2 * base, const BGC_FP64_Position2 * excludand, BGC_FP64_Position2 * difference);
|
extern inline void bgc_fp64_position2_exclude(BGC_FP64_Position2* difference, const BGC_FP64_Position2* base, const BGC_FP64_Position2* excludand);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_get_outward_affine(const BGC_FP32_Position2 * position, BGC_FP32_Affine2 * outward_affine_map);
|
extern inline void bgc_fp32_position2_get_outward_affine(BGC_FP32_Affine2* outward_affine_map, const BGC_FP32_Position2* position);
|
||||||
extern inline void bgc_fp64_position2_get_outward_affine(const BGC_FP64_Position2 * position, BGC_FP64_Affine2 * outward_affine_map);
|
extern inline void bgc_fp64_position2_get_outward_affine(BGC_FP64_Affine2* outward_affine_map, const BGC_FP64_Position2* position);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_get_inward_affine(const BGC_FP32_Position2 * position, BGC_FP32_Affine2 * inward_affine_map);
|
extern inline void bgc_fp32_position2_get_inward_affine(BGC_FP32_Affine2* inward_affine_map, const BGC_FP32_Position2* position);
|
||||||
extern inline void bgc_fp64_position2_get_inward_affine(const BGC_FP64_Position2 * position, BGC_FP64_Affine2 * inward_affine_map);
|
extern inline void bgc_fp64_position2_get_inward_affine(BGC_FP64_Affine2* inward_affine_map, const BGC_FP64_Position2* position);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_transform_point_outwards(const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * inner_point, BGC_FP32_Vector2 * outer_point);
|
extern inline void bgc_fp32_position2_transform_point_outwards(BGC_FP32_Vector2* outer_point, const BGC_FP32_Position2* position, const BGC_FP32_Vector2* inner_point);
|
||||||
extern inline void bgc_fp64_position2_transform_point_outwards(const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * inner_point, BGC_FP64_Vector2 * outer_point);
|
extern inline void bgc_fp64_position2_transform_point_outwards(BGC_FP64_Vector2* outer_point, const BGC_FP64_Position2* position, const BGC_FP64_Vector2* inner_point);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_transform_point_inwards(const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * outer_point, BGC_FP32_Vector2 * inner_point);
|
extern inline void bgc_fp32_position2_transform_point_inwards(BGC_FP32_Vector2* inner_point, const BGC_FP32_Position2* position, const BGC_FP32_Vector2* outer_point);
|
||||||
extern inline void bgc_fp64_position2_transform_point_inwards(const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * outer_point, BGC_FP64_Vector2 * inner_point);
|
extern inline void bgc_fp64_position2_transform_point_inwards(BGC_FP64_Vector2* inner_point, const BGC_FP64_Position2* position, const BGC_FP64_Vector2* outer_point);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_transform_vector_outwards(const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * inner_vector, BGC_FP32_Vector2 * outer_vector);
|
extern inline void bgc_fp32_position2_transform_vector_outwards(BGC_FP32_Vector2* outer_vector, const BGC_FP32_Position2* position, const BGC_FP32_Vector2* inner_vector);
|
||||||
extern inline void bgc_fp64_position2_transform_vector_outwards(const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * inner_vector, BGC_FP64_Vector2 * outer_vector);
|
extern inline void bgc_fp64_position2_transform_vector_outwards(BGC_FP64_Vector2* outer_vector, const BGC_FP64_Position2* position, const BGC_FP64_Vector2* inner_vector);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position2_transform_vector_inwards(const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * outer_vector, BGC_FP32_Vector2 * inner_vector);
|
extern inline void bgc_fp32_position2_transform_vector_inwards(BGC_FP32_Vector2* inner_vector, const BGC_FP32_Position2* position, const BGC_FP32_Vector2* outer_vector);
|
||||||
extern inline void bgc_fp64_position2_transform_vector_inwards(const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * outer_vector, BGC_FP64_Vector2 * inner_vector);
|
extern inline void bgc_fp64_position2_transform_vector_inwards(BGC_FP64_Vector2* inner_vector, const BGC_FP64_Position2* position, const BGC_FP64_Vector2* outer_vector);
|
||||||
|
|
|
||||||
|
|
@ -19,13 +19,13 @@ typedef struct {
|
||||||
|
|
||||||
// ==================== Reset ==================== //
|
// ==================== Reset ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_reset(BGC_FP32_Position2 * position)
|
inline void bgc_fp32_position2_reset(BGC_FP32_Position2* position)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_reset(&position->turn);
|
bgc_fp32_cotes_number_reset(&position->turn);
|
||||||
bgc_fp32_vector2_reset(&position->shift);
|
bgc_fp32_vector2_reset(&position->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_reset(BGC_FP64_Position2 * position)
|
inline void bgc_fp64_position2_reset(BGC_FP64_Position2* position)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_reset(&position->turn);
|
bgc_fp64_cotes_number_reset(&position->turn);
|
||||||
bgc_fp64_vector2_reset(&position->shift);
|
bgc_fp64_vector2_reset(&position->shift);
|
||||||
|
|
@ -33,31 +33,31 @@ inline void bgc_fp64_position2_reset(BGC_FP64_Position2 * position)
|
||||||
|
|
||||||
// ==================== Make ===================== //
|
// ==================== Make ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_make(const BGC_FP32_CotesNumber * turn, const BGC_FP32_Vector2 * shift, BGC_FP32_Position2 * position)
|
inline void bgc_fp32_position2_make(BGC_FP32_Position2* position, const BGC_FP32_CotesNumber* turn, const BGC_FP32_Vector2* shift)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_copy(turn, &position->turn);
|
bgc_fp32_cotes_number_copy(&position->turn, turn);
|
||||||
bgc_fp32_vector2_copy(shift, &position->shift);
|
bgc_fp32_vector2_copy(&position->shift, shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_make(const BGC_FP64_CotesNumber * turn, const BGC_FP64_Vector2 * shift, BGC_FP64_Position2 * position)
|
inline void bgc_fp64_position2_make(BGC_FP64_Position2* position, const BGC_FP64_CotesNumber* turn, const BGC_FP64_Vector2* shift)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_copy(turn, &position->turn);
|
bgc_fp64_cotes_number_copy(&position->turn, turn);
|
||||||
bgc_fp64_vector2_copy(shift, &position->shift);
|
bgc_fp64_vector2_copy(&position->shift, shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
// ==================== Copy ===================== //
|
// ==================== Copy ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_copy(const BGC_FP32_Position2 * source, BGC_FP32_Position2 * destination)
|
inline void bgc_fp32_position2_copy(BGC_FP32_Position2* destination, const BGC_FP32_Position2* source)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_copy(&source->turn, &destination->turn);
|
bgc_fp32_cotes_number_copy(&destination->turn, &source->turn);
|
||||||
bgc_fp32_vector2_copy(&source->shift, &destination->shift);
|
bgc_fp32_vector2_copy(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_copy(const BGC_FP64_Position2 * source, BGC_FP64_Position2 * destination)
|
inline void bgc_fp64_position2_copy(BGC_FP64_Position2* destination, const BGC_FP64_Position2* source)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_copy(&source->turn, &destination->turn);
|
bgc_fp64_cotes_number_copy(&destination->turn, &source->turn);
|
||||||
bgc_fp64_vector2_copy(&source->shift, &destination->shift);
|
bgc_fp64_vector2_copy(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ==================== Swap ===================== //
|
// ==================== Swap ===================== //
|
||||||
|
|
@ -76,16 +76,16 @@ inline void bgc_fp64_position2_swap(BGC_FP64_Position2 * first, BGC_FP64_Positio
|
||||||
|
|
||||||
// =================== Convert =================== //
|
// =================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_position2_convert_to_fp32(const BGC_FP64_Position2 * source, BGC_FP32_Position2 * destination)
|
inline void bgc_fp64_position2_convert_to_fp32(BGC_FP32_Position2* destination, const BGC_FP64_Position2 * source)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_convert_to_fp32(&source->turn, &destination->turn);
|
bgc_fp64_cotes_number_convert_to_fp32(&destination->turn, &source->turn);
|
||||||
bgc_fp64_vector2_convert_to_fp32(&source->shift, &destination->shift);
|
bgc_fp64_vector2_convert_to_fp32(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_position2_convert_to_fp64(const BGC_FP32_Position2 * source, BGC_FP64_Position2 * destination)
|
inline void bgc_fp32_position2_convert_to_fp64(BGC_FP64_Position2* destination, const BGC_FP32_Position2 * source)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_convert_to_fp64(&source->turn, &destination->turn);
|
bgc_fp32_cotes_number_convert_to_fp64(&destination->turn, &source->turn);
|
||||||
bgc_fp32_vector2_convert_to_fp64(&source->shift, &destination->shift);
|
bgc_fp32_vector2_convert_to_fp64(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Is Idle =================== //
|
// =================== Is Idle =================== //
|
||||||
|
|
@ -104,156 +104,156 @@ inline int bgc_fp64_position2_is_idle(const BGC_FP64_Position2 * position)
|
||||||
|
|
||||||
inline void bgc_fp32_position2_invert(BGC_FP32_Position2 * position)
|
inline void bgc_fp32_position2_invert(BGC_FP32_Position2 * position)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_turn_vector_back(&position->turn, &position->shift, &position->shift);
|
bgc_fp32_cotes_number_turn_vector_back(&position->shift, &position->turn, &position->shift);
|
||||||
bgc_fp32_cotes_number_revert(&position->turn);
|
bgc_fp32_cotes_number_revert(&position->turn);
|
||||||
bgc_fp32_vector2_revert(&position->shift);
|
bgc_fp32_vector2_revert(&position->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_invert(BGC_FP64_Position2 * position)
|
inline void bgc_fp64_position2_invert(BGC_FP64_Position2 * position)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_turn_vector_back(&position->turn, &position->shift, &position->shift);
|
bgc_fp64_cotes_number_turn_vector_back(&position->shift, &position->turn, &position->shift);
|
||||||
bgc_fp64_cotes_number_revert(&position->turn);
|
bgc_fp64_cotes_number_revert(&position->turn);
|
||||||
bgc_fp64_vector2_revert(&position->shift);
|
bgc_fp64_vector2_revert(&position->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================= Get Inverse ================= //
|
// ================= Get Inverse ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_get_inverse(const BGC_FP32_Position2 * position, BGC_FP32_Position2 * inverted)
|
inline void bgc_fp32_position2_get_inverse(BGC_FP32_Position2* inverted, const BGC_FP32_Position2 * position)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_turn_vector_back(&position->turn, &position->shift, &inverted->shift);
|
bgc_fp32_cotes_number_turn_vector_back(&inverted->shift, &position->turn, &position->shift);
|
||||||
bgc_fp32_cotes_number_get_reverse(&position->turn, &inverted->turn);
|
bgc_fp32_cotes_number_get_reverse(&inverted->turn, &position->turn);
|
||||||
bgc_fp32_vector2_revert(&inverted->shift);
|
bgc_fp32_vector2_revert(&inverted->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_get_inverse(const BGC_FP64_Position2 * position, BGC_FP64_Position2 * inverted)
|
inline void bgc_fp64_position2_get_inverse(BGC_FP64_Position2* inverted, const BGC_FP64_Position2 * position)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_turn_vector_back(&position->turn, &position->shift, &inverted->shift);
|
bgc_fp64_cotes_number_turn_vector_back(&inverted->shift, &position->turn, &position->shift);
|
||||||
bgc_fp64_cotes_number_get_inverse(&position->turn, &inverted->turn);
|
bgc_fp64_cotes_number_get_reverse(&inverted->turn, &position->turn);
|
||||||
bgc_fp64_vector2_revert(&inverted->shift);
|
bgc_fp64_vector2_revert(&inverted->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Combine =================== //
|
// =================== Combine =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_combine(const BGC_FP32_Position2 * first, const BGC_FP32_Position2 * second, BGC_FP32_Position2 * combination)
|
inline void bgc_fp32_position2_combine(BGC_FP32_Position2* combination, const BGC_FP32_Position2 * first, const BGC_FP32_Position2 * second)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector2 relative_shift;
|
BGC_FP32_Vector2 relative_shift;
|
||||||
bgc_fp32_cotes_number_turn_vector(&second->turn, &first->shift, &relative_shift);
|
bgc_fp32_cotes_number_turn_vector(&relative_shift, &second->turn, &first->shift);
|
||||||
bgc_fp32_cotes_number_combine(&first->turn, &second->turn, &combination->turn);
|
bgc_fp32_cotes_number_combine(&combination->turn, &first->turn, &second->turn);
|
||||||
bgc_fp32_vector2_add(&relative_shift, &second->shift, &combination->shift);
|
bgc_fp32_vector2_add(&combination->shift, &second->shift, &relative_shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_combine(const BGC_FP64_Position2 * first, const BGC_FP64_Position2 * second, BGC_FP64_Position2 * combination)
|
inline void bgc_fp64_position2_combine(BGC_FP64_Position2* combination, const BGC_FP64_Position2 * first, const BGC_FP64_Position2 * second)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector2 relative_shift;
|
BGC_FP64_Vector2 relative_shift;
|
||||||
bgc_fp64_cotes_number_turn_vector(&second->turn, &first->shift, &relative_shift);
|
bgc_fp64_cotes_number_turn_vector(&relative_shift, &second->turn, &first->shift);
|
||||||
bgc_fp64_cotes_number_combine(&first->turn, &second->turn, &combination->turn);
|
bgc_fp64_cotes_number_combine(&combination->turn, &first->turn, &second->turn);
|
||||||
bgc_fp64_vector2_add(&relative_shift, &second->shift, &combination->shift);
|
bgc_fp64_vector2_add(&combination->shift, &second->shift, &relative_shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Exclude =================== //
|
// =================== Exclude =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_exclude(const BGC_FP32_Position2 * base, const BGC_FP32_Position2 * excludand, BGC_FP32_Position2 * difference)
|
inline void bgc_fp32_position2_exclude(BGC_FP32_Position2* difference, const BGC_FP32_Position2 * base, const BGC_FP32_Position2 * excludand)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector2 relative_shift;
|
BGC_FP32_Vector2 relative_shift;
|
||||||
bgc_fp32_vector2_subtract(&base->shift, &excludand->shift, &relative_shift);
|
bgc_fp32_vector2_subtract(&relative_shift, &base->shift, &excludand->shift);
|
||||||
bgc_fp32_cotes_number_turn_vector_back(&excludand->turn, &relative_shift, &difference->shift);
|
bgc_fp32_cotes_number_turn_vector_back(&difference->shift, &excludand->turn, &relative_shift);
|
||||||
bgc_fp32_cotes_number_exclude(&base->turn, &excludand->turn, &difference->turn);
|
bgc_fp32_cotes_number_exclude(&difference->turn, &base->turn, &excludand->turn);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_exclude(const BGC_FP64_Position2 * base, const BGC_FP64_Position2 * excludand, BGC_FP64_Position2 * difference)
|
inline void bgc_fp64_position2_exclude(BGC_FP64_Position2* difference, const BGC_FP64_Position2 * base, const BGC_FP64_Position2 * excludand)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector2 relative_shift;
|
BGC_FP64_Vector2 relative_shift;
|
||||||
bgc_fp64_vector2_subtract(&base->shift, &excludand->shift, &relative_shift);
|
bgc_fp64_vector2_subtract(&relative_shift, &base->shift, &excludand->shift);
|
||||||
bgc_fp64_cotes_number_turn_vector_back(&excludand->turn, &relative_shift, &difference->shift);
|
bgc_fp64_cotes_number_turn_vector_back(&difference->shift, &excludand->turn, &relative_shift);
|
||||||
bgc_fp64_cotes_number_exclude(&base->turn, &excludand->turn, &difference->turn);
|
bgc_fp64_cotes_number_exclude(&difference->turn, &base->turn, &excludand->turn);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============= Get Outward Affine ============== //
|
// ============= Get Outward Affine ============== //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_get_outward_affine(const BGC_FP32_Position2 * position, BGC_FP32_Affine2 * outward_affine_map)
|
inline void bgc_fp32_position2_get_outward_affine(BGC_FP32_Affine2* outward_affine_map, const BGC_FP32_Position2 * position)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_get_rotation_matrix(&position->turn, &outward_affine_map->distortion);
|
bgc_fp32_cotes_number_get_rotation_matrix(&outward_affine_map->distortion, &position->turn);
|
||||||
bgc_fp32_vector2_copy(&position->shift, &outward_affine_map->shift);
|
bgc_fp32_vector2_copy(&outward_affine_map->shift, &position->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_get_outward_affine(const BGC_FP64_Position2 * position, BGC_FP64_Affine2 * outward_affine_map)
|
inline void bgc_fp64_position2_get_outward_affine(BGC_FP64_Affine2* outward_affine_map, const BGC_FP64_Position2 * position)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_get_rotation_matrix(&position->turn, &outward_affine_map->distortion);
|
bgc_fp64_cotes_number_get_rotation_matrix(&outward_affine_map->distortion, &position->turn);
|
||||||
bgc_fp64_vector2_copy(&position->shift, &outward_affine_map->shift);
|
bgc_fp64_vector2_copy(&outward_affine_map->shift, &position->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============== Get Inward Affine ============== //
|
// ============== Get Inward Affine ============== //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_get_inward_affine(const BGC_FP32_Position2 * position, BGC_FP32_Affine2 * inward_affine_map)
|
inline void bgc_fp32_position2_get_inward_affine(BGC_FP32_Affine2* inward_affine_map, const BGC_FP32_Position2 * position)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_get_reverse_matrix(&position->turn, &inward_affine_map->distortion);
|
bgc_fp32_cotes_number_get_reverse_matrix(&inward_affine_map->distortion, &position->turn);
|
||||||
bgc_fp32_multiply_matrix2x2_by_vector2(&inward_affine_map->distortion, &position->shift, &inward_affine_map->shift);
|
bgc_fp32_multiply_matrix2x2_by_vector2(&inward_affine_map->shift, &inward_affine_map->distortion, &position->shift);
|
||||||
bgc_fp32_vector2_revert(&inward_affine_map->shift);
|
bgc_fp32_vector2_revert(&inward_affine_map->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_get_inward_affine(const BGC_FP64_Position2 * position, BGC_FP64_Affine2 * inward_affine_map)
|
inline void bgc_fp64_position2_get_inward_affine(BGC_FP64_Affine2* inward_affine_map, const BGC_FP64_Position2 * position)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_get_reverse_matrix(&position->turn, &inward_affine_map->distortion);
|
bgc_fp64_cotes_number_get_reverse_matrix(&inward_affine_map->distortion, &position->turn);
|
||||||
bgc_fp64_multiply_matrix2x2_by_vector2(&inward_affine_map->distortion, &position->shift, &inward_affine_map->shift);
|
bgc_fp64_multiply_matrix2x2_by_vector2(&inward_affine_map->shift, &inward_affine_map->distortion, &position->shift);
|
||||||
bgc_fp64_vector2_revert(&inward_affine_map->shift);
|
bgc_fp64_vector2_revert(&inward_affine_map->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ========== Transform Point Outwards =========== //
|
// ========== Transform Point Outwards =========== //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_transform_point_outwards(const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * inner_point, BGC_FP32_Vector2 * outer_point)
|
inline void bgc_fp32_position2_transform_point_outwards(BGC_FP32_Vector2* outer_point, const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * inner_point)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector2 turned_point;
|
BGC_FP32_Vector2 turned_point;
|
||||||
bgc_fp32_cotes_number_turn_vector(&position->turn, inner_point, &turned_point);
|
bgc_fp32_cotes_number_turn_vector(&turned_point, &position->turn, inner_point);
|
||||||
bgc_fp32_vector2_add(&position->shift, &turned_point, outer_point);
|
bgc_fp32_vector2_add(outer_point, &position->shift, &turned_point);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_transform_point_outwards(const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * inner_point, BGC_FP64_Vector2 * outer_point)
|
inline void bgc_fp64_position2_transform_point_outwards(BGC_FP64_Vector2* outer_point, const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * inner_point)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector2 turned_point;
|
BGC_FP64_Vector2 turned_point;
|
||||||
bgc_fp64_cotes_number_turn_vector(&position->turn, inner_point, &turned_point);
|
bgc_fp64_cotes_number_turn_vector(&turned_point, &position->turn, inner_point);
|
||||||
bgc_fp64_vector2_add(&position->shift, &turned_point, outer_point);
|
bgc_fp64_vector2_add(outer_point, &position->shift, &turned_point);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =========== Transform Point Inwards =========== //
|
// =========== Transform Point Inwards =========== //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_transform_point_inwards(const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * outer_point, BGC_FP32_Vector2 * inner_point)
|
inline void bgc_fp32_position2_transform_point_inwards(BGC_FP32_Vector2* inner_point, const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * outer_point)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector2 relative_point;
|
BGC_FP32_Vector2 relative_point;
|
||||||
bgc_fp32_vector2_subtract(outer_point, &position->shift, &relative_point);
|
bgc_fp32_vector2_subtract(&relative_point, outer_point, &position->shift);
|
||||||
bgc_fp32_cotes_number_turn_vector_back(&position->turn, &relative_point, inner_point);
|
bgc_fp32_cotes_number_turn_vector_back(inner_point, &position->turn, &relative_point);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_transform_point_inwards(const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * outer_point, BGC_FP64_Vector2 * inner_point)
|
inline void bgc_fp64_position2_transform_point_inwards(BGC_FP64_Vector2* inner_point, const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * outer_point)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector2 relative_point;
|
BGC_FP64_Vector2 relative_point;
|
||||||
bgc_fp64_vector2_subtract(outer_point, &position->shift, &relative_point);
|
bgc_fp64_vector2_subtract(&relative_point, outer_point, &position->shift);
|
||||||
bgc_fp64_cotes_number_turn_vector_back(&position->turn, &relative_point, inner_point);
|
bgc_fp64_cotes_number_turn_vector_back(inner_point, &position->turn, &relative_point);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// ========== Transform Vector Outwards ========== //
|
// ========== Transform Vector Outwards ========== //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_transform_vector_outwards(const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * inner_vector, BGC_FP32_Vector2 * outer_vector)
|
inline void bgc_fp32_position2_transform_vector_outwards(BGC_FP32_Vector2* outer_vector, const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * inner_vector)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_turn_vector(&position->turn, inner_vector, outer_vector);
|
bgc_fp32_cotes_number_turn_vector(outer_vector, &position->turn, inner_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_transform_vector_outwards(const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * inner_vector, BGC_FP64_Vector2 * outer_vector)
|
inline void bgc_fp64_position2_transform_vector_outwards(BGC_FP64_Vector2* outer_vector, const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * inner_vector)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_turn_vector(&position->turn, inner_vector, outer_vector);
|
bgc_fp64_cotes_number_turn_vector(outer_vector, &position->turn, inner_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ========== Transform Vector Inwards =========== //
|
// ========== Transform Vector Inwards =========== //
|
||||||
|
|
||||||
inline void bgc_fp32_position2_transform_vector_inwards(const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * outer_vector, BGC_FP32_Vector2 * inner_vector)
|
inline void bgc_fp32_position2_transform_vector_inwards(BGC_FP32_Vector2* inner_vector, const BGC_FP32_Position2 * position, const BGC_FP32_Vector2 * outer_vector)
|
||||||
{
|
{
|
||||||
bgc_fp32_cotes_number_turn_vector_back(&position->turn, outer_vector, inner_vector);
|
bgc_fp32_cotes_number_turn_vector_back(inner_vector, &position->turn, outer_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position2_transform_vector_inwards(const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * outer_vector, BGC_FP64_Vector2 * inner_vector)
|
inline void bgc_fp64_position2_transform_vector_inwards(BGC_FP64_Vector2* inner_vector, const BGC_FP64_Position2 * position, const BGC_FP64_Vector2 * outer_vector)
|
||||||
{
|
{
|
||||||
bgc_fp64_cotes_number_turn_vector_back(&position->turn, outer_vector, inner_vector);
|
bgc_fp64_cotes_number_turn_vector_back(inner_vector, &position->turn, outer_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
|
||||||
|
|
@ -3,17 +3,17 @@
|
||||||
extern inline void bgc_fp32_position3_reset(BGC_FP32_Position3 * node);
|
extern inline void bgc_fp32_position3_reset(BGC_FP32_Position3 * node);
|
||||||
extern inline void bgc_fp64_position3_reset(BGC_FP64_Position3 * node);
|
extern inline void bgc_fp64_position3_reset(BGC_FP64_Position3 * node);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_make(const BGC_FP32_Versor * turn, const BGC_FP32_Vector3 * shift, BGC_FP32_Position3 * position);
|
extern inline void bgc_fp32_position3_make(BGC_FP32_Position3* position, const BGC_FP32_Versor* turn, const BGC_FP32_Vector3* shift);
|
||||||
extern inline void bgc_fp64_position3_make(const BGC_FP64_Versor * turn, const BGC_FP64_Vector3 * shift, BGC_FP64_Position3 * position);
|
extern inline void bgc_fp64_position3_make(BGC_FP64_Position3* position, const BGC_FP64_Versor * turn, const BGC_FP64_Vector3 * shift);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_copy(const BGC_FP32_Position3 * source, BGC_FP32_Position3 * destination);
|
extern inline void bgc_fp32_position3_copy(BGC_FP32_Position3* destination, const BGC_FP32_Position3* source);
|
||||||
extern inline void bgc_fp64_position3_copy(const BGC_FP64_Position3 * source, BGC_FP64_Position3 * destination);
|
extern inline void bgc_fp64_position3_copy(BGC_FP64_Position3* destination, const BGC_FP64_Position3 * source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_swap(BGC_FP32_Position3 * first, BGC_FP32_Position3 * second);
|
extern inline void bgc_fp32_position3_swap(BGC_FP32_Position3 * first, BGC_FP32_Position3 * second);
|
||||||
extern inline void bgc_fp64_position3_swap(BGC_FP64_Position3 * first, BGC_FP64_Position3 * second);
|
extern inline void bgc_fp64_position3_swap(BGC_FP64_Position3 * first, BGC_FP64_Position3 * second);
|
||||||
|
|
||||||
extern inline void bgc_fp64_position3_convert_to_fp32(const BGC_FP64_Position3 * source, BGC_FP32_Position3 * destination);
|
extern inline void bgc_fp32_position3_convert_to_fp64(BGC_FP64_Position3* destination,const BGC_FP32_Position3 * source);
|
||||||
extern inline void bgc_fp32_position3_convert_to_fp64(const BGC_FP32_Position3 * source, BGC_FP64_Position3 * destination);
|
extern inline void bgc_fp64_position3_convert_to_fp32(BGC_FP32_Position3* destination, const BGC_FP64_Position3* source);
|
||||||
|
|
||||||
extern inline int bgc_fp32_position3_is_idle(const BGC_FP32_Position3 * position);
|
extern inline int bgc_fp32_position3_is_idle(const BGC_FP32_Position3 * position);
|
||||||
extern inline int bgc_fp64_position3_is_idle(const BGC_FP64_Position3 * position);
|
extern inline int bgc_fp64_position3_is_idle(const BGC_FP64_Position3 * position);
|
||||||
|
|
@ -21,29 +21,29 @@ extern inline int bgc_fp64_position3_is_idle(const BGC_FP64_Position3 * position
|
||||||
extern inline void bgc_fp32_position3_invert(BGC_FP32_Position3 * position);
|
extern inline void bgc_fp32_position3_invert(BGC_FP32_Position3 * position);
|
||||||
extern inline void bgc_fp64_position3_invert(BGC_FP64_Position3 * position);
|
extern inline void bgc_fp64_position3_invert(BGC_FP64_Position3 * position);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_get_inverse(const BGC_FP32_Position3 * position, BGC_FP32_Position3 * inverted);
|
extern inline void bgc_fp32_position3_get_inverse(BGC_FP32_Position3* inverse, const BGC_FP32_Position3* position);
|
||||||
extern inline void bgc_fp64_position3_get_inverse(const BGC_FP64_Position3 * position, BGC_FP64_Position3 * inverted);
|
extern inline void bgc_fp64_position3_get_inverse(BGC_FP64_Position3* inverse, const BGC_FP64_Position3 * position);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_combine(const BGC_FP32_Position3 * first, const BGC_FP32_Position3 * second, BGC_FP32_Position3 * combination);
|
extern inline void bgc_fp32_position3_combine(BGC_FP32_Position3* combination, const BGC_FP32_Position3* first, const BGC_FP32_Position3* second);
|
||||||
extern inline void bgc_fp64_position3_combine(const BGC_FP64_Position3 * first, const BGC_FP64_Position3 * second, BGC_FP64_Position3 * combination);
|
extern inline void bgc_fp64_position3_combine(BGC_FP64_Position3* combination, const BGC_FP64_Position3 * first, const BGC_FP64_Position3 * second);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_exclude(const BGC_FP32_Position3 * base, const BGC_FP32_Position3 * excludant, BGC_FP32_Position3 * difference);
|
extern inline void bgc_fp32_position3_exclude(BGC_FP32_Position3* difference, const BGC_FP32_Position3* base, const BGC_FP32_Position3* excludant);
|
||||||
extern inline void bgc_fp64_position3_exclude(const BGC_FP64_Position3 * base, const BGC_FP64_Position3 * excludant, BGC_FP64_Position3 * difference);
|
extern inline void bgc_fp64_position3_exclude(BGC_FP64_Position3* difference, const BGC_FP64_Position3 * base, const BGC_FP64_Position3 * excludant);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_get_outward_affine(const BGC_FP32_Position3 * position, BGC_FP32_Affine3 * outward_affine_map);
|
extern inline void bgc_fp32_position3_get_outward_affine(BGC_FP32_Affine3* outward_affine_map, const BGC_FP32_Position3* position);
|
||||||
extern inline void bgc_fp64_position3_get_outward_affine(const BGC_FP64_Position3 * position, BGC_FP64_Affine3 * outward_affine_map);
|
extern inline void bgc_fp64_position3_get_outward_affine(BGC_FP64_Affine3* outward_affine_map, const BGC_FP64_Position3 * position);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_get_inward_affine(const BGC_FP32_Position3 * position, BGC_FP32_Affine3 * inward_affine_map);
|
extern inline void bgc_fp32_position3_get_inward_affine(BGC_FP32_Affine3* inward_affine_map, const BGC_FP32_Position3* position);
|
||||||
extern inline void bgc_fp64_position3_get_inward_affine(const BGC_FP64_Position3 * position, BGC_FP64_Affine3 * inward_affine_map);
|
extern inline void bgc_fp64_position3_get_inward_affine(BGC_FP64_Affine3* inward_affine_map, const BGC_FP64_Position3 * position);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_transform_point_outwards(const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * inner_point, BGC_FP32_Vector3 * outer_point);
|
extern inline void bgc_fp32_position3_transform_point_outwards(BGC_FP32_Vector3* outer_point, const BGC_FP32_Position3* position, const BGC_FP32_Vector3* inner_point);
|
||||||
extern inline void bgc_fp64_position3_transform_point_outwards(const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * inner_point, BGC_FP64_Vector3 * outer_point);
|
extern inline void bgc_fp64_position3_transform_point_outwards(BGC_FP64_Vector3* outer_point, const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * inner_point);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_transform_point_inwards(const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * outer_point, BGC_FP32_Vector3 * inner_point);
|
extern inline void bgc_fp32_position3_transform_point_inwards(BGC_FP32_Vector3* inner_point, const BGC_FP32_Position3* position, const BGC_FP32_Vector3* outer_point);
|
||||||
extern inline void bgc_fp64_position3_transform_point_inwards(const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * outer_point, BGC_FP64_Vector3 * inner_point);
|
extern inline void bgc_fp64_position3_transform_point_inwards(BGC_FP64_Vector3* inner_point, const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * outer_point);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_transform_vector_outwards(const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * inner_vector, BGC_FP32_Vector3 * outer_vector);
|
extern inline void bgc_fp32_position3_transform_vector_outwards(BGC_FP32_Vector3* outer_vector, const BGC_FP32_Position3* position, const BGC_FP32_Vector3* inner_vector);
|
||||||
extern inline void bgc_fp64_position3_transform_vector_outwards(const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * inner_vector, BGC_FP64_Vector3 * outer_vector);
|
extern inline void bgc_fp64_position3_transform_vector_outwards(BGC_FP64_Vector3* outer_vector, const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * inner_vector);
|
||||||
|
|
||||||
extern inline void bgc_fp32_position3_transform_vector_inwards(const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * outer_vector, BGC_FP32_Vector3 * inner_vector);
|
extern inline void bgc_fp32_position3_transform_vector_inwards(BGC_FP32_Vector3* inner_vector, const BGC_FP32_Position3* position, const BGC_FP32_Vector3* outer_vector);
|
||||||
extern inline void bgc_fp64_position3_transform_vector_inwards(const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * outer_vector, BGC_FP64_Vector3 * inner_vector);
|
extern inline void bgc_fp64_position3_transform_vector_inwards(BGC_FP64_Vector3* inner_vector, const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * outer_vector);
|
||||||
|
|
|
||||||
|
|
@ -33,30 +33,30 @@ inline void bgc_fp64_position3_reset(BGC_FP64_Position3 * position)
|
||||||
|
|
||||||
// ==================== Make ===================== //
|
// ==================== Make ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_position3_make(const BGC_FP32_Versor * turn, const BGC_FP32_Vector3 * shift, BGC_FP32_Position3 * position)
|
inline void bgc_fp32_position3_make(BGC_FP32_Position3* position, const BGC_FP32_Versor * turn, const BGC_FP32_Vector3 * shift)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_copy(turn, &position->turn);
|
bgc_fp32_versor_copy(&position->turn, turn);
|
||||||
bgc_fp32_vector3_copy(shift, &position->shift);
|
bgc_fp32_vector3_copy(&position->shift, shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_make(const BGC_FP64_Versor * turn, const BGC_FP64_Vector3 * shift, BGC_FP64_Position3 * position)
|
inline void bgc_fp64_position3_make(BGC_FP64_Position3* position, const BGC_FP64_Versor * turn, const BGC_FP64_Vector3 * shift)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_copy(turn, &position->turn);
|
bgc_fp64_versor_copy(&position->turn, turn);
|
||||||
bgc_fp64_vector3_copy(shift, &position->shift);
|
bgc_fp64_vector3_copy(&position->shift, shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ==================== Copy ===================== //
|
// ==================== Copy ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_position3_copy(const BGC_FP32_Position3 * source, BGC_FP32_Position3 * destination)
|
inline void bgc_fp32_position3_copy(BGC_FP32_Position3* destination, const BGC_FP32_Position3 * source)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_copy(&source->turn, &destination->turn);
|
bgc_fp32_versor_copy(&destination->turn, &source->turn);
|
||||||
bgc_fp32_vector3_copy(&source->shift, &destination->shift);
|
bgc_fp32_vector3_copy(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_copy(const BGC_FP64_Position3 * source, BGC_FP64_Position3 * destination)
|
inline void bgc_fp64_position3_copy(BGC_FP64_Position3* destination, const BGC_FP64_Position3 * source)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_copy(&source->turn, &destination->turn);
|
bgc_fp64_versor_copy(&destination->turn, &source->turn);
|
||||||
bgc_fp64_vector3_copy(&source->shift, &destination->shift);
|
bgc_fp64_vector3_copy(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ==================== Swap ===================== //
|
// ==================== Swap ===================== //
|
||||||
|
|
@ -75,16 +75,16 @@ inline void bgc_fp64_position3_swap(BGC_FP64_Position3 * first, BGC_FP64_Positio
|
||||||
|
|
||||||
// =================== Convert =================== //
|
// =================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_position3_convert_to_fp32(const BGC_FP64_Position3 * source, BGC_FP32_Position3 * destination)
|
inline void bgc_fp32_position3_convert_to_fp64(BGC_FP64_Position3* destination, const BGC_FP32_Position3 * source)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_convert_to_fp32(&source->turn, &destination->turn);
|
bgc_fp32_versor_convert_to_fp64(&destination->turn, &source->turn);
|
||||||
bgc_fp64_vector3_convert_to_fp32(&source->shift, &destination->shift);
|
bgc_fp32_vector3_convert_to_fp64(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_position3_convert_to_fp64(const BGC_FP32_Position3 * source, BGC_FP64_Position3 * destination)
|
inline void bgc_fp64_position3_convert_to_fp32(BGC_FP32_Position3* destination, const BGC_FP64_Position3* source)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_convert_to_fp64(&source->turn, &destination->turn);
|
bgc_fp64_versor_convert_to_fp32(&destination->turn, &source->turn);
|
||||||
bgc_fp32_vector3_convert_to_fp64(&source->shift, &destination->shift);
|
bgc_fp64_vector3_convert_to_fp32(&destination->shift, &source->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Is Idle =================== //
|
// =================== Is Idle =================== //
|
||||||
|
|
@ -103,156 +103,156 @@ inline int bgc_fp64_position3_is_idle(const BGC_FP64_Position3 * position)
|
||||||
|
|
||||||
inline void bgc_fp32_position3_invert(BGC_FP32_Position3 * position)
|
inline void bgc_fp32_position3_invert(BGC_FP32_Position3 * position)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_turn_vector_back(&position->turn, &position->shift, &position->shift);
|
bgc_fp32_versor_turn_vector_back(&position->shift, &position->turn, &position->shift);
|
||||||
bgc_fp32_versor_revert(&position->turn);
|
bgc_fp32_versor_revert(&position->turn);
|
||||||
bgc_fp32_vector3_revert(&position->shift);
|
bgc_fp32_vector3_revert(&position->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_invert(BGC_FP64_Position3 * position)
|
inline void bgc_fp64_position3_invert(BGC_FP64_Position3 * position)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_turn_vector_back(&position->turn, &position->shift, &position->shift);
|
bgc_fp64_versor_turn_vector_back(&position->shift, &position->turn, &position->shift);
|
||||||
bgc_fp64_versor_revert(&position->turn);
|
bgc_fp64_versor_revert(&position->turn);
|
||||||
bgc_fp64_vector3_revert(&position->shift);
|
bgc_fp64_vector3_revert(&position->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================= Get Inverse ================= //
|
// ================= Get Inverse ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_position3_get_inverse(const BGC_FP32_Position3 * position, BGC_FP32_Position3 * inverted)
|
inline void bgc_fp32_position3_get_inverse(BGC_FP32_Position3* inverse, const BGC_FP32_Position3 * position)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_turn_vector_back(&position->turn, &position->shift, &inverted->shift);
|
bgc_fp32_versor_turn_vector_back(&inverse->shift, &position->turn, &position->shift);
|
||||||
bgc_fp32_versor_get_reverse(&position->turn, &inverted->turn);
|
bgc_fp32_versor_get_reverse(&inverse->turn, &position->turn);
|
||||||
bgc_fp32_vector3_revert(&inverted->shift);
|
bgc_fp32_vector3_revert(&inverse->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_get_inverse(const BGC_FP64_Position3 * position, BGC_FP64_Position3 * inverted)
|
inline void bgc_fp64_position3_get_inverse(BGC_FP64_Position3* inverse, const BGC_FP64_Position3 * position)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_turn_vector_back(&position->turn, &position->shift, &inverted->shift);
|
bgc_fp64_versor_turn_vector_back(&inverse->shift, &position->turn, &position->shift);
|
||||||
bgc_fp64_versor_get_reverse(&position->turn, &inverted->turn);
|
bgc_fp64_versor_get_reverse(&inverse->turn, &position->turn);
|
||||||
bgc_fp64_vector3_revert(&inverted->shift);
|
bgc_fp64_vector3_revert(&inverse->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Combine =================== //
|
// =================== Combine =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_position3_combine(const BGC_FP32_Position3 * first, const BGC_FP32_Position3 * second, BGC_FP32_Position3 * combination)
|
inline void bgc_fp32_position3_combine(BGC_FP32_Position3* combination, const BGC_FP32_Position3 * first, const BGC_FP32_Position3 * second)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector3 relative_shift;
|
BGC_FP32_Vector3 relative_shift;
|
||||||
bgc_fp32_versor_turn_vector(&second->turn, &first->shift, &relative_shift);
|
bgc_fp32_versor_turn_vector(&relative_shift, &second->turn, &first->shift);
|
||||||
bgc_fp32_versor_combine(&first->turn, &second->turn, &combination->turn);
|
bgc_fp32_versor_combine(&combination->turn, &first->turn, &second->turn);
|
||||||
bgc_fp32_vector3_add(&relative_shift, &second->shift, &combination->shift);
|
bgc_fp32_vector3_add(&combination->shift, &relative_shift, &second->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_combine(const BGC_FP64_Position3 * first, const BGC_FP64_Position3 * second, BGC_FP64_Position3 * combination)
|
inline void bgc_fp64_position3_combine(BGC_FP64_Position3* combination, const BGC_FP64_Position3 * first, const BGC_FP64_Position3 * second)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector3 relative_shift;
|
BGC_FP64_Vector3 relative_shift;
|
||||||
bgc_fp64_versor_turn_vector(&second->turn, &first->shift, &relative_shift);
|
bgc_fp64_versor_turn_vector(&relative_shift, &second->turn, &first->shift);
|
||||||
bgc_fp64_versor_combine(&first->turn, &second->turn, &combination->turn);
|
bgc_fp64_versor_combine(&combination->turn, &first->turn, &second->turn);
|
||||||
bgc_fp64_vector3_add(&relative_shift, &second->shift, &combination->shift);
|
bgc_fp64_vector3_add(&combination->shift, &relative_shift, &second->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Exclude =================== //
|
// =================== Exclude =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_position3_exclude(const BGC_FP32_Position3 * base, const BGC_FP32_Position3 * excludant, BGC_FP32_Position3 * difference)
|
inline void bgc_fp32_position3_exclude(BGC_FP32_Position3* difference, const BGC_FP32_Position3 * base, const BGC_FP32_Position3 * excludant)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector3 relative_shift;
|
BGC_FP32_Vector3 relative_shift;
|
||||||
bgc_fp32_vector3_subtract(&base->shift, &excludant->shift, &relative_shift);
|
bgc_fp32_vector3_subtract(&relative_shift, &base->shift, &excludant->shift);
|
||||||
bgc_fp32_versor_turn_vector_back(&excludant->turn, &relative_shift, &difference->shift);
|
bgc_fp32_versor_turn_vector_back(&difference->shift, &excludant->turn, &relative_shift);
|
||||||
bgc_fp32_versor_exclude(&base->turn, &excludant->turn, &difference->turn);
|
bgc_fp32_versor_exclude(&difference->turn, &base->turn, &excludant->turn);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_exclude(const BGC_FP64_Position3 * base, const BGC_FP64_Position3 * excludant, BGC_FP64_Position3 * difference)
|
inline void bgc_fp64_position3_exclude(BGC_FP64_Position3* difference, const BGC_FP64_Position3 * base, const BGC_FP64_Position3 * excludant)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector3 relative_shift;
|
BGC_FP64_Vector3 relative_shift;
|
||||||
bgc_fp64_vector3_subtract(&base->shift, &excludant->shift, &relative_shift);
|
bgc_fp64_vector3_subtract(&relative_shift, &base->shift, &excludant->shift);
|
||||||
bgc_fp64_versor_turn_vector_back(&excludant->turn, &relative_shift, &difference->shift);
|
bgc_fp64_versor_turn_vector_back(&difference->shift, &excludant->turn, &relative_shift);
|
||||||
bgc_fp64_versor_exclude(&base->turn, &excludant->turn, &difference->turn);
|
bgc_fp64_versor_exclude(&difference->turn, &base->turn, &excludant->turn);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============= Get Outward Affine ============== //
|
// ============= Get Outward Affine ============== //
|
||||||
|
|
||||||
inline void bgc_fp32_position3_get_outward_affine(const BGC_FP32_Position3 * position, BGC_FP32_Affine3 * outward_affine_map)
|
inline void bgc_fp32_position3_get_outward_affine(BGC_FP32_Affine3* outward_affine_map, const BGC_FP32_Position3 * position)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_get_rotation_matrix(&position->turn, &outward_affine_map->distortion);
|
bgc_fp32_versor_get_rotation_matrix(&outward_affine_map->distortion, &position->turn);
|
||||||
bgc_fp32_vector3_copy(&position->shift, &outward_affine_map->shift);
|
bgc_fp32_vector3_copy(&outward_affine_map->shift, &position->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_get_outward_affine(const BGC_FP64_Position3 * position, BGC_FP64_Affine3 * outward_affine_map)
|
inline void bgc_fp64_position3_get_outward_affine(BGC_FP64_Affine3* outward_affine_map, const BGC_FP64_Position3 * position)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_get_rotation_matrix(&position->turn, &outward_affine_map->distortion);
|
bgc_fp64_versor_get_rotation_matrix(&outward_affine_map->distortion, &position->turn);
|
||||||
bgc_fp64_vector3_copy(&position->shift, &outward_affine_map->shift);
|
bgc_fp64_vector3_copy(&outward_affine_map->shift, &position->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============== Get Inward Affine ============== //
|
// ============== Get Inward Affine ============== //
|
||||||
|
|
||||||
inline void bgc_fp32_position3_get_inward_affine(const BGC_FP32_Position3 * position, BGC_FP32_Affine3 * inward_affine_map)
|
inline void bgc_fp32_position3_get_inward_affine(BGC_FP32_Affine3* inward_affine_map, const BGC_FP32_Position3 * position)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_get_reverse_matrix(&position->turn, &inward_affine_map->distortion);
|
bgc_fp32_versor_get_reverse_matrix(&inward_affine_map->distortion, &position->turn);
|
||||||
bgc_fp32_multiply_matrix3x3_by_vector3(&inward_affine_map->distortion, &position->shift, &inward_affine_map->shift);
|
bgc_fp32_multiply_matrix3x3_by_vector3(&inward_affine_map->shift, &inward_affine_map->distortion, &position->shift);
|
||||||
bgc_fp32_vector3_revert(&inward_affine_map->shift);
|
bgc_fp32_vector3_revert(&inward_affine_map->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_get_inward_affine(const BGC_FP64_Position3 * position, BGC_FP64_Affine3 * inward_affine_map)
|
inline void bgc_fp64_position3_get_inward_affine(BGC_FP64_Affine3* inward_affine_map, const BGC_FP64_Position3 * position)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_get_reverse_matrix(&position->turn, &inward_affine_map->distortion);
|
bgc_fp64_versor_get_reverse_matrix(&inward_affine_map->distortion, &position->turn);
|
||||||
bgc_fp64_multiply_matrix3x3_by_vector3(&inward_affine_map->distortion, &position->shift, &inward_affine_map->shift);
|
bgc_fp64_multiply_matrix3x3_by_vector3(&inward_affine_map->shift, &inward_affine_map->distortion, &position->shift);
|
||||||
bgc_fp64_vector3_revert(&inward_affine_map->shift);
|
bgc_fp64_vector3_revert(&inward_affine_map->shift);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ========== Transform Point Outwards =========== //
|
// ========== Transform Point Outwards =========== //
|
||||||
|
|
||||||
inline void bgc_fp32_position3_transform_point_outwards(const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * inner_point, BGC_FP32_Vector3 * outer_point)
|
inline void bgc_fp32_position3_transform_point_outwards(BGC_FP32_Vector3* outer_point, const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * inner_point)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector3 turned_point;
|
BGC_FP32_Vector3 turned_point;
|
||||||
bgc_fp32_versor_turn_vector(&position->turn, inner_point, &turned_point);
|
bgc_fp32_versor_turn_vector(&turned_point, &position->turn, inner_point);
|
||||||
bgc_fp32_vector3_add(&position->shift, &turned_point, outer_point);
|
bgc_fp32_vector3_add(outer_point, &position->shift, &turned_point);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_transform_point_outwards(const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * inner_point, BGC_FP64_Vector3 * outer_point)
|
inline void bgc_fp64_position3_transform_point_outwards(BGC_FP64_Vector3* outer_point, const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * inner_point)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector3 turned_point;
|
BGC_FP64_Vector3 turned_point;
|
||||||
bgc_fp64_versor_turn_vector(&position->turn, inner_point, &turned_point);
|
bgc_fp64_versor_turn_vector(&turned_point, &position->turn, inner_point);
|
||||||
bgc_fp64_vector3_add(&position->shift, &turned_point, outer_point);
|
bgc_fp64_vector3_add(outer_point, &position->shift, &turned_point);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =========== Transform Point Inwards =========== //
|
// =========== Transform Point Inwards =========== //
|
||||||
|
|
||||||
inline void bgc_fp32_position3_transform_point_inwards(const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * outer_point, BGC_FP32_Vector3 * inner_point)
|
inline void bgc_fp32_position3_transform_point_inwards(BGC_FP32_Vector3* inner_point, const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * outer_point)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector3 relative_point;
|
BGC_FP32_Vector3 relative_point;
|
||||||
bgc_fp32_vector3_subtract(outer_point, &position->shift, &relative_point);
|
bgc_fp32_vector3_subtract(&relative_point, outer_point, &position->shift);
|
||||||
bgc_fp32_versor_turn_vector_back(&position->turn, &relative_point, inner_point);
|
bgc_fp32_versor_turn_vector_back(inner_point, &position->turn, &relative_point);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_transform_point_inwards(const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * outer_point, BGC_FP64_Vector3 * inner_point)
|
inline void bgc_fp64_position3_transform_point_inwards(BGC_FP64_Vector3* inner_point, const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * outer_point)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector3 relative_point;
|
BGC_FP64_Vector3 relative_point;
|
||||||
bgc_fp64_vector3_subtract(outer_point, &position->shift, &relative_point);
|
bgc_fp64_vector3_subtract(&relative_point, outer_point, &position->shift);
|
||||||
bgc_fp64_versor_turn_vector_back(&position->turn, &relative_point, inner_point);
|
bgc_fp64_versor_turn_vector_back(inner_point, &position->turn, &relative_point);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// ========== Transform Vector Outwards ========== //
|
// ========== Transform Vector Outwards ========== //
|
||||||
|
|
||||||
inline void bgc_fp32_position3_transform_vector_outwards(const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * inner_vector, BGC_FP32_Vector3 * outer_vector)
|
inline void bgc_fp32_position3_transform_vector_outwards(BGC_FP32_Vector3* outer_vector, const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * inner_vector)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_turn_vector(&position->turn, inner_vector, outer_vector);
|
bgc_fp32_versor_turn_vector(outer_vector, &position->turn, inner_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_transform_vector_outwards(const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * inner_vector, BGC_FP64_Vector3 * outer_vector)
|
inline void bgc_fp64_position3_transform_vector_outwards(BGC_FP64_Vector3* outer_vector, const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * inner_vector)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_turn_vector(&position->turn, inner_vector, outer_vector);
|
bgc_fp64_versor_turn_vector(outer_vector, &position->turn, inner_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ========== Transform Vector Inwards =========== //
|
// ========== Transform Vector Inwards =========== //
|
||||||
|
|
||||||
inline void bgc_fp32_position3_transform_vector_inwards(const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * outer_vector, BGC_FP32_Vector3 * inner_vector)
|
inline void bgc_fp32_position3_transform_vector_inwards(BGC_FP32_Vector3* inner_vector, const BGC_FP32_Position3 * position, const BGC_FP32_Vector3 * outer_vector)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_turn_vector_back(&position->turn, outer_vector, inner_vector);
|
bgc_fp32_versor_turn_vector_back(inner_vector, &position->turn, outer_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_position3_transform_vector_inwards(const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * outer_vector, BGC_FP64_Vector3 * inner_vector)
|
inline void bgc_fp64_position3_transform_vector_inwards(BGC_FP64_Vector3* inner_vector, const BGC_FP64_Position3 * position, const BGC_FP64_Vector3 * outer_vector)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_turn_vector_back(&position->turn, outer_vector, inner_vector);
|
bgc_fp64_versor_turn_vector_back(inner_vector, &position->turn, outer_vector);
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif // _BGC_POSITION_H_INCLUDED_
|
#endif // _BGC_POSITION_H_INCLUDED_
|
||||||
|
|
|
||||||
|
|
@ -7,8 +7,8 @@ extern inline void bgc_fp64_quaternion_reset(BGC_FP64_Quaternion* quaternion);
|
||||||
extern inline void bgc_fp32_quaternion_make_unit(BGC_FP32_Quaternion* quaternion);
|
extern inline void bgc_fp32_quaternion_make_unit(BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline void bgc_fp64_quaternion_make_unit(BGC_FP64_Quaternion* quaternion);
|
extern inline void bgc_fp64_quaternion_make_unit(BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_make(const float s0, const float x1, const float x2, const float x3, BGC_FP32_Quaternion* quaternion);
|
extern inline void bgc_fp32_quaternion_make(BGC_FP32_Quaternion* quaternion, const float s0, const float x1, const float x2, const float x3);
|
||||||
extern inline void bgc_fp64_quaternion_make(const double s0, const double x1, const double x2, const double x3, BGC_FP64_Quaternion* quaternion);
|
extern inline void bgc_fp64_quaternion_make(BGC_FP64_Quaternion* quaternion, const double s0, const double x1, const double x2, const double x3);
|
||||||
|
|
||||||
extern inline float bgc_fp32_quaternion_get_square_modulus(const BGC_FP32_Quaternion* quaternion);
|
extern inline float bgc_fp32_quaternion_get_square_modulus(const BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline double bgc_fp64_quaternion_get_square_modulus(const BGC_FP64_Quaternion* quaternion);
|
extern inline double bgc_fp64_quaternion_get_square_modulus(const BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
@ -22,84 +22,84 @@ extern inline int bgc_fp64_quaternion_is_zero(const BGC_FP64_Quaternion* quatern
|
||||||
extern inline int bgc_fp32_quaternion_is_unit(const BGC_FP32_Quaternion* quaternion);
|
extern inline int bgc_fp32_quaternion_is_unit(const BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline int bgc_fp64_quaternion_is_unit(const BGC_FP64_Quaternion* quaternion);
|
extern inline int bgc_fp64_quaternion_is_unit(const BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_copy(const BGC_FP32_Quaternion* source, BGC_FP32_Quaternion* destination);
|
extern inline void bgc_fp32_quaternion_copy(BGC_FP32_Quaternion* destination, const BGC_FP32_Quaternion* source);
|
||||||
extern inline void bgc_fp64_quaternion_copy(const BGC_FP64_Quaternion* source, BGC_FP64_Quaternion* destination);
|
extern inline void bgc_fp64_quaternion_copy(BGC_FP64_Quaternion* destination, const BGC_FP64_Quaternion* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_swap(BGC_FP32_Quaternion* quarternion1, BGC_FP32_Quaternion* quarternion2);
|
extern inline void bgc_fp32_quaternion_swap(BGC_FP32_Quaternion* quarternion1, BGC_FP32_Quaternion* quarternion2);
|
||||||
extern inline void bgc_fp64_quaternion_swap(BGC_FP64_Quaternion* quarternion1, BGC_FP64_Quaternion* quarternion2);
|
extern inline void bgc_fp64_quaternion_swap(BGC_FP64_Quaternion* quarternion1, BGC_FP64_Quaternion* quarternion2);
|
||||||
|
|
||||||
extern inline void bgc_fp64_quaternion_convert_to_fp32(const BGC_FP64_Quaternion* source, BGC_FP32_Quaternion* destination);
|
extern inline void bgc_fp32_quaternion_convert_to_fp64(BGC_FP64_Quaternion* destination, const BGC_FP32_Quaternion* source);
|
||||||
extern inline void bgc_fp32_quaternion_convert_to_fp64(const BGC_FP32_Quaternion* source, BGC_FP64_Quaternion* destination);
|
extern inline void bgc_fp64_quaternion_convert_to_fp32(BGC_FP32_Quaternion* destination, const BGC_FP64_Quaternion* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_add(const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2, BGC_FP32_Quaternion* sum);
|
extern inline void bgc_fp32_quaternion_add(BGC_FP32_Quaternion* sum, const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2);
|
||||||
extern inline void bgc_fp64_quaternion_add(const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2, BGC_FP64_Quaternion* sum);
|
extern inline void bgc_fp64_quaternion_add(BGC_FP64_Quaternion* sum, const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_add_scaled(const BGC_FP32_Quaternion* basic_quaternion, const BGC_FP32_Quaternion* scalable_quaternion, const float scale, BGC_FP32_Quaternion* sum);
|
extern inline void bgc_fp32_quaternion_add_scaled(BGC_FP32_Quaternion* sum, const BGC_FP32_Quaternion* basic_quaternion, const BGC_FP32_Quaternion* scalable_quaternion, const float scale);
|
||||||
extern inline void bgc_fp64_quaternion_add_scaled(const BGC_FP64_Quaternion* basic_quaternion, const BGC_FP64_Quaternion* scalable_quaternion, const double scale, BGC_FP64_Quaternion* sum);
|
extern inline void bgc_fp64_quaternion_add_scaled(BGC_FP64_Quaternion* sum, const BGC_FP64_Quaternion* basic_quaternion, const BGC_FP64_Quaternion* scalable_quaternion, const double scale);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_subtract(const BGC_FP32_Quaternion* minuend, const BGC_FP32_Quaternion* subtrahend, BGC_FP32_Quaternion* difference);
|
extern inline void bgc_fp32_quaternion_subtract(BGC_FP32_Quaternion* difference, const BGC_FP32_Quaternion* minuend, const BGC_FP32_Quaternion* subtrahend);
|
||||||
extern inline void bgc_fp64_quaternion_subtract(const BGC_FP64_Quaternion* minuend, const BGC_FP64_Quaternion* subtrahend, BGC_FP64_Quaternion* difference);
|
extern inline void bgc_fp64_quaternion_subtract(BGC_FP64_Quaternion* difference, const BGC_FP64_Quaternion* minuend, const BGC_FP64_Quaternion* subtrahend);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_get_product(const BGC_FP32_Quaternion* left, const BGC_FP32_Quaternion* right, BGC_FP32_Quaternion* product);
|
extern inline void bgc_fp32_quaternion_get_product(BGC_FP32_Quaternion* product, const BGC_FP32_Quaternion* left, const BGC_FP32_Quaternion* right);
|
||||||
extern inline void bgc_fp64_quaternion_get_product(const BGC_FP64_Quaternion* left, const BGC_FP64_Quaternion* right, BGC_FP64_Quaternion* product);
|
extern inline void bgc_fp64_quaternion_get_product(BGC_FP64_Quaternion* product, const BGC_FP64_Quaternion* left, const BGC_FP64_Quaternion* right);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_multiply(const BGC_FP32_Quaternion* multiplicand, const float multipier, BGC_FP32_Quaternion* product);
|
extern inline void bgc_fp32_quaternion_multiply(BGC_FP32_Quaternion* product, const BGC_FP32_Quaternion* multiplicand, const float multipier);
|
||||||
extern inline void bgc_fp64_quaternion_multiply(const BGC_FP64_Quaternion* multiplicand, const double multipier, BGC_FP64_Quaternion* product);
|
extern inline void bgc_fp64_quaternion_multiply(BGC_FP64_Quaternion* product, const BGC_FP64_Quaternion* multiplicand, const double multipier);
|
||||||
|
|
||||||
extern inline int bgc_fp32_quaternion_get_ratio(const BGC_FP32_Quaternion* divident, const BGC_FP32_Quaternion* divisor, BGC_FP32_Quaternion* quotient);
|
extern inline int bgc_fp32_quaternion_get_ratio(BGC_FP32_Quaternion* quotient, const BGC_FP32_Quaternion* divident, const BGC_FP32_Quaternion* divisor);
|
||||||
extern inline int bgc_fp64_quaternion_get_ratio(const BGC_FP64_Quaternion* divident, const BGC_FP64_Quaternion* divisor, BGC_FP64_Quaternion* quotient);
|
extern inline int bgc_fp64_quaternion_get_ratio(BGC_FP64_Quaternion* quotient, const BGC_FP64_Quaternion* divident, const BGC_FP64_Quaternion* divisor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_divide(const BGC_FP32_Quaternion* dividend, const float divisor, BGC_FP32_Quaternion* quotient);
|
extern inline void bgc_fp32_quaternion_divide(BGC_FP32_Quaternion* quotient, const BGC_FP32_Quaternion* dividend, const float divisor);
|
||||||
extern inline void bgc_fp64_quaternion_divide(const BGC_FP64_Quaternion* dividend, const double divisor, BGC_FP64_Quaternion* quotient);
|
extern inline void bgc_fp64_quaternion_divide(BGC_FP64_Quaternion* quotient, const BGC_FP64_Quaternion* dividend, const double divisor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_get_mean2(const BGC_FP32_Quaternion* vector1, const BGC_FP32_Quaternion* vector2, BGC_FP32_Quaternion* mean);
|
extern inline void bgc_fp32_quaternion_get_mean2(BGC_FP32_Quaternion* mean, const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2);
|
||||||
extern inline void bgc_fp64_quaternion_get_mean2(const BGC_FP64_Quaternion* vector1, const BGC_FP64_Quaternion* vector2, BGC_FP64_Quaternion* mean);
|
extern inline void bgc_fp64_quaternion_get_mean2(BGC_FP64_Quaternion* mean, const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_get_mean3(const BGC_FP32_Quaternion* vector1, const BGC_FP32_Quaternion* vector2, const BGC_FP32_Quaternion* vector3, BGC_FP32_Quaternion* mean);
|
extern inline void bgc_fp32_quaternion_get_mean3(BGC_FP32_Quaternion* mean, const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2, const BGC_FP32_Quaternion* quaternion3);
|
||||||
extern inline void bgc_fp64_quaternion_get_mean3(const BGC_FP64_Quaternion* vector1, const BGC_FP64_Quaternion* vector2, const BGC_FP64_Quaternion* vector3, BGC_FP64_Quaternion* mean);
|
extern inline void bgc_fp64_quaternion_get_mean3(BGC_FP64_Quaternion* mean, const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2, const BGC_FP64_Quaternion* quaternion3);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_interpolate(const BGC_FP32_Quaternion* vector1, const BGC_FP32_Quaternion* vector2, const float phase, BGC_FP32_Quaternion* interpolation);
|
extern inline void bgc_fp32_quaternion_interpolate(BGC_FP32_Quaternion* interpolation, const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2, const float phase);
|
||||||
extern inline void bgc_fp64_quaternion_interpolate(const BGC_FP64_Quaternion* vector1, const BGC_FP64_Quaternion* vector2, const double phase, BGC_FP64_Quaternion* interpolation);
|
extern inline void bgc_fp64_quaternion_interpolate(BGC_FP64_Quaternion* interpolation, const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2, const double phase);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_conjugate(BGC_FP32_Quaternion* quaternion);
|
extern inline void bgc_fp32_quaternion_conjugate(BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline void bgc_fp64_quaternion_conjugate(BGC_FP64_Quaternion* quaternion);
|
extern inline void bgc_fp64_quaternion_conjugate(BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_get_conjugate(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Quaternion* conjugate);
|
extern inline void bgc_fp32_quaternion_get_conjugate(BGC_FP32_Quaternion* conjugate, const BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline void bgc_fp64_quaternion_get_conjugate(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Quaternion* conjugate);
|
extern inline void bgc_fp64_quaternion_get_conjugate(BGC_FP64_Quaternion* conjugate, const BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_revert(BGC_FP32_Quaternion* quaternion);
|
extern inline void bgc_fp32_quaternion_revert(BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline void bgc_fp64_quaternion_revert(BGC_FP64_Quaternion* quaternion);
|
extern inline void bgc_fp64_quaternion_revert(BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline void bgc_fp32_quaternion_get_reverse(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Quaternion* opposite);
|
extern inline void bgc_fp32_quaternion_get_reverse(BGC_FP32_Quaternion* reverse, const BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline void bgc_fp64_quaternion_get_reverse(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Quaternion* opposite);
|
extern inline void bgc_fp64_quaternion_get_reverse(BGC_FP64_Quaternion* reverse, const BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline int bgc_fp32_quaternion_invert(BGC_FP32_Quaternion* quaternion);
|
extern inline int bgc_fp32_quaternion_invert(BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline int bgc_fp64_quaternion_invert(BGC_FP64_Quaternion* quaternion);
|
extern inline int bgc_fp64_quaternion_invert(BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline int bgc_fp32_quaternion_get_inverse(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Quaternion* inverse);
|
extern inline int bgc_fp32_quaternion_get_inverse(BGC_FP32_Quaternion* inverse, const BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline int bgc_fp64_quaternion_get_inverse(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Quaternion* inverse);
|
extern inline int bgc_fp64_quaternion_get_inverse(BGC_FP64_Quaternion* inverse, const BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline int bgc_fp32_quaternion_normalize(BGC_FP32_Quaternion* quaternion);
|
extern inline int bgc_fp32_quaternion_normalize(BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline int bgc_fp64_quaternion_normalize(BGC_FP64_Quaternion* quaternion);
|
extern inline int bgc_fp64_quaternion_normalize(BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline int bgc_fp32_quaternion_get_normalized(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Quaternion* normalized);
|
extern inline int bgc_fp32_quaternion_get_normalized(BGC_FP32_Quaternion* normalized, const BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline int bgc_fp64_quaternion_get_normalized(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Quaternion* normalized);
|
extern inline int bgc_fp64_quaternion_get_normalized(BGC_FP64_Quaternion* normalized, const BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline int bgc_fp32_quaternion_get_rotation_matrix(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Matrix3x3* rotation);
|
extern inline int bgc_fp32_quaternion_get_rotation_matrix(BGC_FP32_Matrix3x3* rotation, const BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline int bgc_fp64_quaternion_get_rotation_matrix(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Matrix3x3* rotation);
|
extern inline int bgc_fp64_quaternion_get_rotation_matrix(BGC_FP64_Matrix3x3* rotation, const BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline int bgc_fp32_quaternion_get_reverse_matrix(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Matrix3x3* reverse);
|
extern inline int bgc_fp32_quaternion_get_reverse_matrix(BGC_FP32_Matrix3x3* reverse, const BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline int bgc_fp64_quaternion_get_reverse_matrix(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Matrix3x3* reverse);
|
extern inline int bgc_fp64_quaternion_get_reverse_matrix(BGC_FP64_Matrix3x3* reverse, const BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline int bgc_fp32_quaternion_get_both_matrices(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Matrix3x3* rotation, BGC_FP32_Matrix3x3* reverse);
|
extern inline int bgc_fp32_quaternion_get_both_matrices(BGC_FP32_Matrix3x3* rotation, BGC_FP32_Matrix3x3* reverse, const BGC_FP32_Quaternion* quaternion);
|
||||||
extern inline int bgc_fp64_quaternion_get_both_matrices(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Matrix3x3* rotation, BGC_FP64_Matrix3x3* reverse);
|
extern inline int bgc_fp64_quaternion_get_both_matrices(BGC_FP64_Matrix3x3* rotation, BGC_FP64_Matrix3x3* reverse, const BGC_FP64_Quaternion* quaternion);
|
||||||
|
|
||||||
extern inline int bgc_fp32_quaternion_are_close(const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2);
|
extern inline int bgc_fp32_quaternion_are_close(const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2);
|
||||||
extern inline int bgc_fp64_quaternion_are_close(const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2);
|
extern inline int bgc_fp64_quaternion_are_close(const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2);
|
||||||
|
|
||||||
// =============== Get Exponation =============== //
|
// =============== Get Exponation =============== //
|
||||||
|
|
||||||
int bgc_fp32_quaternion_get_exponation(const BGC_FP32_Quaternion* base, const float exponent, BGC_FP32_Quaternion* power)
|
int bgc_fp32_quaternion_get_exponation(BGC_FP32_Quaternion* power, const BGC_FP32_Quaternion* base, const float exponent)
|
||||||
{
|
{
|
||||||
const float s0s0 = base->s0 * base->s0;
|
const float s0s0 = base->s0 * base->s0;
|
||||||
const float x1x1 = base->x1 * base->x1;
|
const float x1x1 = base->x1 * base->x1;
|
||||||
|
|
@ -140,7 +140,7 @@ int bgc_fp32_quaternion_get_exponation(const BGC_FP32_Quaternion* base, const fl
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
int bgc_fp64_quaternion_get_exponation(const BGC_FP64_Quaternion* base, const double exponent, BGC_FP64_Quaternion* power)
|
int bgc_fp64_quaternion_get_exponation(BGC_FP64_Quaternion* power, const BGC_FP64_Quaternion* base, const double exponent)
|
||||||
{
|
{
|
||||||
const double s0s0 = base->s0 * base->s0;
|
const double s0s0 = base->s0 * base->s0;
|
||||||
const double x1x1 = base->x1 * base->x1;
|
const double x1x1 = base->x1 * base->x1;
|
||||||
|
|
|
||||||
|
|
@ -17,7 +17,7 @@ typedef struct {
|
||||||
|
|
||||||
// ==================== Reset =================== //
|
// ==================== Reset =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_reset(BGC_FP32_Quaternion * quaternion)
|
inline void bgc_fp32_quaternion_reset(BGC_FP32_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
quaternion->s0 = 0.0f;
|
quaternion->s0 = 0.0f;
|
||||||
quaternion->x1 = 0.0f;
|
quaternion->x1 = 0.0f;
|
||||||
|
|
@ -25,7 +25,7 @@ inline void bgc_fp32_quaternion_reset(BGC_FP32_Quaternion * quaternion)
|
||||||
quaternion->x3 = 0.0f;
|
quaternion->x3 = 0.0f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_reset(BGC_FP64_Quaternion * quaternion)
|
inline void bgc_fp64_quaternion_reset(BGC_FP64_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
quaternion->s0 = 0.0;
|
quaternion->s0 = 0.0;
|
||||||
quaternion->x1 = 0.0;
|
quaternion->x1 = 0.0;
|
||||||
|
|
@ -35,7 +35,7 @@ inline void bgc_fp64_quaternion_reset(BGC_FP64_Quaternion * quaternion)
|
||||||
|
|
||||||
// ================= Make Unit ================== //
|
// ================= Make Unit ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_make_unit(BGC_FP32_Quaternion * quaternion)
|
inline void bgc_fp32_quaternion_make_unit(BGC_FP32_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
quaternion->s0 = 1.0f;
|
quaternion->s0 = 1.0f;
|
||||||
quaternion->x1 = 0.0f;
|
quaternion->x1 = 0.0f;
|
||||||
|
|
@ -43,7 +43,7 @@ inline void bgc_fp32_quaternion_make_unit(BGC_FP32_Quaternion * quaternion)
|
||||||
quaternion->x3 = 0.0f;
|
quaternion->x3 = 0.0f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_make_unit(BGC_FP64_Quaternion * quaternion)
|
inline void bgc_fp64_quaternion_make_unit(BGC_FP64_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
quaternion->s0 = 1.0;
|
quaternion->s0 = 1.0;
|
||||||
quaternion->x1 = 0.0;
|
quaternion->x1 = 0.0;
|
||||||
|
|
@ -53,7 +53,7 @@ inline void bgc_fp64_quaternion_make_unit(BGC_FP64_Quaternion * quaternion)
|
||||||
|
|
||||||
// ==================== Set ===================== //
|
// ==================== Set ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_make(const float s0, const float x1, const float x2, const float x3, BGC_FP32_Quaternion * quaternion)
|
inline void bgc_fp32_quaternion_make(BGC_FP32_Quaternion* quaternion, const float s0, const float x1, const float x2, const float x3)
|
||||||
{
|
{
|
||||||
quaternion->s0 = s0;
|
quaternion->s0 = s0;
|
||||||
quaternion->x1 = x1;
|
quaternion->x1 = x1;
|
||||||
|
|
@ -61,7 +61,7 @@ inline void bgc_fp32_quaternion_make(const float s0, const float x1, const float
|
||||||
quaternion->x3 = x3;
|
quaternion->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_make(const double s0, const double x1, const double x2, const double x3, BGC_FP64_Quaternion * quaternion)
|
inline void bgc_fp64_quaternion_make(BGC_FP64_Quaternion* quaternion, const double s0, const double x1, const double x2, const double x3)
|
||||||
{
|
{
|
||||||
quaternion->s0 = s0;
|
quaternion->s0 = s0;
|
||||||
quaternion->x1 = x1;
|
quaternion->x1 = x1;
|
||||||
|
|
@ -119,7 +119,7 @@ inline int bgc_fp64_quaternion_is_unit(const BGC_FP64_Quaternion* quaternion)
|
||||||
|
|
||||||
// ==================== Copy ==================== //
|
// ==================== Copy ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_copy(const BGC_FP32_Quaternion* source, BGC_FP32_Quaternion* destination)
|
inline void bgc_fp32_quaternion_copy(BGC_FP32_Quaternion* destination, const BGC_FP32_Quaternion* source)
|
||||||
{
|
{
|
||||||
destination->s0 = source->s0;
|
destination->s0 = source->s0;
|
||||||
destination->x1 = source->x1;
|
destination->x1 = source->x1;
|
||||||
|
|
@ -127,7 +127,7 @@ inline void bgc_fp32_quaternion_copy(const BGC_FP32_Quaternion* source, BGC_FP32
|
||||||
destination->x3 = source->x3;
|
destination->x3 = source->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_copy(const BGC_FP64_Quaternion* source, BGC_FP64_Quaternion* destination)
|
inline void bgc_fp64_quaternion_copy(BGC_FP64_Quaternion* destination, const BGC_FP64_Quaternion* source)
|
||||||
{
|
{
|
||||||
destination->s0 = source->s0;
|
destination->s0 = source->s0;
|
||||||
destination->x1 = source->x1;
|
destination->x1 = source->x1;
|
||||||
|
|
@ -175,15 +175,7 @@ inline void bgc_fp64_quaternion_swap(BGC_FP64_Quaternion* quarternion1, BGC_FP64
|
||||||
|
|
||||||
// ================== Convert =================== //
|
// ================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_convert_to_fp32(const BGC_FP64_Quaternion* source, BGC_FP32_Quaternion* destination)
|
inline void bgc_fp32_quaternion_convert_to_fp64(BGC_FP64_Quaternion* destination, const BGC_FP32_Quaternion* source)
|
||||||
{
|
|
||||||
destination->s0 = (float)source->s0;
|
|
||||||
destination->x1 = (float)source->x1;
|
|
||||||
destination->x2 = (float)source->x2;
|
|
||||||
destination->x3 = (float)source->x3;
|
|
||||||
}
|
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_convert_to_fp64(const BGC_FP32_Quaternion* source, BGC_FP64_Quaternion* destination)
|
|
||||||
{
|
{
|
||||||
destination->s0 = source->s0;
|
destination->s0 = source->s0;
|
||||||
destination->x1 = source->x1;
|
destination->x1 = source->x1;
|
||||||
|
|
@ -191,9 +183,17 @@ inline void bgc_fp32_quaternion_convert_to_fp64(const BGC_FP32_Quaternion* sourc
|
||||||
destination->x3 = source->x3;
|
destination->x3 = source->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
inline void bgc_fp64_quaternion_convert_to_fp32(BGC_FP32_Quaternion* destination, const BGC_FP64_Quaternion* source)
|
||||||
|
{
|
||||||
|
destination->s0 = (float)source->s0;
|
||||||
|
destination->x1 = (float)source->x1;
|
||||||
|
destination->x2 = (float)source->x2;
|
||||||
|
destination->x3 = (float)source->x3;
|
||||||
|
}
|
||||||
|
|
||||||
// ==================== Add ===================== //
|
// ==================== Add ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_add(const BGC_FP32_Quaternion * quaternion1, const BGC_FP32_Quaternion * quaternion2, BGC_FP32_Quaternion * sum)
|
inline void bgc_fp32_quaternion_add(BGC_FP32_Quaternion* sum, const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2)
|
||||||
{
|
{
|
||||||
sum->s0 = quaternion1->s0 + quaternion2->s0;
|
sum->s0 = quaternion1->s0 + quaternion2->s0;
|
||||||
sum->x1 = quaternion1->x1 + quaternion2->x1;
|
sum->x1 = quaternion1->x1 + quaternion2->x1;
|
||||||
|
|
@ -201,7 +201,7 @@ inline void bgc_fp32_quaternion_add(const BGC_FP32_Quaternion * quaternion1, con
|
||||||
sum->x3 = quaternion1->x3 + quaternion2->x3;
|
sum->x3 = quaternion1->x3 + quaternion2->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_add(const BGC_FP64_Quaternion * quaternion1, const BGC_FP64_Quaternion * quaternion2, BGC_FP64_Quaternion * sum)
|
inline void bgc_fp64_quaternion_add(BGC_FP64_Quaternion* sum, const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2)
|
||||||
{
|
{
|
||||||
sum->s0 = quaternion1->s0 + quaternion2->s0;
|
sum->s0 = quaternion1->s0 + quaternion2->s0;
|
||||||
sum->x1 = quaternion1->x1 + quaternion2->x1;
|
sum->x1 = quaternion1->x1 + quaternion2->x1;
|
||||||
|
|
@ -211,7 +211,7 @@ inline void bgc_fp64_quaternion_add(const BGC_FP64_Quaternion * quaternion1, con
|
||||||
|
|
||||||
// ================= Add Scaled ================= //
|
// ================= Add Scaled ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_add_scaled(const BGC_FP32_Quaternion * basic_quaternion, const BGC_FP32_Quaternion * scalable_quaternion, const float scale, BGC_FP32_Quaternion * sum)
|
inline void bgc_fp32_quaternion_add_scaled(BGC_FP32_Quaternion* sum, const BGC_FP32_Quaternion* basic_quaternion, const BGC_FP32_Quaternion* scalable_quaternion, const float scale)
|
||||||
{
|
{
|
||||||
sum->s0 = basic_quaternion->s0 + scalable_quaternion->s0 * scale;
|
sum->s0 = basic_quaternion->s0 + scalable_quaternion->s0 * scale;
|
||||||
sum->x1 = basic_quaternion->x1 + scalable_quaternion->x1 * scale;
|
sum->x1 = basic_quaternion->x1 + scalable_quaternion->x1 * scale;
|
||||||
|
|
@ -219,7 +219,7 @@ inline void bgc_fp32_quaternion_add_scaled(const BGC_FP32_Quaternion * basic_qua
|
||||||
sum->x3 = basic_quaternion->x3 + scalable_quaternion->x3 * scale;
|
sum->x3 = basic_quaternion->x3 + scalable_quaternion->x3 * scale;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_add_scaled(const BGC_FP64_Quaternion * basic_quaternion, const BGC_FP64_Quaternion * scalable_quaternion, const double scale, BGC_FP64_Quaternion * sum)
|
inline void bgc_fp64_quaternion_add_scaled(BGC_FP64_Quaternion* sum, const BGC_FP64_Quaternion* basic_quaternion, const BGC_FP64_Quaternion* scalable_quaternion, const double scale)
|
||||||
{
|
{
|
||||||
sum->s0 = basic_quaternion->s0 + scalable_quaternion->s0 * scale;
|
sum->s0 = basic_quaternion->s0 + scalable_quaternion->s0 * scale;
|
||||||
sum->x1 = basic_quaternion->x1 + scalable_quaternion->x1 * scale;
|
sum->x1 = basic_quaternion->x1 + scalable_quaternion->x1 * scale;
|
||||||
|
|
@ -229,7 +229,7 @@ inline void bgc_fp64_quaternion_add_scaled(const BGC_FP64_Quaternion * basic_qua
|
||||||
|
|
||||||
// ================== Subtract ================== //
|
// ================== Subtract ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_subtract(const BGC_FP32_Quaternion * minuend, const BGC_FP32_Quaternion * subtrahend, BGC_FP32_Quaternion * difference)
|
inline void bgc_fp32_quaternion_subtract(BGC_FP32_Quaternion* difference, const BGC_FP32_Quaternion* minuend, const BGC_FP32_Quaternion* subtrahend)
|
||||||
{
|
{
|
||||||
difference->s0 = minuend->s0 - subtrahend->s0;
|
difference->s0 = minuend->s0 - subtrahend->s0;
|
||||||
difference->x1 = minuend->x1 - subtrahend->x1;
|
difference->x1 = minuend->x1 - subtrahend->x1;
|
||||||
|
|
@ -237,7 +237,7 @@ inline void bgc_fp32_quaternion_subtract(const BGC_FP32_Quaternion * minuend, co
|
||||||
difference->x3 = minuend->x3 - subtrahend->x3;
|
difference->x3 = minuend->x3 - subtrahend->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_subtract(const BGC_FP64_Quaternion * minuend, const BGC_FP64_Quaternion * subtrahend, BGC_FP64_Quaternion * difference)
|
inline void bgc_fp64_quaternion_subtract(BGC_FP64_Quaternion* difference, const BGC_FP64_Quaternion* minuend, const BGC_FP64_Quaternion* subtrahend)
|
||||||
{
|
{
|
||||||
difference->s0 = minuend->s0 - subtrahend->s0;
|
difference->s0 = minuend->s0 - subtrahend->s0;
|
||||||
difference->x1 = minuend->x1 - subtrahend->x1;
|
difference->x1 = minuend->x1 - subtrahend->x1;
|
||||||
|
|
@ -247,7 +247,7 @@ inline void bgc_fp64_quaternion_subtract(const BGC_FP64_Quaternion * minuend, co
|
||||||
|
|
||||||
// ================== Multiply ================== //
|
// ================== Multiply ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_get_product(const BGC_FP32_Quaternion* left, const BGC_FP32_Quaternion* right, BGC_FP32_Quaternion* product)
|
inline void bgc_fp32_quaternion_get_product(BGC_FP32_Quaternion* product, const BGC_FP32_Quaternion* left, const BGC_FP32_Quaternion* right)
|
||||||
{
|
{
|
||||||
const float s0 = (left->s0 * right->s0 - left->x1 * right->x1) - (left->x2 * right->x2 + left->x3 * right->x3);
|
const float s0 = (left->s0 * right->s0 - left->x1 * right->x1) - (left->x2 * right->x2 + left->x3 * right->x3);
|
||||||
const float x1 = (left->x1 * right->s0 + left->s0 * right->x1) - (left->x3 * right->x2 - left->x2 * right->x3);
|
const float x1 = (left->x1 * right->s0 + left->s0 * right->x1) - (left->x3 * right->x2 - left->x2 * right->x3);
|
||||||
|
|
@ -260,7 +260,7 @@ inline void bgc_fp32_quaternion_get_product(const BGC_FP32_Quaternion* left, con
|
||||||
product->x3 = x3;
|
product->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_get_product(const BGC_FP64_Quaternion* left, const BGC_FP64_Quaternion* right, BGC_FP64_Quaternion* product)
|
inline void bgc_fp64_quaternion_get_product(BGC_FP64_Quaternion* product, const BGC_FP64_Quaternion* left, const BGC_FP64_Quaternion* right)
|
||||||
{
|
{
|
||||||
const double s0 = (left->s0 * right->s0 - left->x1 * right->x1) - (left->x2 * right->x2 + left->x3 * right->x3);
|
const double s0 = (left->s0 * right->s0 - left->x1 * right->x1) - (left->x2 * right->x2 + left->x3 * right->x3);
|
||||||
const double x1 = (left->x1 * right->s0 + left->s0 * right->x1) - (left->x3 * right->x2 - left->x2 * right->x3);
|
const double x1 = (left->x1 * right->s0 + left->s0 * right->x1) - (left->x3 * right->x2 - left->x2 * right->x3);
|
||||||
|
|
@ -273,7 +273,7 @@ inline void bgc_fp64_quaternion_get_product(const BGC_FP64_Quaternion* left, con
|
||||||
product->x3 = x3;
|
product->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_multiply(const BGC_FP32_Quaternion* multiplicand, const float multipier, BGC_FP32_Quaternion* product)
|
inline void bgc_fp32_quaternion_multiply(BGC_FP32_Quaternion* product, const BGC_FP32_Quaternion* multiplicand, const float multipier)
|
||||||
{
|
{
|
||||||
product->s0 = multiplicand->s0 * multipier;
|
product->s0 = multiplicand->s0 * multipier;
|
||||||
product->x1 = multiplicand->x1 * multipier;
|
product->x1 = multiplicand->x1 * multipier;
|
||||||
|
|
@ -281,7 +281,7 @@ inline void bgc_fp32_quaternion_multiply(const BGC_FP32_Quaternion* multiplicand
|
||||||
product->x3 = multiplicand->x3 * multipier;
|
product->x3 = multiplicand->x3 * multipier;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_multiply(const BGC_FP64_Quaternion* multiplicand, const double multipier, BGC_FP64_Quaternion* product)
|
inline void bgc_fp64_quaternion_multiply(BGC_FP64_Quaternion* product, const BGC_FP64_Quaternion* multiplicand, const double multipier)
|
||||||
{
|
{
|
||||||
product->s0 = multiplicand->s0 * multipier;
|
product->s0 = multiplicand->s0 * multipier;
|
||||||
product->x1 = multiplicand->x1 * multipier;
|
product->x1 = multiplicand->x1 * multipier;
|
||||||
|
|
@ -291,7 +291,7 @@ inline void bgc_fp64_quaternion_multiply(const BGC_FP64_Quaternion* multiplicand
|
||||||
|
|
||||||
// =================== Divide =================== //
|
// =================== Divide =================== //
|
||||||
|
|
||||||
inline int bgc_fp32_quaternion_get_ratio(const BGC_FP32_Quaternion* divident, const BGC_FP32_Quaternion* divisor, BGC_FP32_Quaternion* quotient)
|
inline int bgc_fp32_quaternion_get_ratio(BGC_FP32_Quaternion* quotient, const BGC_FP32_Quaternion* divident, const BGC_FP32_Quaternion* divisor)
|
||||||
{
|
{
|
||||||
const float square_modulus = bgc_fp32_quaternion_get_square_modulus(divisor);
|
const float square_modulus = bgc_fp32_quaternion_get_square_modulus(divisor);
|
||||||
|
|
||||||
|
|
@ -314,7 +314,7 @@ inline int bgc_fp32_quaternion_get_ratio(const BGC_FP32_Quaternion* divident, co
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_quaternion_get_ratio(const BGC_FP64_Quaternion* divident, const BGC_FP64_Quaternion* divisor, BGC_FP64_Quaternion* quotient)
|
inline int bgc_fp64_quaternion_get_ratio(BGC_FP64_Quaternion* quotient, const BGC_FP64_Quaternion* divident, const BGC_FP64_Quaternion* divisor)
|
||||||
{
|
{
|
||||||
const double square_modulus = bgc_fp64_quaternion_get_square_modulus(divisor);
|
const double square_modulus = bgc_fp64_quaternion_get_square_modulus(divisor);
|
||||||
|
|
||||||
|
|
@ -337,55 +337,55 @@ inline int bgc_fp64_quaternion_get_ratio(const BGC_FP64_Quaternion* divident, co
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_divide(const BGC_FP32_Quaternion* dividend, const float divisor, BGC_FP32_Quaternion* quotient)
|
inline void bgc_fp32_quaternion_divide(BGC_FP32_Quaternion* quotient, const BGC_FP32_Quaternion* dividend, const float divisor)
|
||||||
{
|
{
|
||||||
bgc_fp32_quaternion_multiply(dividend, 1.0f / divisor, quotient);
|
bgc_fp32_quaternion_multiply(quotient, dividend, 1.0f / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_divide(const BGC_FP64_Quaternion* dividend, const double divisor, BGC_FP64_Quaternion* quotient)
|
inline void bgc_fp64_quaternion_divide(BGC_FP64_Quaternion* quotient, const BGC_FP64_Quaternion* dividend, const double divisor)
|
||||||
{
|
{
|
||||||
bgc_fp64_quaternion_multiply(dividend, 1.0 / divisor, quotient);
|
bgc_fp64_quaternion_multiply(quotient, dividend, 1.0 / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================ Mean of Two ================= //
|
// ================ Mean of Two ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_get_mean2(const BGC_FP32_Quaternion* vector1, const BGC_FP32_Quaternion* vector2, BGC_FP32_Quaternion* mean)
|
inline void bgc_fp32_quaternion_get_mean2(BGC_FP32_Quaternion* mean, const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2)
|
||||||
{
|
{
|
||||||
mean->s0 = (vector1->s0 + vector2->s0) * 0.5f;
|
mean->s0 = (quaternion1->s0 + quaternion2->s0) * 0.5f;
|
||||||
mean->x1 = (vector1->x1 + vector2->x1) * 0.5f;
|
mean->x1 = (quaternion1->x1 + quaternion2->x1) * 0.5f;
|
||||||
mean->x2 = (vector1->x2 + vector2->x2) * 0.5f;
|
mean->x2 = (quaternion1->x2 + quaternion2->x2) * 0.5f;
|
||||||
mean->x3 = (vector1->x3 + vector2->x3) * 0.5f;
|
mean->x3 = (quaternion1->x3 + quaternion2->x3) * 0.5f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_get_mean2(const BGC_FP64_Quaternion* vector1, const BGC_FP64_Quaternion* vector2, BGC_FP64_Quaternion* mean)
|
inline void bgc_fp64_quaternion_get_mean2(BGC_FP64_Quaternion* mean, const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2)
|
||||||
{
|
{
|
||||||
mean->s0 = (vector1->s0 + vector2->s0) * 0.5f;
|
mean->s0 = (quaternion1->s0 + quaternion2->s0) * 0.5f;
|
||||||
mean->x1 = (vector1->x1 + vector2->x1) * 0.5f;
|
mean->x1 = (quaternion1->x1 + quaternion2->x1) * 0.5f;
|
||||||
mean->x2 = (vector1->x2 + vector2->x2) * 0.5f;
|
mean->x2 = (quaternion1->x2 + quaternion2->x2) * 0.5f;
|
||||||
mean->x3 = (vector1->x3 + vector2->x3) * 0.5f;
|
mean->x3 = (quaternion1->x3 + quaternion2->x3) * 0.5f;
|
||||||
}
|
}
|
||||||
|
|
||||||
// =============== Mean of Three ================ //
|
// =============== Mean of Three ================ //
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_get_mean3(const BGC_FP32_Quaternion* vector1, const BGC_FP32_Quaternion* vector2, const BGC_FP32_Quaternion* vector3, BGC_FP32_Quaternion* mean)
|
inline void bgc_fp32_quaternion_get_mean3(BGC_FP32_Quaternion* mean, const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2, const BGC_FP32_Quaternion* quaternion3)
|
||||||
{
|
{
|
||||||
mean->s0 = (vector1->s0 + vector2->s0 + vector3->s0) * BGC_FP32_ONE_THIRD;
|
mean->s0 = (quaternion1->s0 + quaternion2->s0 + quaternion3->s0) * BGC_FP32_ONE_THIRD;
|
||||||
mean->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP32_ONE_THIRD;
|
mean->x1 = (quaternion1->x1 + quaternion2->x1 + quaternion3->x1) * BGC_FP32_ONE_THIRD;
|
||||||
mean->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP32_ONE_THIRD;
|
mean->x2 = (quaternion1->x2 + quaternion2->x2 + quaternion3->x2) * BGC_FP32_ONE_THIRD;
|
||||||
mean->x3 = (vector1->x3 + vector2->x3 + vector3->x3) * BGC_FP32_ONE_THIRD;
|
mean->x3 = (quaternion1->x3 + quaternion2->x3 + quaternion3->x3) * BGC_FP32_ONE_THIRD;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_get_mean3(const BGC_FP64_Quaternion* vector1, const BGC_FP64_Quaternion* vector2, const BGC_FP64_Quaternion* vector3, BGC_FP64_Quaternion* mean)
|
inline void bgc_fp64_quaternion_get_mean3(BGC_FP64_Quaternion* mean, const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2, const BGC_FP64_Quaternion* quaternion3)
|
||||||
{
|
{
|
||||||
mean->s0 = (vector1->s0 + vector2->s0 + vector3->s0) * BGC_FP64_ONE_THIRD;
|
mean->s0 = (quaternion1->s0 + quaternion2->s0 + quaternion3->s0) * BGC_FP64_ONE_THIRD;
|
||||||
mean->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP64_ONE_THIRD;
|
mean->x1 = (quaternion1->x1 + quaternion2->x1 + quaternion3->x1) * BGC_FP64_ONE_THIRD;
|
||||||
mean->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP64_ONE_THIRD;
|
mean->x2 = (quaternion1->x2 + quaternion2->x2 + quaternion3->x2) * BGC_FP64_ONE_THIRD;
|
||||||
mean->x3 = (vector1->x3 + vector2->x3 + vector3->x3) * BGC_FP64_ONE_THIRD;
|
mean->x3 = (quaternion1->x3 + quaternion2->x3 + quaternion3->x3) * BGC_FP64_ONE_THIRD;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============ Linear Interpolation ============ //
|
// ============ Linear Interpolation ============ //
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_interpolate(const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2, const float phase, BGC_FP32_Quaternion* interpolation)
|
inline void bgc_fp32_quaternion_interpolate(BGC_FP32_Quaternion* interpolation, const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2, const float phase)
|
||||||
{
|
{
|
||||||
const float counter_phase = 1.0f - phase;
|
const float counter_phase = 1.0f - phase;
|
||||||
|
|
||||||
|
|
@ -395,7 +395,7 @@ inline void bgc_fp32_quaternion_interpolate(const BGC_FP32_Quaternion* quaternio
|
||||||
interpolation->x3 = quaternion1->x3 * counter_phase + quaternion2->x3 * phase;
|
interpolation->x3 = quaternion1->x3 * counter_phase + quaternion2->x3 * phase;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_interpolate(const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2, const double phase, BGC_FP64_Quaternion* interpolation)
|
inline void bgc_fp64_quaternion_interpolate(BGC_FP64_Quaternion* interpolation, const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2, const double phase)
|
||||||
{
|
{
|
||||||
const double counter_phase = 1.0 - phase;
|
const double counter_phase = 1.0 - phase;
|
||||||
|
|
||||||
|
|
@ -421,7 +421,7 @@ inline void bgc_fp64_quaternion_conjugate(BGC_FP64_Quaternion* quaternion)
|
||||||
quaternion->x3 = -quaternion->x3;
|
quaternion->x3 = -quaternion->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_get_conjugate(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Quaternion* conjugate)
|
inline void bgc_fp32_quaternion_get_conjugate(BGC_FP32_Quaternion* conjugate, const BGC_FP32_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
conjugate->s0 = quaternion->s0;
|
conjugate->s0 = quaternion->s0;
|
||||||
conjugate->x1 = -quaternion->x1;
|
conjugate->x1 = -quaternion->x1;
|
||||||
|
|
@ -429,7 +429,7 @@ inline void bgc_fp32_quaternion_get_conjugate(const BGC_FP32_Quaternion* quatern
|
||||||
conjugate->x3 = -quaternion->x3;
|
conjugate->x3 = -quaternion->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_get_conjugate(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Quaternion* conjugate)
|
inline void bgc_fp64_quaternion_get_conjugate(BGC_FP64_Quaternion* conjugate, const BGC_FP64_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
conjugate->s0 = quaternion->s0;
|
conjugate->s0 = quaternion->s0;
|
||||||
conjugate->x1 = -quaternion->x1;
|
conjugate->x1 = -quaternion->x1;
|
||||||
|
|
@ -455,25 +455,25 @@ inline void bgc_fp64_quaternion_revert(BGC_FP64_Quaternion* quaternion)
|
||||||
quaternion->x3 = -quaternion->x3;
|
quaternion->x3 = -quaternion->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_quaternion_get_reverse(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Quaternion* opposite)
|
inline void bgc_fp32_quaternion_get_reverse(BGC_FP32_Quaternion* reverse, const BGC_FP32_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
opposite->s0 = -quaternion->s0;
|
reverse->s0 = -quaternion->s0;
|
||||||
opposite->x1 = -quaternion->x1;
|
reverse->x1 = -quaternion->x1;
|
||||||
opposite->x2 = -quaternion->x2;
|
reverse->x2 = -quaternion->x2;
|
||||||
opposite->x3 = -quaternion->x3;
|
reverse->x3 = -quaternion->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_quaternion_get_reverse(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Quaternion* opposite)
|
inline void bgc_fp64_quaternion_get_reverse(BGC_FP64_Quaternion* reverse, const BGC_FP64_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
opposite->s0 = -quaternion->s0;
|
reverse->s0 = -quaternion->s0;
|
||||||
opposite->x1 = -quaternion->x1;
|
reverse->x1 = -quaternion->x1;
|
||||||
opposite->x2 = -quaternion->x2;
|
reverse->x2 = -quaternion->x2;
|
||||||
opposite->x3 = -quaternion->x3;
|
reverse->x3 = -quaternion->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Invert =================== //
|
// =================== Invert =================== //
|
||||||
|
|
||||||
inline int bgc_fp32_quaternion_get_inverse(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Quaternion* inverse)
|
inline int bgc_fp32_quaternion_get_inverse(BGC_FP32_Quaternion* inverse, const BGC_FP32_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
const float square_modulus = bgc_fp32_quaternion_get_square_modulus(quaternion);
|
const float square_modulus = bgc_fp32_quaternion_get_square_modulus(quaternion);
|
||||||
|
|
||||||
|
|
@ -491,7 +491,7 @@ inline int bgc_fp32_quaternion_get_inverse(const BGC_FP32_Quaternion* quaternion
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_quaternion_get_inverse(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Quaternion* inverse)
|
inline int bgc_fp64_quaternion_get_inverse(BGC_FP64_Quaternion* inverse, const BGC_FP64_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
const double square_modulus = bgc_fp64_quaternion_get_square_modulus(quaternion);
|
const double square_modulus = bgc_fp64_quaternion_get_square_modulus(quaternion);
|
||||||
|
|
||||||
|
|
@ -565,12 +565,12 @@ inline int bgc_fp64_quaternion_normalize(BGC_FP64_Quaternion* quaternion)
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp32_quaternion_get_normalized(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Quaternion* normalized)
|
inline int bgc_fp32_quaternion_get_normalized(BGC_FP32_Quaternion* normalized, const BGC_FP32_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
const float square_modulus = bgc_fp32_quaternion_get_square_modulus(quaternion);
|
const float square_modulus = bgc_fp32_quaternion_get_square_modulus(quaternion);
|
||||||
|
|
||||||
if (bgc_fp32_is_square_unit(square_modulus)) {
|
if (bgc_fp32_is_square_unit(square_modulus)) {
|
||||||
bgc_fp32_quaternion_copy(quaternion, normalized);
|
bgc_fp32_quaternion_copy(normalized, quaternion);
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -579,16 +579,16 @@ inline int bgc_fp32_quaternion_get_normalized(const BGC_FP32_Quaternion* quatern
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp32_quaternion_multiply(quaternion, sqrtf(1.0f / square_modulus), normalized);
|
bgc_fp32_quaternion_multiply(normalized, quaternion, sqrtf(1.0f / square_modulus));
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_quaternion_get_normalized(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Quaternion* normalized)
|
inline int bgc_fp64_quaternion_get_normalized(BGC_FP64_Quaternion* normalized, const BGC_FP64_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
const double square_modulus = bgc_fp64_quaternion_get_square_modulus(quaternion);
|
const double square_modulus = bgc_fp64_quaternion_get_square_modulus(quaternion);
|
||||||
|
|
||||||
if (bgc_fp64_is_square_unit(square_modulus)) {
|
if (bgc_fp64_is_square_unit(square_modulus)) {
|
||||||
bgc_fp64_quaternion_copy(quaternion, normalized);
|
bgc_fp64_quaternion_copy(normalized, quaternion);
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -597,19 +597,19 @@ inline int bgc_fp64_quaternion_get_normalized(const BGC_FP64_Quaternion* quatern
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp64_quaternion_multiply(quaternion, sqrt(1.0 / square_modulus), normalized);
|
bgc_fp64_quaternion_multiply(normalized, quaternion, sqrt(1.0 / square_modulus));
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
// =============== Get Exponation =============== //
|
// =============== Get Exponation =============== //
|
||||||
|
|
||||||
int bgc_fp32_quaternion_get_exponation(const BGC_FP32_Quaternion* base, const float exponent, BGC_FP32_Quaternion* power);
|
int bgc_fp32_quaternion_get_exponation(BGC_FP32_Quaternion* power, const BGC_FP32_Quaternion* base, const float exponent);
|
||||||
|
|
||||||
int bgc_fp64_quaternion_get_exponation(const BGC_FP64_Quaternion* base, const double exponent, BGC_FP64_Quaternion* power);
|
int bgc_fp64_quaternion_get_exponation(BGC_FP64_Quaternion* power, const BGC_FP64_Quaternion* base, const double exponent);
|
||||||
|
|
||||||
// ============ Get Rotation Matrix ============= //
|
// ============ Get Rotation Matrix ============= //
|
||||||
|
|
||||||
inline int bgc_fp32_quaternion_get_rotation_matrix(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Matrix3x3* rotation)
|
inline int bgc_fp32_quaternion_get_rotation_matrix(BGC_FP32_Matrix3x3* rotation, const BGC_FP32_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
const float s0s0 = quaternion->s0 * quaternion->s0;
|
const float s0s0 = quaternion->s0 * quaternion->s0;
|
||||||
const float x1x1 = quaternion->x1 * quaternion->x1;
|
const float x1x1 = quaternion->x1 * quaternion->x1;
|
||||||
|
|
@ -650,7 +650,7 @@ inline int bgc_fp32_quaternion_get_rotation_matrix(const BGC_FP32_Quaternion* qu
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_quaternion_get_rotation_matrix(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Matrix3x3* rotation)
|
inline int bgc_fp64_quaternion_get_rotation_matrix(BGC_FP64_Matrix3x3* rotation, const BGC_FP64_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
const double s0s0 = quaternion->s0 * quaternion->s0;
|
const double s0s0 = quaternion->s0 * quaternion->s0;
|
||||||
const double x1x1 = quaternion->x1 * quaternion->x1;
|
const double x1x1 = quaternion->x1 * quaternion->x1;
|
||||||
|
|
@ -693,7 +693,7 @@ inline int bgc_fp64_quaternion_get_rotation_matrix(const BGC_FP64_Quaternion* qu
|
||||||
|
|
||||||
// ============= Get Reverse Matrix ============= //
|
// ============= Get Reverse Matrix ============= //
|
||||||
|
|
||||||
inline int bgc_fp32_quaternion_get_reverse_matrix(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Matrix3x3* reverse)
|
inline int bgc_fp32_quaternion_get_reverse_matrix(BGC_FP32_Matrix3x3* reverse, const BGC_FP32_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
const float s0s0 = quaternion->s0 * quaternion->s0;
|
const float s0s0 = quaternion->s0 * quaternion->s0;
|
||||||
const float x1x1 = quaternion->x1 * quaternion->x1;
|
const float x1x1 = quaternion->x1 * quaternion->x1;
|
||||||
|
|
@ -734,7 +734,7 @@ inline int bgc_fp32_quaternion_get_reverse_matrix(const BGC_FP32_Quaternion* qua
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_quaternion_get_reverse_matrix(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Matrix3x3* reverse)
|
inline int bgc_fp64_quaternion_get_reverse_matrix(BGC_FP64_Matrix3x3* reverse, const BGC_FP64_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
const double s0s0 = quaternion->s0 * quaternion->s0;
|
const double s0s0 = quaternion->s0 * quaternion->s0;
|
||||||
const double x1x1 = quaternion->x1 * quaternion->x1;
|
const double x1x1 = quaternion->x1 * quaternion->x1;
|
||||||
|
|
@ -777,20 +777,20 @@ inline int bgc_fp64_quaternion_get_reverse_matrix(const BGC_FP64_Quaternion* qua
|
||||||
|
|
||||||
// ============= Get Both Matrixes ============== //
|
// ============= Get Both Matrixes ============== //
|
||||||
|
|
||||||
inline int bgc_fp32_quaternion_get_both_matrices(const BGC_FP32_Quaternion* quaternion, BGC_FP32_Matrix3x3* rotation, BGC_FP32_Matrix3x3* reverse)
|
inline int bgc_fp32_quaternion_get_both_matrices(BGC_FP32_Matrix3x3* rotation, BGC_FP32_Matrix3x3* reverse, const BGC_FP32_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
if (bgc_fp32_quaternion_get_reverse_matrix(quaternion, reverse)) {
|
if (bgc_fp32_quaternion_get_reverse_matrix(reverse, quaternion)) {
|
||||||
bgc_fp32_matrix3x3_get_transposed(reverse, rotation);
|
bgc_fp32_matrix3x3_get_transposed(rotation, reverse);
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_quaternion_get_both_matrices(const BGC_FP64_Quaternion* quaternion, BGC_FP64_Matrix3x3* rotation, BGC_FP64_Matrix3x3* reverse)
|
inline int bgc_fp64_quaternion_get_both_matrices(BGC_FP64_Matrix3x3* rotation, BGC_FP64_Matrix3x3* reverse, const BGC_FP64_Quaternion* quaternion)
|
||||||
{
|
{
|
||||||
if (bgc_fp64_quaternion_get_reverse_matrix(quaternion, reverse)) {
|
if (bgc_fp64_quaternion_get_reverse_matrix(reverse, quaternion)) {
|
||||||
bgc_fp64_matrix3x3_get_transposed(reverse, rotation);
|
bgc_fp64_matrix3x3_get_transposed(rotation, reverse);
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -72,7 +72,7 @@ inline void bgc_fp64_rotation3_make(const double x1, const double x2, const doub
|
||||||
|
|
||||||
inline void bgc_fp32_rotation3_make_for_axis(const BGC_FP32_Vector3* axis, const float angle, const int unit, BGC_FP32_Rotation3* rotation)
|
inline void bgc_fp32_rotation3_make_for_axis(const BGC_FP32_Vector3* axis, const float angle, const int unit, BGC_FP32_Rotation3* rotation)
|
||||||
{
|
{
|
||||||
if (bgc_fp32_vector3_get_normalized(axis, &rotation->axis)) {
|
if (bgc_fp32_vector3_get_normalized(&rotation->axis, axis)) {
|
||||||
rotation->radians = bgc_fp32_angle_to_radians(angle, unit);
|
rotation->radians = bgc_fp32_angle_to_radians(angle, unit);
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
|
|
@ -82,7 +82,7 @@ inline void bgc_fp32_rotation3_make_for_axis(const BGC_FP32_Vector3* axis, const
|
||||||
|
|
||||||
inline void bgc_fp64_rotation3_make_for_axis(const BGC_FP64_Vector3* axis, const double angle, const int unit, BGC_FP64_Rotation3* rotation)
|
inline void bgc_fp64_rotation3_make_for_axis(const BGC_FP64_Vector3* axis, const double angle, const int unit, BGC_FP64_Rotation3* rotation)
|
||||||
{
|
{
|
||||||
if (bgc_fp64_vector3_get_normalized(axis, &rotation->axis)) {
|
if (bgc_fp64_vector3_get_normalized(&rotation->axis, axis)) {
|
||||||
rotation->radians = bgc_fp64_angle_to_radians(angle, unit);
|
rotation->radians = bgc_fp64_angle_to_radians(angle, unit);
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
|
|
|
||||||
|
|
@ -3,16 +3,16 @@
|
||||||
extern inline void bgc_fp32_slerp_reset(BGC_FP32_Slerp* slerp);
|
extern inline void bgc_fp32_slerp_reset(BGC_FP32_Slerp* slerp);
|
||||||
extern inline void bgc_fp64_slerp_reset(BGC_FP64_Slerp* slerp);
|
extern inline void bgc_fp64_slerp_reset(BGC_FP64_Slerp* slerp);
|
||||||
|
|
||||||
extern inline void bgc_fp32_slerp_make_full(const BGC_FP32_Versor* start, const BGC_FP32_Versor* end, BGC_FP32_Slerp* slerp);
|
extern inline void bgc_fp32_slerp_make_full(BGC_FP32_Slerp* slerp, const BGC_FP32_Versor* start, const BGC_FP32_Versor* end);
|
||||||
extern inline void bgc_fp64_slerp_make_full(const BGC_FP64_Versor* start, const BGC_FP64_Versor* end, BGC_FP64_Slerp* slerp);
|
extern inline void bgc_fp64_slerp_make_full(BGC_FP64_Slerp* slerp, const BGC_FP64_Versor* start, const BGC_FP64_Versor* end);
|
||||||
|
|
||||||
extern inline void bgc_fp32_slerp_make_shortened(const BGC_FP32_Versor* start, const BGC_FP32_Versor* end, BGC_FP32_Slerp* slerp);
|
extern inline void bgc_fp32_slerp_make_shortened(BGC_FP32_Slerp* slerp, const BGC_FP32_Versor* start, const BGC_FP32_Versor* end);
|
||||||
extern inline void bgc_fp64_slerp_make_shortened(const BGC_FP64_Versor* start, const BGC_FP64_Versor* end, BGC_FP64_Slerp* slerp);
|
extern inline void bgc_fp64_slerp_make_shortened(BGC_FP64_Slerp* slerp, const BGC_FP64_Versor* start, const BGC_FP64_Versor* end);
|
||||||
|
|
||||||
extern inline void bgc_fp32_slerp_get_phase_versor(const BGC_FP32_Slerp* slerp, const float phase, BGC_FP32_Versor* result);
|
extern inline void bgc_fp32_slerp_get_phase_versor(BGC_FP32_Versor* versor, const BGC_FP32_Slerp* slerp, const float phase);
|
||||||
extern inline void bgc_fp64_slerp_get_phase_versor(const BGC_FP64_Slerp* slerp, const double phase, BGC_FP64_Versor* result);
|
extern inline void bgc_fp64_slerp_get_phase_versor(BGC_FP64_Versor* versor, const BGC_FP64_Slerp* slerp, const double phase);
|
||||||
|
|
||||||
void bgc_fp32_slerp_make(const BGC_FP32_Versor* start, const BGC_FP32_Versor* augment, BGC_FP32_Slerp* slerp)
|
void bgc_fp32_slerp_make(BGC_FP32_Slerp* slerp, const BGC_FP32_Versor* start, const BGC_FP32_Versor* augment)
|
||||||
{
|
{
|
||||||
const float square_vector = augment->_x1 * augment->_x1 + augment->_x2 * augment->_x2 + augment->_x3 * augment->_x3;
|
const float square_vector = augment->_x1 * augment->_x1 + augment->_x2 * augment->_x2 + augment->_x3 * augment->_x3;
|
||||||
|
|
||||||
|
|
@ -53,7 +53,7 @@ void bgc_fp32_slerp_make(const BGC_FP32_Versor* start, const BGC_FP32_Versor* au
|
||||||
slerp->x3_sin_weight = multiplier * (augment->_x3 * start->_s0 - augment->_x2 * start->_x1 + augment->_x1 * start->_x2);
|
slerp->x3_sin_weight = multiplier * (augment->_x3 * start->_s0 - augment->_x2 * start->_x1 + augment->_x1 * start->_x2);
|
||||||
}
|
}
|
||||||
|
|
||||||
void bgc_fp64_slerp_make(const BGC_FP64_Versor* start, const BGC_FP64_Versor* augment, BGC_FP64_Slerp* slerp)
|
void bgc_fp64_slerp_make(BGC_FP64_Slerp* slerp, const BGC_FP64_Versor* start, const BGC_FP64_Versor* augment)
|
||||||
{
|
{
|
||||||
const double square_vector = augment->_x1 * augment->_x1 + augment->_x2 * augment->_x2 + augment->_x3 * augment->_x3;
|
const double square_vector = augment->_x1 * augment->_x1 + augment->_x2 * augment->_x2 + augment->_x3 * augment->_x3;
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -53,75 +53,74 @@ inline void bgc_fp64_slerp_reset(BGC_FP64_Slerp* slerp)
|
||||||
slerp->radians = 0.0;
|
slerp->radians = 0.0;
|
||||||
}
|
}
|
||||||
|
|
||||||
void bgc_fp32_slerp_make(const BGC_FP32_Versor* start, const BGC_FP32_Versor* augment, BGC_FP32_Slerp* slerp);
|
void bgc_fp32_slerp_make(BGC_FP32_Slerp* slerp, const BGC_FP32_Versor* start, const BGC_FP32_Versor* augment);
|
||||||
|
void bgc_fp64_slerp_make(BGC_FP64_Slerp* slerp, const BGC_FP64_Versor* start, const BGC_FP64_Versor* augment);
|
||||||
|
|
||||||
void bgc_fp64_slerp_make(const BGC_FP64_Versor* start, const BGC_FP64_Versor* augment, BGC_FP64_Slerp* slerp);
|
inline void bgc_fp32_slerp_make_full(BGC_FP32_Slerp* slerp, const BGC_FP32_Versor* start, const BGC_FP32_Versor* end)
|
||||||
|
|
||||||
inline void bgc_fp32_slerp_make_full(const BGC_FP32_Versor* start, const BGC_FP32_Versor* end, BGC_FP32_Slerp* slerp)
|
|
||||||
{
|
{
|
||||||
BGC_FP32_Versor augment;
|
BGC_FP32_Versor augment;
|
||||||
|
|
||||||
bgc_fp32_versor_exclude(end, start, &augment);
|
bgc_fp32_versor_exclude(&augment, end, start);
|
||||||
|
|
||||||
bgc_fp32_slerp_make(start, &augment, slerp);
|
bgc_fp32_slerp_make(slerp, start, &augment);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_slerp_make_full(const BGC_FP64_Versor* start, const BGC_FP64_Versor* end, BGC_FP64_Slerp* slerp)
|
inline void bgc_fp64_slerp_make_full(BGC_FP64_Slerp* slerp, const BGC_FP64_Versor* start, const BGC_FP64_Versor* end)
|
||||||
{
|
{
|
||||||
BGC_FP64_Versor augment;
|
BGC_FP64_Versor augment;
|
||||||
|
|
||||||
bgc_fp64_versor_exclude(end, start, &augment);
|
bgc_fp64_versor_exclude(&augment, end, start);
|
||||||
|
|
||||||
bgc_fp64_slerp_make(start, &augment, slerp);
|
bgc_fp64_slerp_make(slerp, start, &augment);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_slerp_make_shortened(const BGC_FP32_Versor* start, const BGC_FP32_Versor* end, BGC_FP32_Slerp* slerp)
|
inline void bgc_fp32_slerp_make_shortened(BGC_FP32_Slerp* slerp, const BGC_FP32_Versor* start, const BGC_FP32_Versor* end)
|
||||||
{
|
{
|
||||||
BGC_FP32_Versor augment;
|
BGC_FP32_Versor augment;
|
||||||
|
|
||||||
bgc_fp32_versor_exclude(end, start, &augment);
|
bgc_fp32_versor_exclude(&augment, end, start);
|
||||||
bgc_fp32_versor_shorten(&augment);
|
bgc_fp32_versor_shorten(&augment);
|
||||||
|
|
||||||
bgc_fp32_slerp_make(start, &augment, slerp);
|
bgc_fp32_slerp_make(slerp, start, &augment);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_slerp_make_shortened(const BGC_FP64_Versor* start, const BGC_FP64_Versor* end, BGC_FP64_Slerp* slerp)
|
inline void bgc_fp64_slerp_make_shortened(BGC_FP64_Slerp* slerp, const BGC_FP64_Versor* start, const BGC_FP64_Versor* end)
|
||||||
{
|
{
|
||||||
BGC_FP64_Versor augment;
|
BGC_FP64_Versor augment;
|
||||||
|
|
||||||
bgc_fp64_versor_exclude(end, start, &augment);
|
bgc_fp64_versor_exclude(&augment, end, start);
|
||||||
bgc_fp64_versor_shorten(&augment);
|
bgc_fp64_versor_shorten(&augment);
|
||||||
|
|
||||||
bgc_fp64_slerp_make(start, &augment, slerp);
|
bgc_fp64_slerp_make(slerp, start, &augment);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_slerp_get_phase_versor(const BGC_FP32_Slerp* slerp, const float phase, BGC_FP32_Versor* result)
|
inline void bgc_fp32_slerp_get_phase_versor(BGC_FP32_Versor* versor, const BGC_FP32_Slerp* slerp, const float phase)
|
||||||
{
|
{
|
||||||
const float angle = slerp->radians * phase;
|
const float angle = slerp->radians * phase;
|
||||||
const float cosine = cosf(angle);
|
const float cosine = cosf(angle);
|
||||||
const float sine = sinf(angle);
|
const float sine = sinf(angle);
|
||||||
|
|
||||||
bgc_fp32_versor_make(
|
bgc_fp32_versor_make(
|
||||||
|
versor,
|
||||||
slerp->s0_cos_weight * cosine + slerp->s0_sin_weight * sine,
|
slerp->s0_cos_weight * cosine + slerp->s0_sin_weight * sine,
|
||||||
slerp->x1_cos_weight * cosine + slerp->x1_sin_weight * sine,
|
slerp->x1_cos_weight * cosine + slerp->x1_sin_weight * sine,
|
||||||
slerp->x2_cos_weight * cosine + slerp->x2_sin_weight * sine,
|
slerp->x2_cos_weight * cosine + slerp->x2_sin_weight * sine,
|
||||||
slerp->x3_cos_weight * cosine + slerp->x3_sin_weight * sine,
|
slerp->x3_cos_weight * cosine + slerp->x3_sin_weight * sine
|
||||||
result
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_slerp_get_phase_versor(const BGC_FP64_Slerp* slerp, const double phase, BGC_FP64_Versor* result)
|
inline void bgc_fp64_slerp_get_phase_versor(BGC_FP64_Versor* versor, const BGC_FP64_Slerp* slerp, const double phase)
|
||||||
{
|
{
|
||||||
const double angle = slerp->radians * phase;
|
const double angle = slerp->radians * phase;
|
||||||
const double cosine = cos(angle);
|
const double cosine = cos(angle);
|
||||||
const double sine = sin(angle);
|
const double sine = sin(angle);
|
||||||
|
|
||||||
bgc_fp64_versor_make(
|
bgc_fp64_versor_make(
|
||||||
|
versor,
|
||||||
slerp->s0_cos_weight * cosine + slerp->s0_sin_weight * sine,
|
slerp->s0_cos_weight * cosine + slerp->s0_sin_weight * sine,
|
||||||
slerp->x1_cos_weight * cosine + slerp->x1_sin_weight * sine,
|
slerp->x1_cos_weight * cosine + slerp->x1_sin_weight * sine,
|
||||||
slerp->x2_cos_weight * cosine + slerp->x2_sin_weight * sine,
|
slerp->x2_cos_weight * cosine + slerp->x2_sin_weight * sine,
|
||||||
slerp->x3_cos_weight * cosine + slerp->x3_sin_weight * sine,
|
slerp->x3_cos_weight * cosine + slerp->x3_sin_weight * sine
|
||||||
result
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -3,8 +3,8 @@
|
||||||
extern inline void bgc_fp32_vector2_reset(BGC_FP32_Vector2* vector);
|
extern inline void bgc_fp32_vector2_reset(BGC_FP32_Vector2* vector);
|
||||||
extern inline void bgc_fp64_vector2_reset(BGC_FP64_Vector2* vector);
|
extern inline void bgc_fp64_vector2_reset(BGC_FP64_Vector2* vector);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_make(const float x1, const float x2, BGC_FP32_Vector2* destination);
|
extern inline void bgc_fp32_vector2_make(BGC_FP32_Vector2* destination, const float x1, const float x2);
|
||||||
extern inline void bgc_fp64_vector2_make(const double x1, const double x2, BGC_FP64_Vector2* destination);
|
extern inline void bgc_fp64_vector2_make(BGC_FP64_Vector2* destination, const double x1, const double x2);
|
||||||
|
|
||||||
extern inline float bgc_fp32_vector2_get_square_modulus(const BGC_FP32_Vector2* vector);
|
extern inline float bgc_fp32_vector2_get_square_modulus(const BGC_FP32_Vector2* vector);
|
||||||
extern inline double bgc_fp64_vector2_get_square_modulus(const BGC_FP64_Vector2* vector);
|
extern inline double bgc_fp64_vector2_get_square_modulus(const BGC_FP64_Vector2* vector);
|
||||||
|
|
@ -18,50 +18,50 @@ extern inline int bgc_fp64_vector2_is_zero(const BGC_FP64_Vector2* vector);
|
||||||
extern inline int bgc_fp32_vector2_is_unit(const BGC_FP32_Vector2* vector);
|
extern inline int bgc_fp32_vector2_is_unit(const BGC_FP32_Vector2* vector);
|
||||||
extern inline int bgc_fp64_vector2_is_unit(const BGC_FP64_Vector2* vector);
|
extern inline int bgc_fp64_vector2_is_unit(const BGC_FP64_Vector2* vector);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_copy(const BGC_FP32_Vector2* source, BGC_FP32_Vector2* destination);
|
extern inline void bgc_fp32_vector2_copy(BGC_FP32_Vector2* destination, const BGC_FP32_Vector2* source);
|
||||||
extern inline void bgc_fp64_vector2_copy(const BGC_FP64_Vector2* source, BGC_FP64_Vector2* destination);
|
extern inline void bgc_fp64_vector2_copy(BGC_FP64_Vector2* destination, const BGC_FP64_Vector2* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_swap(BGC_FP32_Vector2* vector1, BGC_FP32_Vector2* vector2);
|
extern inline void bgc_fp32_vector2_swap(BGC_FP32_Vector2* vector1, BGC_FP32_Vector2* vector2);
|
||||||
extern inline void bgc_fp64_vector2_swap(BGC_FP64_Vector2* vector1, BGC_FP64_Vector2* vector2);
|
extern inline void bgc_fp64_vector2_swap(BGC_FP64_Vector2* vector1, BGC_FP64_Vector2* vector2);
|
||||||
|
|
||||||
extern inline void bgc_fp64_vector2_convert_to_fp32(const BGC_FP64_Vector2* source, BGC_FP32_Vector2* destination);
|
extern inline void bgc_fp32_vector2_convert_to_fp64(BGC_FP64_Vector2* destination, const BGC_FP32_Vector2* source);
|
||||||
extern inline void bgc_fp32_vector2_convert_to_fp64(const BGC_FP32_Vector2* source, BGC_FP64_Vector2* destination);
|
extern inline void bgc_fp64_vector2_convert_to_fp32(BGC_FP32_Vector2* destination, const BGC_FP64_Vector2* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_add(const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, BGC_FP32_Vector2* sum);
|
extern inline void bgc_fp32_vector2_add(BGC_FP32_Vector2* sum, const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2);
|
||||||
extern inline void bgc_fp64_vector2_add(const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, BGC_FP64_Vector2* sum);
|
extern inline void bgc_fp64_vector2_add(BGC_FP64_Vector2* sum, const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_add_scaled(const BGC_FP32_Vector2* basic_vector, const BGC_FP32_Vector2* scalable_vector, const float scale, BGC_FP32_Vector2* sum);
|
extern inline void bgc_fp32_vector2_add_scaled(BGC_FP32_Vector2* sum, const BGC_FP32_Vector2* basic_vector, const BGC_FP32_Vector2* scalable_vector, const float scale);
|
||||||
extern inline void bgc_fp64_vector2_add_scaled(const BGC_FP64_Vector2* basic_vector, const BGC_FP64_Vector2* scalable_vector, const double scale, BGC_FP64_Vector2* sum);
|
extern inline void bgc_fp64_vector2_add_scaled(BGC_FP64_Vector2* sum, const BGC_FP64_Vector2* basic_vector, const BGC_FP64_Vector2* scalable_vector, const double scale);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_subtract(const BGC_FP32_Vector2* minuend, const BGC_FP32_Vector2* subtrahend, BGC_FP32_Vector2* difference);
|
extern inline void bgc_fp32_vector2_subtract(BGC_FP32_Vector2* difference, const BGC_FP32_Vector2* minuend, const BGC_FP32_Vector2* subtrahend);
|
||||||
extern inline void bgc_fp64_vector2_subtract(const BGC_FP64_Vector2* minuend, const BGC_FP64_Vector2* subtrahend, BGC_FP64_Vector2* difference);
|
extern inline void bgc_fp64_vector2_subtract(BGC_FP64_Vector2* difference, const BGC_FP64_Vector2* minuend, const BGC_FP64_Vector2* subtrahend);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_multiply(const BGC_FP32_Vector2* multiplicand, const float multiplier, BGC_FP32_Vector2* product);
|
extern inline void bgc_fp32_vector2_multiply(BGC_FP32_Vector2* product, const BGC_FP32_Vector2* multiplicand, const float multiplier);
|
||||||
extern inline void bgc_fp64_vector2_multiply(const BGC_FP64_Vector2* multiplicand, const double multiplier, BGC_FP64_Vector2* product);
|
extern inline void bgc_fp64_vector2_multiply(BGC_FP64_Vector2* product, const BGC_FP64_Vector2* multiplicand, const double multiplier);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_divide(const BGC_FP32_Vector2* dividend, const float divisor, BGC_FP32_Vector2* quotient);
|
extern inline void bgc_fp32_vector2_divide(BGC_FP32_Vector2* quotient, const BGC_FP32_Vector2* dividend, const float divisor);
|
||||||
extern inline void bgc_fp64_vector2_divide(const BGC_FP64_Vector2* dividend, const double divisor, BGC_FP64_Vector2* quotient);
|
extern inline void bgc_fp64_vector2_divide(BGC_FP64_Vector2* quotient, const BGC_FP64_Vector2* dividend, const double divisor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_get_middle2(const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, BGC_FP32_Vector2* middle);
|
extern inline void bgc_fp32_vector2_get_mean2(BGC_FP32_Vector2* mean, const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2);
|
||||||
extern inline void bgc_fp64_vector2_get_middle2(const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, BGC_FP64_Vector2* middle);
|
extern inline void bgc_fp64_vector2_get_mean2(BGC_FP64_Vector2* mean, const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_get_middle3(const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, const BGC_FP32_Vector2* vector3, BGC_FP32_Vector2* middle);
|
extern inline void bgc_fp32_vector2_get_mean3(BGC_FP32_Vector2* mean, const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, const BGC_FP32_Vector2* vector3);
|
||||||
extern inline void bgc_fp64_vector2_get_middle3(const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, const BGC_FP64_Vector2* vector3, BGC_FP64_Vector2* middle);
|
extern inline void bgc_fp64_vector2_get_mean3(BGC_FP64_Vector2* mean, const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, const BGC_FP64_Vector2* vector3);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_interpolate(const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, const float phase, BGC_FP32_Vector2* interpolation);
|
extern inline void bgc_fp32_vector2_interpolate(BGC_FP32_Vector2* interpolation, const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, const float phase);
|
||||||
extern inline void bgc_fp64_vector2_interpolate(const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, const double phase, BGC_FP64_Vector2* interpolation);
|
extern inline void bgc_fp64_vector2_interpolate(BGC_FP64_Vector2* interpolation, const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, const double phase);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_revert(BGC_FP32_Vector2* vector);
|
extern inline void bgc_fp32_vector2_revert(BGC_FP32_Vector2* vector);
|
||||||
extern inline void bgc_fp64_vector2_revert(BGC_FP64_Vector2* vector);
|
extern inline void bgc_fp64_vector2_revert(BGC_FP64_Vector2* vector);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector2_get_reverse(const BGC_FP32_Vector2* vector, BGC_FP32_Vector2* reverse);
|
extern inline void bgc_fp32_vector2_get_reverse(BGC_FP32_Vector2* reverse, const BGC_FP32_Vector2* vector);
|
||||||
extern inline void bgc_fp64_vector2_get_reverse(const BGC_FP64_Vector2* vector, BGC_FP64_Vector2* reverse);
|
extern inline void bgc_fp64_vector2_get_reverse(BGC_FP64_Vector2* reverse, const BGC_FP64_Vector2* vector);
|
||||||
|
|
||||||
extern inline int bgc_fp32_vector2_normalize(BGC_FP32_Vector2* vector);
|
extern inline int bgc_fp32_vector2_normalize(BGC_FP32_Vector2* vector);
|
||||||
extern inline int bgc_fp64_vector2_normalize(BGC_FP64_Vector2* vector);
|
extern inline int bgc_fp64_vector2_normalize(BGC_FP64_Vector2* vector);
|
||||||
|
|
||||||
extern inline int bgc_fp32_vector2_get_normalized(const BGC_FP32_Vector2* vector, BGC_FP32_Vector2* normalized);
|
extern inline int bgc_fp32_vector2_get_normalized(BGC_FP32_Vector2* normalized, const BGC_FP32_Vector2* vector);
|
||||||
extern inline int bgc_fp64_vector2_get_normalized(const BGC_FP64_Vector2* vector, BGC_FP64_Vector2* normalized);
|
extern inline int bgc_fp64_vector2_get_normalized(BGC_FP64_Vector2* normalized, const BGC_FP64_Vector2* vector);
|
||||||
|
|
||||||
extern inline float bgc_fp32_vector2_get_dot_product(const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2);
|
extern inline float bgc_fp32_vector2_get_dot_product(const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2);
|
||||||
extern inline double bgc_fp64_vector2_get_dot_product(const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2);
|
extern inline double bgc_fp64_vector2_get_dot_product(const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2);
|
||||||
|
|
|
||||||
|
|
@ -32,13 +32,13 @@ inline void bgc_fp64_vector2_reset(BGC_FP64_Vector2* vector)
|
||||||
|
|
||||||
// ==================== Set ===================== //
|
// ==================== Set ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_make(const float x1, const float x2, BGC_FP32_Vector2* destination)
|
inline void bgc_fp32_vector2_make(BGC_FP32_Vector2* destination, const float x1, const float x2)
|
||||||
{
|
{
|
||||||
destination->x1 = x1;
|
destination->x1 = x1;
|
||||||
destination->x2 = x2;
|
destination->x2 = x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_make(const double x1, const double x2, BGC_FP64_Vector2* destination)
|
inline void bgc_fp64_vector2_make(BGC_FP64_Vector2* destination, const double x1, const double x2)
|
||||||
{
|
{
|
||||||
destination->x1 = x1;
|
destination->x1 = x1;
|
||||||
destination->x2 = x2;
|
destination->x2 = x2;
|
||||||
|
|
@ -90,13 +90,13 @@ inline int bgc_fp64_vector2_is_unit(const BGC_FP64_Vector2* vector)
|
||||||
|
|
||||||
// ==================== Copy ==================== //
|
// ==================== Copy ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_copy(const BGC_FP32_Vector2* source, BGC_FP32_Vector2* destination)
|
inline void bgc_fp32_vector2_copy(BGC_FP32_Vector2* destination, const BGC_FP32_Vector2* source)
|
||||||
{
|
{
|
||||||
destination->x1 = source->x1;
|
destination->x1 = source->x1;
|
||||||
destination->x2 = source->x2;
|
destination->x2 = source->x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_copy(const BGC_FP64_Vector2* source, BGC_FP64_Vector2* destination)
|
inline void bgc_fp64_vector2_copy(BGC_FP64_Vector2* destination, const BGC_FP64_Vector2* source)
|
||||||
{
|
{
|
||||||
destination->x1 = source->x1;
|
destination->x1 = source->x1;
|
||||||
destination->x2 = source->x2;
|
destination->x2 = source->x2;
|
||||||
|
|
@ -130,27 +130,27 @@ inline void bgc_fp64_vector2_swap(BGC_FP64_Vector2* vector1, BGC_FP64_Vector2* v
|
||||||
|
|
||||||
// ================== Convert =================== //
|
// ================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_convert_to_fp32(const BGC_FP64_Vector2* source, BGC_FP32_Vector2* destination)
|
inline void bgc_fp32_vector2_convert_to_fp64(BGC_FP64_Vector2* destination, const BGC_FP32_Vector2* source)
|
||||||
{
|
|
||||||
destination->x1 = (float)source->x1;
|
|
||||||
destination->x2 = (float)source->x2;
|
|
||||||
}
|
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_convert_to_fp64(const BGC_FP32_Vector2* source, BGC_FP64_Vector2* destination)
|
|
||||||
{
|
{
|
||||||
destination->x1 = source->x1;
|
destination->x1 = source->x1;
|
||||||
destination->x2 = source->x2;
|
destination->x2 = source->x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
inline void bgc_fp64_vector2_convert_to_fp32(BGC_FP32_Vector2* destination, const BGC_FP64_Vector2* source)
|
||||||
|
{
|
||||||
|
destination->x1 = (float)source->x1;
|
||||||
|
destination->x2 = (float)source->x2;
|
||||||
|
}
|
||||||
|
|
||||||
// ==================== Add ===================== //
|
// ==================== Add ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_add(const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, BGC_FP32_Vector2* sum)
|
inline void bgc_fp32_vector2_add(BGC_FP32_Vector2* sum, const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2)
|
||||||
{
|
{
|
||||||
sum->x1 = vector1->x1 + vector2->x1;
|
sum->x1 = vector1->x1 + vector2->x1;
|
||||||
sum->x2 = vector1->x2 + vector2->x2;
|
sum->x2 = vector1->x2 + vector2->x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_add(const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, BGC_FP64_Vector2* sum)
|
inline void bgc_fp64_vector2_add(BGC_FP64_Vector2* sum, const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2)
|
||||||
{
|
{
|
||||||
sum->x1 = vector1->x1 + vector2->x1;
|
sum->x1 = vector1->x1 + vector2->x1;
|
||||||
sum->x2 = vector1->x2 + vector2->x2;
|
sum->x2 = vector1->x2 + vector2->x2;
|
||||||
|
|
@ -158,13 +158,13 @@ inline void bgc_fp64_vector2_add(const BGC_FP64_Vector2* vector1, const BGC_FP64
|
||||||
|
|
||||||
// ================= Add scaled ================= //
|
// ================= Add scaled ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_add_scaled(const BGC_FP32_Vector2* basic_vector, const BGC_FP32_Vector2* scalable_vector, const float scale, BGC_FP32_Vector2* sum)
|
inline void bgc_fp32_vector2_add_scaled(BGC_FP32_Vector2* sum, const BGC_FP32_Vector2* basic_vector, const BGC_FP32_Vector2* scalable_vector, const float scale)
|
||||||
{
|
{
|
||||||
sum->x1 = basic_vector->x1 + scalable_vector->x1 * scale;
|
sum->x1 = basic_vector->x1 + scalable_vector->x1 * scale;
|
||||||
sum->x2 = basic_vector->x2 + scalable_vector->x2 * scale;
|
sum->x2 = basic_vector->x2 + scalable_vector->x2 * scale;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_add_scaled(const BGC_FP64_Vector2* basic_vector, const BGC_FP64_Vector2* scalable_vector, const double scale, BGC_FP64_Vector2* sum)
|
inline void bgc_fp64_vector2_add_scaled(BGC_FP64_Vector2* sum, const BGC_FP64_Vector2* basic_vector, const BGC_FP64_Vector2* scalable_vector, const double scale)
|
||||||
{
|
{
|
||||||
sum->x1 = basic_vector->x1 + scalable_vector->x1 * scale;
|
sum->x1 = basic_vector->x1 + scalable_vector->x1 * scale;
|
||||||
sum->x2 = basic_vector->x2 + scalable_vector->x2 * scale;
|
sum->x2 = basic_vector->x2 + scalable_vector->x2 * scale;
|
||||||
|
|
@ -172,13 +172,13 @@ inline void bgc_fp64_vector2_add_scaled(const BGC_FP64_Vector2* basic_vector, co
|
||||||
|
|
||||||
// ================== Subtract ================== //
|
// ================== Subtract ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_subtract(const BGC_FP32_Vector2* minuend, const BGC_FP32_Vector2* subtrahend, BGC_FP32_Vector2* difference)
|
inline void bgc_fp32_vector2_subtract(BGC_FP32_Vector2* difference, const BGC_FP32_Vector2* minuend, const BGC_FP32_Vector2* subtrahend)
|
||||||
{
|
{
|
||||||
difference->x1 = minuend->x1 - subtrahend->x1;
|
difference->x1 = minuend->x1 - subtrahend->x1;
|
||||||
difference->x2 = minuend->x2 - subtrahend->x2;
|
difference->x2 = minuend->x2 - subtrahend->x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_subtract(const BGC_FP64_Vector2* minuend, const BGC_FP64_Vector2* subtrahend, BGC_FP64_Vector2* difference)
|
inline void bgc_fp64_vector2_subtract(BGC_FP64_Vector2* difference, const BGC_FP64_Vector2* minuend, const BGC_FP64_Vector2* subtrahend)
|
||||||
{
|
{
|
||||||
difference->x1 = minuend->x1 - subtrahend->x1;
|
difference->x1 = minuend->x1 - subtrahend->x1;
|
||||||
difference->x2 = minuend->x2 - subtrahend->x2;
|
difference->x2 = minuend->x2 - subtrahend->x2;
|
||||||
|
|
@ -186,13 +186,13 @@ inline void bgc_fp64_vector2_subtract(const BGC_FP64_Vector2* minuend, const BGC
|
||||||
|
|
||||||
// ================== Multiply ================== //
|
// ================== Multiply ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_multiply(const BGC_FP32_Vector2* multiplicand, const float multiplier, BGC_FP32_Vector2* product)
|
inline void bgc_fp32_vector2_multiply(BGC_FP32_Vector2* product, const BGC_FP32_Vector2* multiplicand, const float multiplier)
|
||||||
{
|
{
|
||||||
product->x1 = multiplicand->x1 * multiplier;
|
product->x1 = multiplicand->x1 * multiplier;
|
||||||
product->x2 = multiplicand->x2 * multiplier;
|
product->x2 = multiplicand->x2 * multiplier;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_multiply(const BGC_FP64_Vector2* multiplicand, const double multiplier, BGC_FP64_Vector2* product)
|
inline void bgc_fp64_vector2_multiply(BGC_FP64_Vector2* product, const BGC_FP64_Vector2* multiplicand, const double multiplier)
|
||||||
{
|
{
|
||||||
product->x1 = multiplicand->x1 * multiplier;
|
product->x1 = multiplicand->x1 * multiplier;
|
||||||
product->x2 = multiplicand->x2 * multiplier;
|
product->x2 = multiplicand->x2 * multiplier;
|
||||||
|
|
@ -200,47 +200,47 @@ inline void bgc_fp64_vector2_multiply(const BGC_FP64_Vector2* multiplicand, cons
|
||||||
|
|
||||||
// =================== Divide =================== //
|
// =================== Divide =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_divide(const BGC_FP32_Vector2* dividend, const float divisor, BGC_FP32_Vector2* quotient)
|
inline void bgc_fp32_vector2_divide(BGC_FP32_Vector2* quotient, const BGC_FP32_Vector2* dividend, const float divisor)
|
||||||
{
|
{
|
||||||
bgc_fp32_vector2_multiply(dividend, 1.0f / divisor, quotient);
|
bgc_fp32_vector2_multiply(quotient, dividend, 1.0f / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_divide(const BGC_FP64_Vector2* dividend, const double divisor, BGC_FP64_Vector2* quotient)
|
inline void bgc_fp64_vector2_divide(BGC_FP64_Vector2* quotient, const BGC_FP64_Vector2* dividend, const double divisor)
|
||||||
{
|
{
|
||||||
bgc_fp64_vector2_multiply(dividend, 1.0 / divisor, quotient);
|
bgc_fp64_vector2_multiply(quotient, dividend, 1.0 / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================ Mean of Two ================= //
|
// ================ Mean of Two ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_get_middle2(const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, BGC_FP32_Vector2* middle)
|
inline void bgc_fp32_vector2_get_mean2(BGC_FP32_Vector2* mean, const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2)
|
||||||
{
|
{
|
||||||
middle->x1 = (vector1->x1 + vector2->x1) * 0.5f;
|
mean->x1 = (vector1->x1 + vector2->x1) * 0.5f;
|
||||||
middle->x2 = (vector1->x2 + vector2->x2) * 0.5f;
|
mean->x2 = (vector1->x2 + vector2->x2) * 0.5f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_get_middle2(const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, BGC_FP64_Vector2* middle)
|
inline void bgc_fp64_vector2_get_mean2(BGC_FP64_Vector2* mean, const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2)
|
||||||
{
|
{
|
||||||
middle->x1 = (vector1->x1 + vector2->x1) * 0.5;
|
mean->x1 = (vector1->x1 + vector2->x1) * 0.5;
|
||||||
middle->x2 = (vector1->x2 + vector2->x2) * 0.5;
|
mean->x2 = (vector1->x2 + vector2->x2) * 0.5;
|
||||||
}
|
}
|
||||||
|
|
||||||
// =============== Mean of Three ================ //
|
// =============== Mean of Three ================ //
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_get_middle3(const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, const BGC_FP32_Vector2* vector3, BGC_FP32_Vector2* middle)
|
inline void bgc_fp32_vector2_get_mean3(BGC_FP32_Vector2* mean, const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, const BGC_FP32_Vector2* vector3)
|
||||||
{
|
{
|
||||||
middle->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP32_ONE_THIRD;
|
mean->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP32_ONE_THIRD;
|
||||||
middle->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP32_ONE_THIRD;
|
mean->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP32_ONE_THIRD;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_get_middle3(const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, const BGC_FP64_Vector2* vector3, BGC_FP64_Vector2* middle)
|
inline void bgc_fp64_vector2_get_mean3(BGC_FP64_Vector2* mean, const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, const BGC_FP64_Vector2* vector3)
|
||||||
{
|
{
|
||||||
middle->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP64_ONE_THIRD;
|
mean->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP64_ONE_THIRD;
|
||||||
middle->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP64_ONE_THIRD;
|
mean->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP64_ONE_THIRD;
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Linear =================== //
|
// =================== Linear =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_interpolate(const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, const float phase, BGC_FP32_Vector2* interpolation)
|
inline void bgc_fp32_vector2_interpolate(BGC_FP32_Vector2* interpolation, const BGC_FP32_Vector2* vector1, const BGC_FP32_Vector2* vector2, const float phase)
|
||||||
{
|
{
|
||||||
const float counter_phase = 1.0f - phase;
|
const float counter_phase = 1.0f - phase;
|
||||||
|
|
||||||
|
|
@ -248,7 +248,7 @@ inline void bgc_fp32_vector2_interpolate(const BGC_FP32_Vector2* vector1, const
|
||||||
interpolation->x2 = vector1->x2 * counter_phase + vector2->x2 * phase;
|
interpolation->x2 = vector1->x2 * counter_phase + vector2->x2 * phase;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_interpolate(const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, const double phase, BGC_FP64_Vector2* interpolation)
|
inline void bgc_fp64_vector2_interpolate(BGC_FP64_Vector2* interpolation, const BGC_FP64_Vector2* vector1, const BGC_FP64_Vector2* vector2, const double phase)
|
||||||
{
|
{
|
||||||
const double counter_phase = 1.0 - phase;
|
const double counter_phase = 1.0 - phase;
|
||||||
|
|
||||||
|
|
@ -270,13 +270,13 @@ inline void bgc_fp64_vector2_revert(BGC_FP64_Vector2* vector)
|
||||||
vector->x2 = -vector->x2;
|
vector->x2 = -vector->x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_vector2_get_reverse(const BGC_FP32_Vector2* vector, BGC_FP32_Vector2* reverse)
|
inline void bgc_fp32_vector2_get_reverse(BGC_FP32_Vector2* reverse, const BGC_FP32_Vector2* vector)
|
||||||
{
|
{
|
||||||
reverse->x1 = -vector->x1;
|
reverse->x1 = -vector->x1;
|
||||||
reverse->x2 = -vector->x2;
|
reverse->x2 = -vector->x2;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector2_get_reverse(const BGC_FP64_Vector2* vector, BGC_FP64_Vector2* reverse)
|
inline void bgc_fp64_vector2_get_reverse(BGC_FP64_Vector2* reverse, const BGC_FP64_Vector2* vector)
|
||||||
{
|
{
|
||||||
reverse->x1 = -vector->x1;
|
reverse->x1 = -vector->x1;
|
||||||
reverse->x2 = -vector->x2;
|
reverse->x2 = -vector->x2;
|
||||||
|
|
@ -324,12 +324,12 @@ inline int bgc_fp64_vector2_normalize(BGC_FP64_Vector2* vector)
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp32_vector2_get_normalized(const BGC_FP32_Vector2* vector, BGC_FP32_Vector2* normalized)
|
inline int bgc_fp32_vector2_get_normalized(BGC_FP32_Vector2* normalized, const BGC_FP32_Vector2* vector)
|
||||||
{
|
{
|
||||||
const float square_modulus = bgc_fp32_vector2_get_square_modulus(vector);
|
const float square_modulus = bgc_fp32_vector2_get_square_modulus(vector);
|
||||||
|
|
||||||
if (bgc_fp32_is_square_unit(square_modulus)) {
|
if (bgc_fp32_is_square_unit(square_modulus)) {
|
||||||
bgc_fp32_vector2_copy(vector, normalized);
|
bgc_fp32_vector2_copy(normalized, vector);
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -338,16 +338,16 @@ inline int bgc_fp32_vector2_get_normalized(const BGC_FP32_Vector2* vector, BGC_F
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp32_vector2_multiply(vector, sqrtf(1.0f / square_modulus), normalized);
|
bgc_fp32_vector2_multiply(normalized, vector, sqrtf(1.0f / square_modulus));
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_vector2_get_normalized(const BGC_FP64_Vector2* vector, BGC_FP64_Vector2* normalized)
|
inline int bgc_fp64_vector2_get_normalized(BGC_FP64_Vector2* normalized, const BGC_FP64_Vector2* vector)
|
||||||
{
|
{
|
||||||
const double square_modulus = bgc_fp64_vector2_get_square_modulus(vector);
|
const double square_modulus = bgc_fp64_vector2_get_square_modulus(vector);
|
||||||
|
|
||||||
if (bgc_fp64_is_square_unit(square_modulus)) {
|
if (bgc_fp64_is_square_unit(square_modulus)) {
|
||||||
bgc_fp64_vector2_copy(vector, normalized);
|
bgc_fp64_vector2_copy(normalized, vector);
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -356,7 +356,7 @@ inline int bgc_fp64_vector2_get_normalized(const BGC_FP64_Vector2* vector, BGC_F
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp64_vector2_multiply(vector, sqrt(1.0 / square_modulus), normalized);
|
bgc_fp64_vector2_multiply(normalized, vector, sqrt(1.0 / square_modulus));
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -3,8 +3,8 @@
|
||||||
extern inline void bgc_fp32_vector3_reset(BGC_FP32_Vector3* vector);
|
extern inline void bgc_fp32_vector3_reset(BGC_FP32_Vector3* vector);
|
||||||
extern inline void bgc_fp64_vector3_reset(BGC_FP64_Vector3* vector);
|
extern inline void bgc_fp64_vector3_reset(BGC_FP64_Vector3* vector);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_make(const float x1, const float x2, const float x3, BGC_FP32_Vector3* destination);
|
extern inline void bgc_fp32_vector3_make(BGC_FP32_Vector3* destination, const float x1, const float x2, const float x3);
|
||||||
extern inline void bgc_fp64_vector3_make(const double x1, const double x2, const double x3, BGC_FP64_Vector3* destination);
|
extern inline void bgc_fp64_vector3_make(BGC_FP64_Vector3* destination, const double x1, const double x2, const double x3);
|
||||||
|
|
||||||
extern inline float bgc_fp32_vector3_get_square_modulus(const BGC_FP32_Vector3* vector);
|
extern inline float bgc_fp32_vector3_get_square_modulus(const BGC_FP32_Vector3* vector);
|
||||||
extern inline double bgc_fp64_vector3_get_square_modulus(const BGC_FP64_Vector3* vector);
|
extern inline double bgc_fp64_vector3_get_square_modulus(const BGC_FP64_Vector3* vector);
|
||||||
|
|
@ -18,50 +18,50 @@ extern inline int bgc_fp64_vector3_is_zero(const BGC_FP64_Vector3* vector);
|
||||||
extern inline int bgc_fp32_vector3_is_unit(const BGC_FP32_Vector3* vector);
|
extern inline int bgc_fp32_vector3_is_unit(const BGC_FP32_Vector3* vector);
|
||||||
extern inline int bgc_fp64_vector3_is_unit(const BGC_FP64_Vector3* vector);
|
extern inline int bgc_fp64_vector3_is_unit(const BGC_FP64_Vector3* vector);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_copy(const BGC_FP32_Vector3* source, BGC_FP32_Vector3* destination);
|
extern inline void bgc_fp32_vector3_copy(BGC_FP32_Vector3* destination, const BGC_FP32_Vector3* source);
|
||||||
extern inline void bgc_fp64_vector3_copy(const BGC_FP64_Vector3* source, BGC_FP64_Vector3* destination);
|
extern inline void bgc_fp64_vector3_copy(BGC_FP64_Vector3* destination, const BGC_FP64_Vector3* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_convert_to_fp64(const BGC_FP32_Vector3* source, BGC_FP64_Vector3* destination);
|
extern inline void bgc_fp32_vector3_convert_to_fp64(BGC_FP64_Vector3* destination, const BGC_FP32_Vector3* source);
|
||||||
extern inline void bgc_fp64_vector3_convert_to_fp32(const BGC_FP64_Vector3* source, BGC_FP32_Vector3* destination);
|
extern inline void bgc_fp64_vector3_convert_to_fp32(BGC_FP32_Vector3* destination, const BGC_FP64_Vector3* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_swap(BGC_FP32_Vector3* vector1, BGC_FP32_Vector3* vector2);
|
extern inline void bgc_fp32_vector3_swap(BGC_FP32_Vector3* vector1, BGC_FP32_Vector3* vector2);
|
||||||
extern inline void bgc_fp64_vector3_swap(BGC_FP64_Vector3* vector1, BGC_FP64_Vector3* vector2);
|
extern inline void bgc_fp64_vector3_swap(BGC_FP64_Vector3* vector1, BGC_FP64_Vector3* vector2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_add(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, BGC_FP32_Vector3* sum);
|
extern inline void bgc_fp32_vector3_add(BGC_FP32_Vector3* sum, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2);
|
||||||
extern inline void bgc_fp64_vector3_add(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, BGC_FP64_Vector3* sum);
|
extern inline void bgc_fp64_vector3_add(BGC_FP64_Vector3* sum, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_add_scaled(const BGC_FP32_Vector3* basic_vector, const BGC_FP32_Vector3* scalable_vector, const float scale, BGC_FP32_Vector3* sum);
|
extern inline void bgc_fp32_vector3_add_scaled(BGC_FP32_Vector3* sum, const BGC_FP32_Vector3* basic_vector, const BGC_FP32_Vector3* scalable_vector, const float scale);
|
||||||
extern inline void bgc_fp64_vector3_add_scaled(const BGC_FP64_Vector3* basic_vector, const BGC_FP64_Vector3* scalable_vector, const double scale, BGC_FP64_Vector3* sum);
|
extern inline void bgc_fp64_vector3_add_scaled(BGC_FP64_Vector3* sum, const BGC_FP64_Vector3* basic_vector, const BGC_FP64_Vector3* scalable_vector, const double scale);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_subtract(const BGC_FP32_Vector3* minuend, const BGC_FP32_Vector3* subtrahend, BGC_FP32_Vector3* difference);
|
extern inline void bgc_fp32_vector3_subtract(BGC_FP32_Vector3* difference, const BGC_FP32_Vector3* minuend, const BGC_FP32_Vector3* subtrahend);
|
||||||
extern inline void bgc_fp64_vector3_subtract(const BGC_FP64_Vector3* minuend, const BGC_FP64_Vector3* subtrahend, BGC_FP64_Vector3* difference);
|
extern inline void bgc_fp64_vector3_subtract(BGC_FP64_Vector3* difference, const BGC_FP64_Vector3* minuend, const BGC_FP64_Vector3* subtrahend);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_multiply(const BGC_FP32_Vector3* multiplicand, const float multiplier, BGC_FP32_Vector3* product);
|
extern inline void bgc_fp32_vector3_multiply(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* multiplicand, const float multiplier);
|
||||||
extern inline void bgc_fp64_vector3_multiply(const BGC_FP64_Vector3* multiplicand, const double multiplier, BGC_FP64_Vector3* product);
|
extern inline void bgc_fp64_vector3_multiply(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* multiplicand, const double multiplier);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_divide(const BGC_FP32_Vector3* dividend, const float divisor, BGC_FP32_Vector3* quotient);
|
extern inline void bgc_fp32_vector3_divide(BGC_FP32_Vector3* quotient, const BGC_FP32_Vector3* dividend, const float divisor);
|
||||||
extern inline void bgc_fp64_vector3_divide(const BGC_FP64_Vector3* dividend, const double divisor, BGC_FP64_Vector3* quotient);
|
extern inline void bgc_fp64_vector3_divide(BGC_FP64_Vector3* quotient, const BGC_FP64_Vector3* dividend, const double divisor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_get_middle2(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, BGC_FP32_Vector3* middle);
|
extern inline void bgc_fp32_vector3_get_mean2(BGC_FP32_Vector3* mean, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2);
|
||||||
extern inline void bgc_fp64_vector3_get_middle2(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, BGC_FP64_Vector3* middle);
|
extern inline void bgc_fp64_vector3_get_mean2(BGC_FP64_Vector3* mean, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_get_middle3(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3, BGC_FP32_Vector3* middle);
|
extern inline void bgc_fp32_vector3_get_mean3(BGC_FP32_Vector3* mean, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3);
|
||||||
extern inline void bgc_fp64_vector3_get_middle3(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3, BGC_FP64_Vector3* middle);
|
extern inline void bgc_fp64_vector3_get_mean3(BGC_FP64_Vector3* mean, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_interpolate(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const float phase, BGC_FP32_Vector3* interpolation);
|
extern inline void bgc_fp32_vector3_interpolate(BGC_FP32_Vector3* interpolation, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const float phase);
|
||||||
extern inline void bgc_fp64_vector3_interpolate(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const double phase, BGC_FP64_Vector3* interpolation);
|
extern inline void bgc_fp64_vector3_interpolate(BGC_FP64_Vector3* interpolation, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const double phase);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_revert(BGC_FP32_Vector3* vector);
|
extern inline void bgc_fp32_vector3_revert(BGC_FP32_Vector3* vector);
|
||||||
extern inline void bgc_fp64_vector3_revert(BGC_FP64_Vector3* vector);
|
extern inline void bgc_fp64_vector3_revert(BGC_FP64_Vector3* vector);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_get_reverse(const BGC_FP32_Vector3* vector, BGC_FP32_Vector3* reverse);
|
extern inline void bgc_fp32_vector3_get_reverse(BGC_FP32_Vector3* reverse, const BGC_FP32_Vector3* vector);
|
||||||
extern inline void bgc_fp64_vector3_get_reverse(const BGC_FP64_Vector3* vector, BGC_FP64_Vector3* reverse);
|
extern inline void bgc_fp64_vector3_get_reverse(BGC_FP64_Vector3* reverse, const BGC_FP64_Vector3* vector);
|
||||||
|
|
||||||
extern inline int bgc_fp32_vector3_normalize(BGC_FP32_Vector3* vector);
|
extern inline int bgc_fp32_vector3_normalize(BGC_FP32_Vector3* vector);
|
||||||
extern inline int bgc_fp64_vector3_normalize(BGC_FP64_Vector3* vector);
|
extern inline int bgc_fp64_vector3_normalize(BGC_FP64_Vector3* vector);
|
||||||
|
|
||||||
extern inline int bgc_fp32_vector3_get_normalized(const BGC_FP32_Vector3* vector, BGC_FP32_Vector3* normalized);
|
extern inline int bgc_fp32_vector3_get_normalized(BGC_FP32_Vector3* normalized, const BGC_FP32_Vector3* vector);
|
||||||
extern inline int bgc_fp64_vector3_get_normalized(const BGC_FP64_Vector3* vector, BGC_FP64_Vector3* normalized);
|
extern inline int bgc_fp64_vector3_get_normalized(BGC_FP64_Vector3* normalized, const BGC_FP64_Vector3* vector);
|
||||||
|
|
||||||
extern inline float bgc_fp32_vector3_get_dot_product(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2);
|
extern inline float bgc_fp32_vector3_get_dot_product(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2);
|
||||||
extern inline double bgc_fp64_vector3_get_dot_product(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2);
|
extern inline double bgc_fp64_vector3_get_dot_product(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2);
|
||||||
|
|
@ -69,11 +69,11 @@ extern inline double bgc_fp64_vector3_get_dot_product(const BGC_FP64_Vector3* ve
|
||||||
extern inline float bgc_fp32_vector3_get_triple_product(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3);
|
extern inline float bgc_fp32_vector3_get_triple_product(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3);
|
||||||
extern inline double bgc_fp64_vector3_get_triple_product(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3);
|
extern inline double bgc_fp64_vector3_get_triple_product(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_get_cross_product(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, BGC_FP32_Vector3* result);
|
extern inline void bgc_fp32_vector3_get_cross_product(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2);
|
||||||
extern inline void bgc_fp64_vector3_get_cross_product(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, BGC_FP64_Vector3* result);
|
extern inline void bgc_fp64_vector3_get_cross_product(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2);
|
||||||
|
|
||||||
extern inline void bgc_fp32_vector3_get_double_cross(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3, BGC_FP32_Vector3* result);
|
extern inline void bgc_fp32_vector3_get_double_cross(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3);
|
||||||
extern inline void bgc_fp64_vector3_get_double_cross(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3, BGC_FP64_Vector3* result);
|
extern inline void bgc_fp64_vector3_get_double_cross(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3);
|
||||||
|
|
||||||
extern inline float bgc_fp32_vector3_get_square_distance(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2);
|
extern inline float bgc_fp32_vector3_get_square_distance(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2);
|
||||||
extern inline double bgc_fp64_vector3_get_square_distance(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2);
|
extern inline double bgc_fp64_vector3_get_square_distance(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2);
|
||||||
|
|
@ -116,7 +116,7 @@ float bgc_fp32_vector3_get_angle(const BGC_FP32_Vector3* vector1, const BGC_FP32
|
||||||
|
|
||||||
BGC_FP32_Vector3 cross_product;
|
BGC_FP32_Vector3 cross_product;
|
||||||
|
|
||||||
bgc_fp32_vector3_get_cross_product(vector1, vector2, &cross_product);
|
bgc_fp32_vector3_get_cross_product(&cross_product, vector1, vector2);
|
||||||
|
|
||||||
const float scalar = bgc_fp32_vector3_get_dot_product(vector1, vector2);
|
const float scalar = bgc_fp32_vector3_get_dot_product(vector1, vector2);
|
||||||
|
|
||||||
|
|
@ -143,7 +143,7 @@ double bgc_fp64_vector3_get_angle(const BGC_FP64_Vector3* vector1, const BGC_FP6
|
||||||
|
|
||||||
BGC_FP64_Vector3 cross_product;
|
BGC_FP64_Vector3 cross_product;
|
||||||
|
|
||||||
bgc_fp64_vector3_get_cross_product(vector1, vector2, &cross_product);
|
bgc_fp64_vector3_get_cross_product(&cross_product, vector1, vector2);
|
||||||
|
|
||||||
const double scalar = bgc_fp64_vector3_get_dot_product(vector1, vector2);
|
const double scalar = bgc_fp64_vector3_get_dot_product(vector1, vector2);
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -36,14 +36,14 @@ inline void bgc_fp64_vector3_reset(BGC_FP64_Vector3* vector)
|
||||||
|
|
||||||
// ==================== Set ===================== //
|
// ==================== Set ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_make(const float x1, const float x2, const float x3, BGC_FP32_Vector3* destination)
|
inline void bgc_fp32_vector3_make(BGC_FP32_Vector3* destination, const float x1, const float x2, const float x3)
|
||||||
{
|
{
|
||||||
destination->x1 = x1;
|
destination->x1 = x1;
|
||||||
destination->x2 = x2;
|
destination->x2 = x2;
|
||||||
destination->x3 = x3;
|
destination->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_make(const double x1, const double x2, const double x3, BGC_FP64_Vector3* destination)
|
inline void bgc_fp64_vector3_make(BGC_FP64_Vector3* destination, const double x1, const double x2, const double x3)
|
||||||
{
|
{
|
||||||
destination->x1 = x1;
|
destination->x1 = x1;
|
||||||
destination->x2 = x2;
|
destination->x2 = x2;
|
||||||
|
|
@ -96,14 +96,14 @@ inline int bgc_fp64_vector3_is_unit(const BGC_FP64_Vector3* vector)
|
||||||
|
|
||||||
// ==================== Copy ==================== //
|
// ==================== Copy ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_copy(const BGC_FP32_Vector3* source, BGC_FP32_Vector3* destination)
|
inline void bgc_fp32_vector3_copy(BGC_FP32_Vector3* destination, const BGC_FP32_Vector3* source)
|
||||||
{
|
{
|
||||||
destination->x1 = source->x1;
|
destination->x1 = source->x1;
|
||||||
destination->x2 = source->x2;
|
destination->x2 = source->x2;
|
||||||
destination->x3 = source->x3;
|
destination->x3 = source->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_copy(const BGC_FP64_Vector3* source, BGC_FP64_Vector3* destination)
|
inline void bgc_fp64_vector3_copy(BGC_FP64_Vector3* destination, const BGC_FP64_Vector3* source)
|
||||||
{
|
{
|
||||||
destination->x1 = source->x1;
|
destination->x1 = source->x1;
|
||||||
destination->x2 = source->x2;
|
destination->x2 = source->x2;
|
||||||
|
|
@ -144,30 +144,30 @@ inline void bgc_fp64_vector3_swap(BGC_FP64_Vector3* vector1, BGC_FP64_Vector3* v
|
||||||
|
|
||||||
// ================== Convert =================== //
|
// ================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_convert_to_fp32(const BGC_FP64_Vector3* source, BGC_FP32_Vector3* destination)
|
inline void bgc_fp32_vector3_convert_to_fp64(BGC_FP64_Vector3* destination, const BGC_FP32_Vector3* source)
|
||||||
{
|
|
||||||
destination->x1 = (float)source->x1;
|
|
||||||
destination->x2 = (float)source->x2;
|
|
||||||
destination->x3 = (float)source->x3;
|
|
||||||
}
|
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_convert_to_fp64(const BGC_FP32_Vector3* source, BGC_FP64_Vector3* destination)
|
|
||||||
{
|
{
|
||||||
destination->x1 = source->x1;
|
destination->x1 = source->x1;
|
||||||
destination->x2 = source->x2;
|
destination->x2 = source->x2;
|
||||||
destination->x3 = source->x3;
|
destination->x3 = source->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
inline void bgc_fp64_vector3_convert_to_fp32(BGC_FP32_Vector3* destination, const BGC_FP64_Vector3* source)
|
||||||
|
{
|
||||||
|
destination->x1 = (float)source->x1;
|
||||||
|
destination->x2 = (float)source->x2;
|
||||||
|
destination->x3 = (float)source->x3;
|
||||||
|
}
|
||||||
|
|
||||||
// ==================== Add ===================== //
|
// ==================== Add ===================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_add(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, BGC_FP32_Vector3* sum)
|
inline void bgc_fp32_vector3_add(BGC_FP32_Vector3* sum, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||||
{
|
{
|
||||||
sum->x1 = vector1->x1 + vector2->x1;
|
sum->x1 = vector1->x1 + vector2->x1;
|
||||||
sum->x2 = vector1->x2 + vector2->x2;
|
sum->x2 = vector1->x2 + vector2->x2;
|
||||||
sum->x3 = vector1->x3 + vector2->x3;
|
sum->x3 = vector1->x3 + vector2->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_add(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, BGC_FP64_Vector3* sum)
|
inline void bgc_fp64_vector3_add(BGC_FP64_Vector3* sum, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||||
{
|
{
|
||||||
sum->x1 = vector1->x1 + vector2->x1;
|
sum->x1 = vector1->x1 + vector2->x1;
|
||||||
sum->x2 = vector1->x2 + vector2->x2;
|
sum->x2 = vector1->x2 + vector2->x2;
|
||||||
|
|
@ -176,14 +176,14 @@ inline void bgc_fp64_vector3_add(const BGC_FP64_Vector3* vector1, const BGC_FP64
|
||||||
|
|
||||||
// ================= Add scaled ================= //
|
// ================= Add scaled ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_add_scaled(const BGC_FP32_Vector3* basic_vector, const BGC_FP32_Vector3* scalable_vector, const float scale, BGC_FP32_Vector3* sum)
|
inline void bgc_fp32_vector3_add_scaled(BGC_FP32_Vector3* sum, const BGC_FP32_Vector3* basic_vector, const BGC_FP32_Vector3* scalable_vector, const float scale)
|
||||||
{
|
{
|
||||||
sum->x1 = basic_vector->x1 + scalable_vector->x1 * scale;
|
sum->x1 = basic_vector->x1 + scalable_vector->x1 * scale;
|
||||||
sum->x2 = basic_vector->x2 + scalable_vector->x2 * scale;
|
sum->x2 = basic_vector->x2 + scalable_vector->x2 * scale;
|
||||||
sum->x3 = basic_vector->x3 + scalable_vector->x3 * scale;
|
sum->x3 = basic_vector->x3 + scalable_vector->x3 * scale;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_add_scaled(const BGC_FP64_Vector3* basic_vector, const BGC_FP64_Vector3* scalable_vector, const double scale, BGC_FP64_Vector3* sum)
|
inline void bgc_fp64_vector3_add_scaled(BGC_FP64_Vector3* sum, const BGC_FP64_Vector3* basic_vector, const BGC_FP64_Vector3* scalable_vector, const double scale)
|
||||||
{
|
{
|
||||||
sum->x1 = basic_vector->x1 + scalable_vector->x1 * scale;
|
sum->x1 = basic_vector->x1 + scalable_vector->x1 * scale;
|
||||||
sum->x2 = basic_vector->x2 + scalable_vector->x2 * scale;
|
sum->x2 = basic_vector->x2 + scalable_vector->x2 * scale;
|
||||||
|
|
@ -192,14 +192,14 @@ inline void bgc_fp64_vector3_add_scaled(const BGC_FP64_Vector3* basic_vector, co
|
||||||
|
|
||||||
// ================== Subtract ================== //
|
// ================== Subtract ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_subtract(const BGC_FP32_Vector3* minuend, const BGC_FP32_Vector3* subtrahend, BGC_FP32_Vector3* difference)
|
inline void bgc_fp32_vector3_subtract(BGC_FP32_Vector3* difference, const BGC_FP32_Vector3* minuend, const BGC_FP32_Vector3* subtrahend)
|
||||||
{
|
{
|
||||||
difference->x1 = minuend->x1 - subtrahend->x1;
|
difference->x1 = minuend->x1 - subtrahend->x1;
|
||||||
difference->x2 = minuend->x2 - subtrahend->x2;
|
difference->x2 = minuend->x2 - subtrahend->x2;
|
||||||
difference->x3 = minuend->x3 - subtrahend->x3;
|
difference->x3 = minuend->x3 - subtrahend->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_subtract(const BGC_FP64_Vector3* minuend, const BGC_FP64_Vector3* subtrahend, BGC_FP64_Vector3* difference)
|
inline void bgc_fp64_vector3_subtract(BGC_FP64_Vector3* difference, const BGC_FP64_Vector3* minuend, const BGC_FP64_Vector3* subtrahend)
|
||||||
{
|
{
|
||||||
difference->x1 = minuend->x1 - subtrahend->x1;
|
difference->x1 = minuend->x1 - subtrahend->x1;
|
||||||
difference->x2 = minuend->x2 - subtrahend->x2;
|
difference->x2 = minuend->x2 - subtrahend->x2;
|
||||||
|
|
@ -208,14 +208,14 @@ inline void bgc_fp64_vector3_subtract(const BGC_FP64_Vector3* minuend, const BGC
|
||||||
|
|
||||||
// ================== Multiply ================== //
|
// ================== Multiply ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_multiply(const BGC_FP32_Vector3* multiplicand, const float multiplier, BGC_FP32_Vector3* product)
|
inline void bgc_fp32_vector3_multiply(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* multiplicand, const float multiplier)
|
||||||
{
|
{
|
||||||
product->x1 = multiplicand->x1 * multiplier;
|
product->x1 = multiplicand->x1 * multiplier;
|
||||||
product->x2 = multiplicand->x2 * multiplier;
|
product->x2 = multiplicand->x2 * multiplier;
|
||||||
product->x3 = multiplicand->x3 * multiplier;
|
product->x3 = multiplicand->x3 * multiplier;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_multiply(const BGC_FP64_Vector3* multiplicand, const double multiplier, BGC_FP64_Vector3* product)
|
inline void bgc_fp64_vector3_multiply(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* multiplicand, const double multiplier)
|
||||||
{
|
{
|
||||||
product->x1 = multiplicand->x1 * multiplier;
|
product->x1 = multiplicand->x1 * multiplier;
|
||||||
product->x2 = multiplicand->x2 * multiplier;
|
product->x2 = multiplicand->x2 * multiplier;
|
||||||
|
|
@ -224,51 +224,51 @@ inline void bgc_fp64_vector3_multiply(const BGC_FP64_Vector3* multiplicand, cons
|
||||||
|
|
||||||
// =================== Divide =================== //
|
// =================== Divide =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_divide(const BGC_FP32_Vector3* dividend, const float divisor, BGC_FP32_Vector3* quotient)
|
inline void bgc_fp32_vector3_divide(BGC_FP32_Vector3* quotient, const BGC_FP32_Vector3* dividend, const float divisor)
|
||||||
{
|
{
|
||||||
bgc_fp32_vector3_multiply(dividend, 1.0f / divisor, quotient);
|
bgc_fp32_vector3_multiply(quotient, dividend, 1.0f / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_divide(const BGC_FP64_Vector3* dividend, const double divisor, BGC_FP64_Vector3* quotient)
|
inline void bgc_fp64_vector3_divide(BGC_FP64_Vector3* quotient, const BGC_FP64_Vector3* dividend, const double divisor)
|
||||||
{
|
{
|
||||||
bgc_fp64_vector3_multiply(dividend, 1.0 / divisor, quotient);
|
bgc_fp64_vector3_multiply(quotient, dividend, 1.0 / divisor);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================== Average2 ================== //
|
// ================== Average2 ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_get_middle2(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, BGC_FP32_Vector3* middle)
|
inline void bgc_fp32_vector3_get_mean2(BGC_FP32_Vector3* mean, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||||
{
|
{
|
||||||
middle->x1 = (vector1->x1 + vector2->x1) * 0.5f;
|
mean->x1 = (vector1->x1 + vector2->x1) * 0.5f;
|
||||||
middle->x2 = (vector1->x2 + vector2->x2) * 0.5f;
|
mean->x2 = (vector1->x2 + vector2->x2) * 0.5f;
|
||||||
middle->x3 = (vector1->x3 + vector2->x3) * 0.5f;
|
mean->x3 = (vector1->x3 + vector2->x3) * 0.5f;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_get_middle2(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, BGC_FP64_Vector3* middle)
|
inline void bgc_fp64_vector3_get_mean2(BGC_FP64_Vector3* mean, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||||
{
|
{
|
||||||
middle->x1 = (vector1->x1 + vector2->x1) * 0.5;
|
mean->x1 = (vector1->x1 + vector2->x1) * 0.5;
|
||||||
middle->x2 = (vector1->x2 + vector2->x2) * 0.5;
|
mean->x2 = (vector1->x2 + vector2->x2) * 0.5;
|
||||||
middle->x3 = (vector1->x3 + vector2->x3) * 0.5;
|
mean->x3 = (vector1->x3 + vector2->x3) * 0.5;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================== Average3 ================== //
|
// ================== Average3 ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_get_middle3(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3, BGC_FP32_Vector3* middle)
|
inline void bgc_fp32_vector3_get_mean3(BGC_FP32_Vector3* mean, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3)
|
||||||
{
|
{
|
||||||
middle->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP32_ONE_THIRD;
|
mean->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP32_ONE_THIRD;
|
||||||
middle->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP32_ONE_THIRD;
|
mean->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP32_ONE_THIRD;
|
||||||
middle->x3 = (vector1->x3 + vector2->x3 + vector3->x3) * BGC_FP32_ONE_THIRD;
|
mean->x3 = (vector1->x3 + vector2->x3 + vector3->x3) * BGC_FP32_ONE_THIRD;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_get_middle3(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3, BGC_FP64_Vector3* middle)
|
inline void bgc_fp64_vector3_get_mean3(BGC_FP64_Vector3* mean, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3)
|
||||||
{
|
{
|
||||||
middle->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP64_ONE_THIRD;
|
mean->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP64_ONE_THIRD;
|
||||||
middle->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP64_ONE_THIRD;
|
mean->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP64_ONE_THIRD;
|
||||||
middle->x3 = (vector1->x3 + vector2->x3 + vector3->x3) * BGC_FP64_ONE_THIRD;
|
mean->x3 = (vector1->x3 + vector2->x3 + vector3->x3) * BGC_FP64_ONE_THIRD;
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Linear =================== //
|
// =================== Linear =================== //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_interpolate(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const float phase, BGC_FP32_Vector3* interpolation)
|
inline void bgc_fp32_vector3_interpolate(BGC_FP32_Vector3* interpolation, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const float phase)
|
||||||
{
|
{
|
||||||
const float counter_phase = 1.0f - phase;
|
const float counter_phase = 1.0f - phase;
|
||||||
|
|
||||||
|
|
@ -277,7 +277,7 @@ inline void bgc_fp32_vector3_interpolate(const BGC_FP32_Vector3* vector1, const
|
||||||
interpolation->x3 = vector1->x3 * counter_phase + vector2->x3 * phase;
|
interpolation->x3 = vector1->x3 * counter_phase + vector2->x3 * phase;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_interpolate(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const double phase, BGC_FP64_Vector3* interpolation)
|
inline void bgc_fp64_vector3_interpolate(BGC_FP64_Vector3* interpolation, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const double phase)
|
||||||
{
|
{
|
||||||
const double counter_phase = 1.0 - phase;
|
const double counter_phase = 1.0 - phase;
|
||||||
|
|
||||||
|
|
@ -302,14 +302,14 @@ inline void bgc_fp64_vector3_revert(BGC_FP64_Vector3* vector)
|
||||||
vector->x3 = -vector->x3;
|
vector->x3 = -vector->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_get_reverse(const BGC_FP32_Vector3* vector, BGC_FP32_Vector3* reverse)
|
inline void bgc_fp32_vector3_get_reverse(BGC_FP32_Vector3* reverse, const BGC_FP32_Vector3* vector)
|
||||||
{
|
{
|
||||||
reverse->x1 = -vector->x1;
|
reverse->x1 = -vector->x1;
|
||||||
reverse->x2 = -vector->x2;
|
reverse->x2 = -vector->x2;
|
||||||
reverse->x3 = -vector->x3;
|
reverse->x3 = -vector->x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_get_reverse(const BGC_FP64_Vector3* vector, BGC_FP64_Vector3* reverse)
|
inline void bgc_fp64_vector3_get_reverse(BGC_FP64_Vector3* reverse, const BGC_FP64_Vector3* vector)
|
||||||
{
|
{
|
||||||
reverse->x1 = -vector->x1;
|
reverse->x1 = -vector->x1;
|
||||||
reverse->x2 = -vector->x2;
|
reverse->x2 = -vector->x2;
|
||||||
|
|
@ -360,12 +360,12 @@ inline int bgc_fp64_vector3_normalize(BGC_FP64_Vector3* vector)
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp32_vector3_get_normalized(const BGC_FP32_Vector3* vector, BGC_FP32_Vector3* normalized)
|
inline int bgc_fp32_vector3_get_normalized(BGC_FP32_Vector3* normalized, const BGC_FP32_Vector3* vector)
|
||||||
{
|
{
|
||||||
const float square_modulus = bgc_fp32_vector3_get_square_modulus(vector);
|
const float square_modulus = bgc_fp32_vector3_get_square_modulus(vector);
|
||||||
|
|
||||||
if (bgc_fp32_is_square_unit(square_modulus)) {
|
if (bgc_fp32_is_square_unit(square_modulus)) {
|
||||||
bgc_fp32_vector3_copy(vector, normalized);
|
bgc_fp32_vector3_copy(normalized, vector);
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -374,16 +374,16 @@ inline int bgc_fp32_vector3_get_normalized(const BGC_FP32_Vector3* vector, BGC_F
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp32_vector3_multiply(vector, sqrtf(1.0f / square_modulus), normalized);
|
bgc_fp32_vector3_multiply(normalized, vector, sqrtf(1.0f / square_modulus));
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline int bgc_fp64_vector3_get_normalized(const BGC_FP64_Vector3* vector, BGC_FP64_Vector3* normalized)
|
inline int bgc_fp64_vector3_get_normalized(BGC_FP64_Vector3* normalized, const BGC_FP64_Vector3* vector)
|
||||||
{
|
{
|
||||||
const double square_modulus = bgc_fp64_vector3_get_square_modulus(vector);
|
const double square_modulus = bgc_fp64_vector3_get_square_modulus(vector);
|
||||||
|
|
||||||
if (bgc_fp64_is_square_unit(square_modulus)) {
|
if (bgc_fp64_is_square_unit(square_modulus)) {
|
||||||
bgc_fp64_vector3_copy(vector, normalized);
|
bgc_fp64_vector3_copy(normalized, vector);
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -392,7 +392,7 @@ inline int bgc_fp64_vector3_get_normalized(const BGC_FP64_Vector3* vector, BGC_F
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp64_vector3_multiply(vector, sqrt(1.0 / square_modulus), normalized);
|
bgc_fp64_vector3_multiply(normalized, vector, sqrt(1.0 / square_modulus));
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -426,7 +426,7 @@ inline double bgc_fp64_vector3_get_triple_product(const BGC_FP64_Vector3* vector
|
||||||
|
|
||||||
// =============== Cross Product ================ //
|
// =============== Cross Product ================ //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_get_cross_product(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, BGC_FP32_Vector3* product)
|
inline void bgc_fp32_vector3_get_cross_product(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||||
{
|
{
|
||||||
const float x1 = vector1->x2 * vector2->x3 - vector1->x3 * vector2->x2;
|
const float x1 = vector1->x2 * vector2->x3 - vector1->x3 * vector2->x2;
|
||||||
const float x2 = vector1->x3 * vector2->x1 - vector1->x1 * vector2->x3;
|
const float x2 = vector1->x3 * vector2->x1 - vector1->x1 * vector2->x3;
|
||||||
|
|
@ -437,7 +437,7 @@ inline void bgc_fp32_vector3_get_cross_product(const BGC_FP32_Vector3* vector1,
|
||||||
product->x3 = x3;
|
product->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_get_cross_product(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, BGC_FP64_Vector3* product)
|
inline void bgc_fp64_vector3_get_cross_product(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||||
{
|
{
|
||||||
const double x1 = vector1->x2 * vector2->x3 - vector1->x3 * vector2->x2;
|
const double x1 = vector1->x2 * vector2->x3 - vector1->x3 * vector2->x2;
|
||||||
const double x2 = vector1->x3 * vector2->x1 - vector1->x1 * vector2->x3;
|
const double x2 = vector1->x3 * vector2->x1 - vector1->x1 * vector2->x3;
|
||||||
|
|
@ -450,7 +450,7 @@ inline void bgc_fp64_vector3_get_cross_product(const BGC_FP64_Vector3* vector1,
|
||||||
|
|
||||||
// ============ Double Cross Product ============ //
|
// ============ Double Cross Product ============ //
|
||||||
|
|
||||||
inline void bgc_fp32_vector3_get_double_cross(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3, BGC_FP32_Vector3* product)
|
inline void bgc_fp32_vector3_get_double_cross(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3)
|
||||||
{
|
{
|
||||||
const float ac = bgc_fp32_vector3_get_dot_product(vector1, vector3);
|
const float ac = bgc_fp32_vector3_get_dot_product(vector1, vector3);
|
||||||
const float ab = bgc_fp32_vector3_get_dot_product(vector1, vector2);
|
const float ab = bgc_fp32_vector3_get_dot_product(vector1, vector2);
|
||||||
|
|
@ -460,7 +460,7 @@ inline void bgc_fp32_vector3_get_double_cross(const BGC_FP32_Vector3* vector1, c
|
||||||
product->x3 = vector2->x3 * ac - vector3->x3 * ab;
|
product->x3 = vector2->x3 * ac - vector3->x3 * ab;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_vector3_get_double_cross(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3, BGC_FP64_Vector3* product)
|
inline void bgc_fp64_vector3_get_double_cross(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3)
|
||||||
{
|
{
|
||||||
const double ac = bgc_fp64_vector3_get_dot_product(vector1, vector3);
|
const double ac = bgc_fp64_vector3_get_dot_product(vector1, vector3);
|
||||||
const double ab = bgc_fp64_vector3_get_dot_product(vector1, vector2);
|
const double ab = bgc_fp64_vector3_get_dot_product(vector1, vector2);
|
||||||
|
|
@ -561,7 +561,7 @@ inline int bgc_fp32_vector3_are_parallel(const BGC_FP32_Vector3* vector1, const
|
||||||
|
|
||||||
BGC_FP32_Vector3 product;
|
BGC_FP32_Vector3 product;
|
||||||
|
|
||||||
bgc_fp32_vector3_get_cross_product(vector1, vector2, &product);
|
bgc_fp32_vector3_get_cross_product(&product, vector1, vector2);
|
||||||
|
|
||||||
return bgc_fp32_vector3_get_square_modulus(&product) <= BGC_FP32_SQUARE_EPSYLON * square_modulus1 * square_modulus2;
|
return bgc_fp32_vector3_get_square_modulus(&product) <= BGC_FP32_SQUARE_EPSYLON * square_modulus1 * square_modulus2;
|
||||||
}
|
}
|
||||||
|
|
@ -577,7 +577,7 @@ inline int bgc_fp64_vector3_are_parallel(const BGC_FP64_Vector3* vector1, const
|
||||||
|
|
||||||
BGC_FP64_Vector3 product;
|
BGC_FP64_Vector3 product;
|
||||||
|
|
||||||
bgc_fp64_vector3_get_cross_product(vector1, vector2, &product);
|
bgc_fp64_vector3_get_cross_product(&product, vector1, vector2);
|
||||||
|
|
||||||
return bgc_fp64_vector3_get_square_modulus(&product) <= BGC_FP64_SQUARE_EPSYLON * square_modulus1 * square_modulus2;
|
return bgc_fp64_vector3_get_square_modulus(&product) <= BGC_FP64_SQUARE_EPSYLON * square_modulus1 * square_modulus2;
|
||||||
}
|
}
|
||||||
|
|
@ -633,7 +633,7 @@ inline int bgc_fp32_vector3_get_attitude(const BGC_FP32_Vector3* vector1, const
|
||||||
|
|
||||||
BGC_FP32_Vector3 product;
|
BGC_FP32_Vector3 product;
|
||||||
|
|
||||||
bgc_fp32_vector3_get_cross_product(vector1, vector2, &product);
|
bgc_fp32_vector3_get_cross_product(&product, vector1, vector2);
|
||||||
|
|
||||||
if (bgc_fp32_vector3_get_square_modulus(&product) > square_limit) {
|
if (bgc_fp32_vector3_get_square_modulus(&product) > square_limit) {
|
||||||
return BGC_ATTITUDE_ANY;
|
return BGC_ATTITUDE_ANY;
|
||||||
|
|
@ -661,7 +661,7 @@ inline int bgc_fp64_vector3_get_attitude(const BGC_FP64_Vector3* vector1, const
|
||||||
|
|
||||||
BGC_FP64_Vector3 product;
|
BGC_FP64_Vector3 product;
|
||||||
|
|
||||||
bgc_fp64_vector3_get_cross_product(vector1, vector2, &product);
|
bgc_fp64_vector3_get_cross_product(&product, vector1, vector2);
|
||||||
|
|
||||||
if (bgc_fp64_vector3_get_square_modulus(&product) > square_limit) {
|
if (bgc_fp64_vector3_get_square_modulus(&product) > square_limit) {
|
||||||
return BGC_ATTITUDE_ANY;
|
return BGC_ATTITUDE_ANY;
|
||||||
|
|
|
||||||
|
|
@ -10,14 +10,14 @@ const BGC_FP64_Versor BGC_FP64_IDLE_VERSOR = { 1.0, 0.0, 0.0, 0.0 };
|
||||||
extern inline void bgc_fp32_versor_reset(BGC_FP32_Versor* versor);
|
extern inline void bgc_fp32_versor_reset(BGC_FP32_Versor* versor);
|
||||||
extern inline void bgc_fp64_versor_reset(BGC_FP64_Versor* versor);
|
extern inline void bgc_fp64_versor_reset(BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_make(const float s0, const float x1, const float x2, const float x3, BGC_FP32_Versor* versor);
|
extern inline void bgc_fp32_versor_make(BGC_FP32_Versor* versor, const float s0, const float x1, const float x2, const float x3);
|
||||||
extern inline void bgc_fp64_versor_make(const double s0, const double x1, const double x2, const double x3, BGC_FP64_Versor* versor);
|
extern inline void bgc_fp64_versor_make(BGC_FP64_Versor* versor, const double s0, const double x1, const double x2, const double x3);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_make_for_rotation(const BGC_FP32_Rotation3* rotation, BGC_FP32_Versor* result);
|
extern inline void bgc_fp32_versor_make_for_rotation(BGC_FP32_Versor* versor, const BGC_FP32_Rotation3* rotation);
|
||||||
extern inline void bgc_fp64_versor_make_for_rotation(const BGC_FP64_Rotation3* rotation, BGC_FP64_Versor* result);
|
extern inline void bgc_fp64_versor_make_for_rotation(BGC_FP64_Versor* versor, const BGC_FP64_Rotation3* rotation);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_copy(const BGC_FP32_Versor* source, BGC_FP32_Versor* destination);
|
extern inline void bgc_fp32_versor_copy(BGC_FP32_Versor* destination, const BGC_FP32_Versor* source);
|
||||||
extern inline void bgc_fp64_versor_copy(const BGC_FP64_Versor* source, BGC_FP64_Versor* destination);
|
extern inline void bgc_fp64_versor_copy(BGC_FP64_Versor* destination, const BGC_FP64_Versor* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_swap(BGC_FP32_Versor* versor1, BGC_FP32_Versor* versor2);
|
extern inline void bgc_fp32_versor_swap(BGC_FP32_Versor* versor1, BGC_FP32_Versor* versor2);
|
||||||
extern inline void bgc_fp64_versor_swap(BGC_FP64_Versor* versor1, BGC_FP64_Versor* versor2);
|
extern inline void bgc_fp64_versor_swap(BGC_FP64_Versor* versor1, BGC_FP64_Versor* versor2);
|
||||||
|
|
@ -25,50 +25,50 @@ extern inline void bgc_fp64_versor_swap(BGC_FP64_Versor* versor1, BGC_FP64_Verso
|
||||||
extern inline int bgc_fp32_versor_is_idle(const BGC_FP32_Versor* versor);
|
extern inline int bgc_fp32_versor_is_idle(const BGC_FP32_Versor* versor);
|
||||||
extern inline int bgc_fp64_versor_is_idle(const BGC_FP64_Versor* versor);
|
extern inline int bgc_fp64_versor_is_idle(const BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
extern inline void bgc_fp64_versor_convert_to_fp32(const BGC_FP64_Versor* source, BGC_FP32_Versor* destination);
|
extern inline void bgc_fp32_versor_convert_to_fp64(BGC_FP64_Versor* destination, const BGC_FP32_Versor* source);
|
||||||
extern inline void bgc_fp32_versor_convert_to_fp64(const BGC_FP32_Versor* source, BGC_FP64_Versor* destination);
|
extern inline void bgc_fp64_versor_convert_to_fp32(BGC_FP32_Versor* destination, const BGC_FP64_Versor* source);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_shorten(BGC_FP32_Versor* versor);
|
extern inline void bgc_fp32_versor_shorten(BGC_FP32_Versor* versor);
|
||||||
extern inline void bgc_fp64_versor_shorten(BGC_FP64_Versor* versor);
|
extern inline void bgc_fp64_versor_shorten(BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_get_shortened(const BGC_FP32_Versor* versor, BGC_FP32_Versor* shortened);
|
extern inline void bgc_fp32_versor_get_shortened(BGC_FP32_Versor* shortened, const BGC_FP32_Versor* versor);
|
||||||
extern inline void bgc_fp64_versor_get_shortened(const BGC_FP64_Versor* versor, BGC_FP64_Versor* shortened);
|
extern inline void bgc_fp64_versor_get_shortened(BGC_FP64_Versor* shortened, const BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_alternate(BGC_FP32_Versor* versor);
|
extern inline void bgc_fp32_versor_alternate(BGC_FP32_Versor* versor);
|
||||||
extern inline void bgc_fp64_versor_alternate(BGC_FP64_Versor* versor);
|
extern inline void bgc_fp64_versor_alternate(BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_get_alternative(const BGC_FP32_Versor* versor, BGC_FP32_Versor* opposite);
|
extern inline void bgc_fp32_versor_get_alternative(BGC_FP32_Versor* alternative, const BGC_FP32_Versor* versor);
|
||||||
extern inline void bgc_fp64_versor_get_alternative(const BGC_FP64_Versor* versor, BGC_FP64_Versor* opposite);
|
extern inline void bgc_fp64_versor_get_alternative(BGC_FP64_Versor* alternative, const BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_revert(BGC_FP32_Versor* versor);
|
extern inline void bgc_fp32_versor_revert(BGC_FP32_Versor* versor);
|
||||||
extern inline void bgc_fp64_versor_revert(BGC_FP64_Versor* versor);
|
extern inline void bgc_fp64_versor_revert(BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_get_reverse(const BGC_FP32_Versor* versor, BGC_FP32_Versor* inverse);
|
extern inline void bgc_fp32_versor_get_reverse(BGC_FP32_Versor* inverse, const BGC_FP32_Versor* versor);
|
||||||
extern inline void bgc_fp64_versor_get_reverse(const BGC_FP64_Versor* versor, BGC_FP64_Versor* inverse);
|
extern inline void bgc_fp64_versor_get_reverse(BGC_FP64_Versor* inverse, const BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_combine(const BGC_FP32_Versor* first, const BGC_FP32_Versor* second, BGC_FP32_Versor* result);
|
extern inline void bgc_fp32_versor_combine(BGC_FP32_Versor* combination, const BGC_FP32_Versor* first, const BGC_FP32_Versor* second);
|
||||||
extern inline void bgc_fp64_versor_combine(const BGC_FP64_Versor* first, const BGC_FP64_Versor* second, BGC_FP64_Versor* result);
|
extern inline void bgc_fp64_versor_combine(BGC_FP64_Versor* combination, const BGC_FP64_Versor* first, const BGC_FP64_Versor* second);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_combine3(const BGC_FP32_Versor* first, const BGC_FP32_Versor* second, const BGC_FP32_Versor* third, BGC_FP32_Versor* result);
|
extern inline void bgc_fp32_versor_combine3(BGC_FP32_Versor* combination, const BGC_FP32_Versor* first, const BGC_FP32_Versor* second, const BGC_FP32_Versor* third);
|
||||||
extern inline void bgc_fp64_versor_combine3(const BGC_FP64_Versor* first, const BGC_FP64_Versor* second, const BGC_FP64_Versor* third, BGC_FP64_Versor* result);
|
extern inline void bgc_fp64_versor_combine3(BGC_FP64_Versor* combination, const BGC_FP64_Versor* first, const BGC_FP64_Versor* second, const BGC_FP64_Versor* third);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_exclude(const BGC_FP32_Versor* base, const BGC_FP32_Versor* excludant, BGC_FP32_Versor* difference);
|
extern inline void bgc_fp32_versor_exclude(BGC_FP32_Versor* difference, const BGC_FP32_Versor* base, const BGC_FP32_Versor* excludant);
|
||||||
extern inline void bgc_fp64_versor_exclude(const BGC_FP64_Versor* base, const BGC_FP64_Versor* excludant, BGC_FP64_Versor* difference);
|
extern inline void bgc_fp64_versor_exclude(BGC_FP64_Versor* difference, const BGC_FP64_Versor* base, const BGC_FP64_Versor* excludant);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_get_rotation_matrix(const BGC_FP32_Versor* versor, BGC_FP32_Matrix3x3* matrix);
|
extern inline void bgc_fp32_versor_get_rotation_matrix(BGC_FP32_Matrix3x3* matrix, const BGC_FP32_Versor* versor);
|
||||||
extern inline void bgc_fp64_versor_get_rotation_matrix(const BGC_FP64_Versor* versor, BGC_FP64_Matrix3x3* matrix);
|
extern inline void bgc_fp64_versor_get_rotation_matrix(BGC_FP64_Matrix3x3* matrix, const BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_get_reverse_matrix(const BGC_FP32_Versor* versor, BGC_FP32_Matrix3x3* matrix);
|
extern inline void bgc_fp32_versor_get_reverse_matrix(BGC_FP32_Matrix3x3* matrix, const BGC_FP32_Versor* versor);
|
||||||
extern inline void bgc_fp64_versor_get_reverse_matrix(const BGC_FP64_Versor* versor, BGC_FP64_Matrix3x3* matrix);
|
extern inline void bgc_fp64_versor_get_reverse_matrix(BGC_FP64_Matrix3x3* matrix, const BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_get_both_matrices(const BGC_FP32_Versor* versor, BGC_FP32_Matrix3x3* rotation, BGC_FP32_Matrix3x3* reverse);
|
extern inline void bgc_fp32_versor_get_both_matrices(BGC_FP32_Matrix3x3* rotation, BGC_FP32_Matrix3x3* reverse, const BGC_FP32_Versor* versor);
|
||||||
extern inline void bgc_fp64_versor_get_both_matrices(const BGC_FP64_Versor* versor, BGC_FP64_Matrix3x3* rotation, BGC_FP64_Matrix3x3* reverse);
|
extern inline void bgc_fp64_versor_get_both_matrices(BGC_FP64_Matrix3x3* rotation, BGC_FP64_Matrix3x3* reverse, const BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_turn_vector(const BGC_FP32_Versor* versor, const BGC_FP32_Vector3* vector, BGC_FP32_Vector3* result);
|
extern inline void bgc_fp32_versor_turn_vector(BGC_FP32_Vector3* turned_vector, const BGC_FP32_Versor* versor, const BGC_FP32_Vector3* vector);
|
||||||
extern inline void bgc_fp64_versor_turn_vector(const BGC_FP64_Versor* versor, const BGC_FP64_Vector3* vector, BGC_FP64_Vector3* result);
|
extern inline void bgc_fp64_versor_turn_vector(BGC_FP64_Vector3* turned_vector, const BGC_FP64_Versor* versor, const BGC_FP64_Vector3* vector);
|
||||||
|
|
||||||
extern inline void bgc_fp32_versor_turn_vector_back(const BGC_FP32_Versor* versor, const BGC_FP32_Vector3* vector, BGC_FP32_Vector3* result);
|
extern inline void bgc_fp32_versor_turn_vector_back(BGC_FP32_Vector3* turned_vector, const BGC_FP32_Versor* versor, const BGC_FP32_Vector3* vector);
|
||||||
extern inline void bgc_fp64_versor_turn_vector_back(const BGC_FP64_Versor* versor, const BGC_FP64_Vector3* vector, BGC_FP64_Vector3* result);
|
extern inline void bgc_fp64_versor_turn_vector_back(BGC_FP64_Vector3* turned_vector, const BGC_FP64_Versor* versor, const BGC_FP64_Vector3* vector);
|
||||||
|
|
||||||
extern inline int bgc_fp32_versor_are_close(const BGC_FP32_Versor* versor1, const BGC_FP32_Versor* versor2);
|
extern inline int bgc_fp32_versor_are_close(const BGC_FP32_Versor* versor1, const BGC_FP32_Versor* versor2);
|
||||||
extern inline int bgc_fp64_versor_are_close(const BGC_FP64_Versor* versor1, const BGC_FP64_Versor* versor2);
|
extern inline int bgc_fp64_versor_are_close(const BGC_FP64_Versor* versor1, const BGC_FP64_Versor* versor2);
|
||||||
|
|
@ -117,12 +117,12 @@ void _bgc_fp64_versor_normalize(BGC_FP64_Versor* versor)
|
||||||
|
|
||||||
// ================== Set Turn ================== //
|
// ================== Set Turn ================== //
|
||||||
|
|
||||||
void bgc_fp32_versor_make_for_turn(const float x1, const float x2, const float x3, const float angle, const int unit, BGC_FP32_Versor* result)
|
void bgc_fp32_versor_make_for_turn(BGC_FP32_Versor* versor, const float x1, const float x2, const float x3, const float angle, const int unit)
|
||||||
{
|
{
|
||||||
const float square_vector = x1 * x1 + x2 * x2 + x3 * x3;
|
const float square_vector = x1 * x1 + x2 * x2 + x3 * x3;
|
||||||
|
|
||||||
if (square_vector <= BGC_FP32_SQUARE_EPSYLON) {
|
if (square_vector <= BGC_FP32_SQUARE_EPSYLON) {
|
||||||
bgc_fp32_versor_reset(result);
|
bgc_fp32_versor_reset(versor);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -131,21 +131,21 @@ void bgc_fp32_versor_make_for_turn(const float x1, const float x2, const float x
|
||||||
const float sine = sinf(half_angle);
|
const float sine = sinf(half_angle);
|
||||||
|
|
||||||
if (bgc_fp32_is_zero(sine)) {
|
if (bgc_fp32_is_zero(sine)) {
|
||||||
bgc_fp32_versor_reset(result);
|
bgc_fp32_versor_reset(versor);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
const float multiplier = sine / sqrtf(square_vector);
|
const float multiplier = sine / sqrtf(square_vector);
|
||||||
|
|
||||||
bgc_fp32_versor_make(cosf(half_angle), x1 * multiplier, x2 * multiplier, x3 * multiplier, result);
|
bgc_fp32_versor_make(versor, cosf(half_angle), x1 * multiplier, x2 * multiplier, x3 * multiplier);
|
||||||
}
|
}
|
||||||
|
|
||||||
void bgc_fp64_versor_make_for_turn(const double x1, const double x2, const double x3, const double angle, const int unit, BGC_FP64_Versor* result)
|
void bgc_fp64_versor_make_for_turn(BGC_FP64_Versor* versor, const double x1, const double x2, const double x3, const double angle, const int unit)
|
||||||
{
|
{
|
||||||
const double square_vector = x1 * x1 + x2 * x2 + x3 * x3;
|
const double square_vector = x1 * x1 + x2 * x2 + x3 * x3;
|
||||||
|
|
||||||
if (square_vector <= BGC_FP64_SQUARE_EPSYLON) {
|
if (square_vector <= BGC_FP64_SQUARE_EPSYLON) {
|
||||||
bgc_fp64_versor_reset(result);
|
bgc_fp64_versor_reset(versor);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -154,22 +154,22 @@ void bgc_fp64_versor_make_for_turn(const double x1, const double x2, const doubl
|
||||||
const double sine = sin(half_angle);
|
const double sine = sin(half_angle);
|
||||||
|
|
||||||
if (bgc_fp64_is_zero(sine)) {
|
if (bgc_fp64_is_zero(sine)) {
|
||||||
bgc_fp64_versor_reset(result);
|
bgc_fp64_versor_reset(versor);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
const double multiplier = sine / sqrt(square_vector);
|
const double multiplier = sine / sqrt(square_vector);
|
||||||
|
|
||||||
bgc_fp64_versor_make(cos(half_angle), x1 * multiplier, x2 * multiplier, x3 * multiplier, result);
|
bgc_fp64_versor_make(versor, cos(half_angle), x1 * multiplier, x2 * multiplier, x3 * multiplier);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ========= Make Direction Difference ========== //
|
// ========= Make Direction Difference ========== //
|
||||||
|
|
||||||
static int _bgc_fp32_versor_make_direction_turn(const BGC_FP32_Vector3* start, const BGC_FP32_Vector3* end, const float square_modulus_product, BGC_FP32_Versor* result)
|
static int _bgc_fp32_versor_make_direction_turn(BGC_FP32_Versor* versor, const BGC_FP32_Vector3* start, const BGC_FP32_Vector3* end, const float square_modulus_product)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector3 orthogonal_axis;
|
BGC_FP32_Vector3 orthogonal_axis;
|
||||||
|
|
||||||
bgc_fp32_vector3_get_cross_product(start, end, &orthogonal_axis);
|
bgc_fp32_vector3_get_cross_product(&orthogonal_axis, start, end);
|
||||||
|
|
||||||
const float scalar_product = bgc_fp32_vector3_get_dot_product(start, end);
|
const float scalar_product = bgc_fp32_vector3_get_dot_product(start, end);
|
||||||
const float square_modulus = bgc_fp32_vector3_get_square_modulus(&orthogonal_axis);
|
const float square_modulus = bgc_fp32_vector3_get_square_modulus(&orthogonal_axis);
|
||||||
|
|
@ -181,7 +181,7 @@ static int _bgc_fp32_versor_make_direction_turn(const BGC_FP32_Vector3* start, c
|
||||||
|
|
||||||
const float multiplier = sinf(angle) * sqrtf(1.0f / square_modulus);
|
const float multiplier = sinf(angle) * sqrtf(1.0f / square_modulus);
|
||||||
|
|
||||||
bgc_fp32_versor_make(cosf(angle), orthogonal_axis.x1 * multiplier, orthogonal_axis.x2 * multiplier, orthogonal_axis.x3 * multiplier, result);
|
bgc_fp32_versor_make(versor, cosf(angle), orthogonal_axis.x1 * multiplier, orthogonal_axis.x2 * multiplier, orthogonal_axis.x3 * multiplier);
|
||||||
return BGC_SOME_TURN;
|
return BGC_SOME_TURN;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -189,15 +189,15 @@ static int _bgc_fp32_versor_make_direction_turn(const BGC_FP32_Vector3* start, c
|
||||||
return BGC_OPPOSITE;
|
return BGC_OPPOSITE;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp32_versor_reset(result);
|
bgc_fp32_versor_reset(versor);
|
||||||
return BGC_ZERO_TURN;
|
return BGC_ZERO_TURN;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int _bgc_fp64_versor_make_direction_turn(const BGC_FP64_Vector3* start, const BGC_FP64_Vector3* end, const double square_modulus_product, BGC_FP64_Versor* result)
|
static int _bgc_fp64_versor_make_direction_turn(BGC_FP64_Versor* versor, const BGC_FP64_Vector3* start, const BGC_FP64_Vector3* end, const double square_modulus_product)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector3 orthogonal_axis;
|
BGC_FP64_Vector3 orthogonal_axis;
|
||||||
|
|
||||||
bgc_fp64_vector3_get_cross_product(start, end, &orthogonal_axis);
|
bgc_fp64_vector3_get_cross_product(&orthogonal_axis, start, end);
|
||||||
|
|
||||||
const double scalar_product = bgc_fp64_vector3_get_dot_product(start, end);
|
const double scalar_product = bgc_fp64_vector3_get_dot_product(start, end);
|
||||||
const double square_modulus = bgc_fp64_vector3_get_square_modulus(&orthogonal_axis);
|
const double square_modulus = bgc_fp64_vector3_get_square_modulus(&orthogonal_axis);
|
||||||
|
|
@ -209,7 +209,7 @@ static int _bgc_fp64_versor_make_direction_turn(const BGC_FP64_Vector3* start, c
|
||||||
|
|
||||||
const double multiplier = sin(angle) * sqrt(1.0f / square_modulus);
|
const double multiplier = sin(angle) * sqrt(1.0f / square_modulus);
|
||||||
|
|
||||||
bgc_fp64_versor_make(cos(angle), orthogonal_axis.x1 * multiplier, orthogonal_axis.x2 * multiplier, orthogonal_axis.x3 * multiplier, result);
|
bgc_fp64_versor_make(versor, cos(angle), orthogonal_axis.x1 * multiplier, orthogonal_axis.x2 * multiplier, orthogonal_axis.x3 * multiplier);
|
||||||
return BGC_SOME_TURN;
|
return BGC_SOME_TURN;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -217,34 +217,34 @@ static int _bgc_fp64_versor_make_direction_turn(const BGC_FP64_Vector3* start, c
|
||||||
return BGC_OPPOSITE;
|
return BGC_OPPOSITE;
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp64_versor_reset(result);
|
bgc_fp64_versor_reset(versor);
|
||||||
return BGC_ZERO_TURN;
|
return BGC_ZERO_TURN;
|
||||||
}
|
}
|
||||||
|
|
||||||
int bgc_fp32_versor_make_direction_difference(const BGC_FP32_Vector3* start, const BGC_FP32_Vector3* end, BGC_FP32_Versor* result)
|
int bgc_fp32_versor_make_direction_difference(BGC_FP32_Versor* versor, const BGC_FP32_Vector3* start, const BGC_FP32_Vector3* end)
|
||||||
{
|
{
|
||||||
const float start_square_modulus = bgc_fp32_vector3_get_square_modulus(start);
|
const float start_square_modulus = bgc_fp32_vector3_get_square_modulus(start);
|
||||||
const float end_square_modulus = bgc_fp32_vector3_get_square_modulus(end);
|
const float end_square_modulus = bgc_fp32_vector3_get_square_modulus(end);
|
||||||
|
|
||||||
if (start_square_modulus <= BGC_FP32_SQUARE_EPSYLON || end_square_modulus <= BGC_FP32_SQUARE_EPSYLON) {
|
if (start_square_modulus <= BGC_FP32_SQUARE_EPSYLON || end_square_modulus <= BGC_FP32_SQUARE_EPSYLON) {
|
||||||
bgc_fp32_versor_reset(result);
|
bgc_fp32_versor_reset(versor);
|
||||||
return BGC_ZERO_TURN;
|
return BGC_ZERO_TURN;
|
||||||
}
|
}
|
||||||
|
|
||||||
return _bgc_fp32_versor_make_direction_turn(start, end, start_square_modulus * end_square_modulus, result);
|
return _bgc_fp32_versor_make_direction_turn(versor, start, end, start_square_modulus * end_square_modulus);
|
||||||
}
|
}
|
||||||
|
|
||||||
int bgc_fp64_versor_make_direction_difference(const BGC_FP64_Vector3* start, const BGC_FP64_Vector3* end, BGC_FP64_Versor* result)
|
int bgc_fp64_versor_make_direction_difference(BGC_FP64_Versor* versor, const BGC_FP64_Vector3* start, const BGC_FP64_Vector3* end)
|
||||||
{
|
{
|
||||||
const double start_square_modulus = bgc_fp64_vector3_get_square_modulus(start);
|
const double start_square_modulus = bgc_fp64_vector3_get_square_modulus(start);
|
||||||
const double end_square_modulus = bgc_fp64_vector3_get_square_modulus(end);
|
const double end_square_modulus = bgc_fp64_vector3_get_square_modulus(end);
|
||||||
|
|
||||||
if (start_square_modulus <= BGC_FP64_SQUARE_EPSYLON || end_square_modulus <= BGC_FP64_SQUARE_EPSYLON) {
|
if (start_square_modulus <= BGC_FP64_SQUARE_EPSYLON || end_square_modulus <= BGC_FP64_SQUARE_EPSYLON) {
|
||||||
bgc_fp64_versor_reset(result);
|
bgc_fp64_versor_reset(versor);
|
||||||
return BGC_ZERO_TURN;
|
return BGC_ZERO_TURN;
|
||||||
}
|
}
|
||||||
|
|
||||||
return _bgc_fp64_versor_make_direction_turn(start, end, start_square_modulus * end_square_modulus, result);
|
return _bgc_fp64_versor_make_direction_turn(versor, start, end, start_square_modulus * end_square_modulus);
|
||||||
}
|
}
|
||||||
|
|
||||||
// =============== Set Directions =============== //
|
// =============== Set Directions =============== //
|
||||||
|
|
@ -290,17 +290,17 @@ static int _bgc_fp64_versor_validate_basis(const double primary_square_modulus,
|
||||||
}
|
}
|
||||||
|
|
||||||
int bgc_fp32_versor_make_basis_difference(
|
int bgc_fp32_versor_make_basis_difference(
|
||||||
|
BGC_FP32_Versor* versor,
|
||||||
const BGC_FP32_Vector3* initial_primary_direction,
|
const BGC_FP32_Vector3* initial_primary_direction,
|
||||||
const BGC_FP32_Vector3* initial_auxiliary_direction,
|
const BGC_FP32_Vector3* initial_auxiliary_direction,
|
||||||
const BGC_FP32_Vector3* final_primary_direction,
|
const BGC_FP32_Vector3* final_primary_direction,
|
||||||
const BGC_FP32_Vector3* final_auxiliary_direction,
|
const BGC_FP32_Vector3* final_auxiliary_direction
|
||||||
BGC_FP32_Versor* result
|
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
BGC_FP32_Vector3 initial_orthogonal_direction, turned_orthogonal_direction, final_orthogonal_direction;
|
BGC_FP32_Vector3 initial_orthogonal_direction, turned_orthogonal_direction, final_orthogonal_direction;
|
||||||
|
|
||||||
// Step 1: Validate initial basis:
|
// Step 1: Validate initial basis:
|
||||||
bgc_fp32_vector3_get_cross_product(initial_primary_direction, initial_auxiliary_direction, &initial_orthogonal_direction);
|
bgc_fp32_vector3_get_cross_product(&initial_orthogonal_direction, initial_primary_direction, initial_auxiliary_direction);
|
||||||
|
|
||||||
const float initial_primary_square_modulus = bgc_fp32_vector3_get_square_modulus(initial_primary_direction);
|
const float initial_primary_square_modulus = bgc_fp32_vector3_get_square_modulus(initial_primary_direction);
|
||||||
const float initial_auxiliary_square_modulus = bgc_fp32_vector3_get_square_modulus(initial_auxiliary_direction);
|
const float initial_auxiliary_square_modulus = bgc_fp32_vector3_get_square_modulus(initial_auxiliary_direction);
|
||||||
|
|
@ -313,7 +313,7 @@ int bgc_fp32_versor_make_basis_difference(
|
||||||
}
|
}
|
||||||
|
|
||||||
// Step 1: Validate final basis:
|
// Step 1: Validate final basis:
|
||||||
bgc_fp32_vector3_get_cross_product(final_primary_direction, final_auxiliary_direction, &final_orthogonal_direction);
|
bgc_fp32_vector3_get_cross_product(&final_orthogonal_direction, final_primary_direction, final_auxiliary_direction);
|
||||||
|
|
||||||
const float final_primary_square_modulus = bgc_fp32_vector3_get_square_modulus(final_primary_direction);
|
const float final_primary_square_modulus = bgc_fp32_vector3_get_square_modulus(final_primary_direction);
|
||||||
const float final_auxiliary_square_modulus = bgc_fp32_vector3_get_square_modulus(final_auxiliary_direction);
|
const float final_auxiliary_square_modulus = bgc_fp32_vector3_get_square_modulus(final_auxiliary_direction);
|
||||||
|
|
@ -326,52 +326,52 @@ int bgc_fp32_versor_make_basis_difference(
|
||||||
}
|
}
|
||||||
|
|
||||||
// Step 3: Validate normalize orthogonal vectors:
|
// Step 3: Validate normalize orthogonal vectors:
|
||||||
bgc_fp32_vector3_divide(&initial_orthogonal_direction, sqrtf(initial_orthogonal_square_modulus), &initial_orthogonal_direction);
|
bgc_fp32_vector3_divide(&initial_orthogonal_direction, &initial_orthogonal_direction, sqrtf(initial_orthogonal_square_modulus));
|
||||||
bgc_fp32_vector3_divide(&final_orthogonal_direction, sqrtf(final_orthogonal_square_modulus), &final_orthogonal_direction);
|
bgc_fp32_vector3_divide(&final_orthogonal_direction, &final_orthogonal_direction, sqrtf(final_orthogonal_square_modulus));
|
||||||
|
|
||||||
BGC_FP32_Versor turn1, turn2;
|
BGC_FP32_Versor turn1, turn2;
|
||||||
|
|
||||||
// Step 4: Find turn1
|
// Step 4: Find turn1
|
||||||
int turn1_code = _bgc_fp32_versor_make_direction_turn(initial_primary_direction, final_primary_direction, initial_primary_square_modulus * final_primary_square_modulus, &turn1);
|
int turn1_code = _bgc_fp32_versor_make_direction_turn(&turn1, initial_primary_direction, final_primary_direction, initial_primary_square_modulus * final_primary_square_modulus);
|
||||||
|
|
||||||
if (turn1_code == BGC_OPPOSITE) {
|
if (turn1_code == BGC_OPPOSITE) {
|
||||||
bgc_fp32_versor_make(0.0f, initial_orthogonal_direction.x1, initial_orthogonal_direction.x2, initial_orthogonal_direction.x3, &turn1);
|
bgc_fp32_versor_make(&turn1, 0.0f, initial_orthogonal_direction.x1, initial_orthogonal_direction.x2, initial_orthogonal_direction.x3);
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp32_versor_turn_vector(&turn1, &initial_orthogonal_direction, &turned_orthogonal_direction);
|
bgc_fp32_versor_turn_vector(&turned_orthogonal_direction, &turn1, &initial_orthogonal_direction);
|
||||||
|
|
||||||
// Step 5: Find turn2:
|
// Step 5: Find turn2:
|
||||||
int turn2_code = _bgc_fp32_versor_make_direction_turn(&turned_orthogonal_direction, &final_orthogonal_direction, 1.0f, &turn2);
|
int turn2_code = _bgc_fp32_versor_make_direction_turn(&turn2, &turned_orthogonal_direction, &final_orthogonal_direction, 1.0f);
|
||||||
|
|
||||||
if (turn2_code == BGC_OPPOSITE) {
|
if (turn2_code == BGC_OPPOSITE) {
|
||||||
const float turn2_multiplier = sqrtf(1.0f / final_primary_square_modulus);
|
const float turn2_multiplier = sqrtf(1.0f / final_primary_square_modulus);
|
||||||
|
|
||||||
bgc_fp32_versor_make(0.0f,
|
bgc_fp32_versor_make(&turn2,
|
||||||
|
0.0f,
|
||||||
final_primary_direction->x1 * turn2_multiplier,
|
final_primary_direction->x1 * turn2_multiplier,
|
||||||
final_primary_direction->x2 * turn2_multiplier,
|
final_primary_direction->x2 * turn2_multiplier,
|
||||||
final_primary_direction->x3 * turn2_multiplier,
|
final_primary_direction->x3 * turn2_multiplier
|
||||||
&turn2
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Step 6: Combine turn1 and turn2:
|
// Step 6: Combine turn1 and turn2:
|
||||||
bgc_fp32_versor_combine(&turn1, &turn2, result);
|
bgc_fp32_versor_combine(versor, &turn1, &turn2);
|
||||||
|
|
||||||
return BGC_SUCCESS;
|
return BGC_SUCCESS;
|
||||||
}
|
}
|
||||||
|
|
||||||
int bgc_fp64_versor_make_basis_difference(
|
int bgc_fp64_versor_make_basis_difference(
|
||||||
|
BGC_FP64_Versor* versor,
|
||||||
const BGC_FP64_Vector3* initial_primary_direction,
|
const BGC_FP64_Vector3* initial_primary_direction,
|
||||||
const BGC_FP64_Vector3* initial_auxiliary_direction,
|
const BGC_FP64_Vector3* initial_auxiliary_direction,
|
||||||
const BGC_FP64_Vector3* final_primary_direction,
|
const BGC_FP64_Vector3* final_primary_direction,
|
||||||
const BGC_FP64_Vector3* final_auxiliary_direction,
|
const BGC_FP64_Vector3* final_auxiliary_direction
|
||||||
BGC_FP64_Versor* result
|
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
BGC_FP64_Vector3 initial_orthogonal_direction, turned_orthogonal_direction, final_orthogonal_direction;
|
BGC_FP64_Vector3 initial_orthogonal_direction, turned_orthogonal_direction, final_orthogonal_direction;
|
||||||
|
|
||||||
// Step 1: Validate initial basis:
|
// Step 1: Validate initial basis:
|
||||||
bgc_fp64_vector3_get_cross_product(initial_primary_direction, initial_auxiliary_direction, &initial_orthogonal_direction);
|
bgc_fp64_vector3_get_cross_product(&initial_orthogonal_direction, initial_primary_direction, initial_auxiliary_direction);
|
||||||
|
|
||||||
const double initial_primary_square_modulus = bgc_fp64_vector3_get_square_modulus(initial_primary_direction);
|
const double initial_primary_square_modulus = bgc_fp64_vector3_get_square_modulus(initial_primary_direction);
|
||||||
const double initial_auxiliary_square_modulus = bgc_fp64_vector3_get_square_modulus(initial_auxiliary_direction);
|
const double initial_auxiliary_square_modulus = bgc_fp64_vector3_get_square_modulus(initial_auxiliary_direction);
|
||||||
|
|
@ -384,7 +384,7 @@ int bgc_fp64_versor_make_basis_difference(
|
||||||
}
|
}
|
||||||
|
|
||||||
// Step 1: Validate final basis:
|
// Step 1: Validate final basis:
|
||||||
bgc_fp64_vector3_get_cross_product(final_primary_direction, final_auxiliary_direction, &final_orthogonal_direction);
|
bgc_fp64_vector3_get_cross_product(&final_orthogonal_direction, final_primary_direction, final_auxiliary_direction);
|
||||||
|
|
||||||
const double final_primary_square_modulus = bgc_fp64_vector3_get_square_modulus(final_primary_direction);
|
const double final_primary_square_modulus = bgc_fp64_vector3_get_square_modulus(final_primary_direction);
|
||||||
const double final_auxiliary_square_modulus = bgc_fp64_vector3_get_square_modulus(final_auxiliary_direction);
|
const double final_auxiliary_square_modulus = bgc_fp64_vector3_get_square_modulus(final_auxiliary_direction);
|
||||||
|
|
@ -397,43 +397,43 @@ int bgc_fp64_versor_make_basis_difference(
|
||||||
}
|
}
|
||||||
|
|
||||||
// Step 3: Validate normalize orthogonal vectors:
|
// Step 3: Validate normalize orthogonal vectors:
|
||||||
bgc_fp64_vector3_divide(&initial_orthogonal_direction, sqrt(initial_orthogonal_square_modulus), &initial_orthogonal_direction);
|
bgc_fp64_vector3_divide(&initial_orthogonal_direction, &initial_orthogonal_direction, sqrt(initial_orthogonal_square_modulus));
|
||||||
bgc_fp64_vector3_divide(&final_orthogonal_direction, sqrt(final_orthogonal_square_modulus), &final_orthogonal_direction);
|
bgc_fp64_vector3_divide(&final_orthogonal_direction, &final_orthogonal_direction, sqrt(final_orthogonal_square_modulus));
|
||||||
|
|
||||||
BGC_FP64_Versor turn1, turn2;
|
BGC_FP64_Versor turn1, turn2;
|
||||||
|
|
||||||
// Step 4: Find turn1
|
// Step 4: Find turn1
|
||||||
int turn1_code = _bgc_fp64_versor_make_direction_turn(initial_primary_direction, final_primary_direction, initial_primary_square_modulus * final_primary_square_modulus, &turn1);
|
int turn1_code = _bgc_fp64_versor_make_direction_turn(&turn1, initial_primary_direction, final_primary_direction, initial_primary_square_modulus * final_primary_square_modulus);
|
||||||
|
|
||||||
if (turn1_code == BGC_OPPOSITE) {
|
if (turn1_code == BGC_OPPOSITE) {
|
||||||
bgc_fp64_versor_make(0.0, initial_orthogonal_direction.x1, initial_orthogonal_direction.x2, initial_orthogonal_direction.x3, &turn1);
|
bgc_fp64_versor_make(&turn1, 0.0, initial_orthogonal_direction.x1, initial_orthogonal_direction.x2, initial_orthogonal_direction.x3);
|
||||||
}
|
}
|
||||||
|
|
||||||
bgc_fp64_versor_turn_vector(&turn1, &initial_orthogonal_direction, &turned_orthogonal_direction);
|
bgc_fp64_versor_turn_vector(&turned_orthogonal_direction, &turn1, &initial_orthogonal_direction);
|
||||||
|
|
||||||
// Step 5: Find turn2:
|
// Step 5: Find turn2:
|
||||||
int turn2_code = _bgc_fp64_versor_make_direction_turn(&turned_orthogonal_direction, &final_orthogonal_direction, 1.0f, &turn2);
|
int turn2_code = _bgc_fp64_versor_make_direction_turn(&turn2, &turned_orthogonal_direction, &final_orthogonal_direction, 1.0f);
|
||||||
|
|
||||||
if (turn2_code == BGC_OPPOSITE) {
|
if (turn2_code == BGC_OPPOSITE) {
|
||||||
const double turn2_multiplier = sqrt(1.0 / final_primary_square_modulus);
|
const double turn2_multiplier = sqrt(1.0 / final_primary_square_modulus);
|
||||||
|
|
||||||
bgc_fp64_versor_make(0.0,
|
bgc_fp64_versor_make(&turn2,
|
||||||
|
0.0,
|
||||||
final_primary_direction->x1 * turn2_multiplier,
|
final_primary_direction->x1 * turn2_multiplier,
|
||||||
final_primary_direction->x2 * turn2_multiplier,
|
final_primary_direction->x2 * turn2_multiplier,
|
||||||
final_primary_direction->x3 * turn2_multiplier,
|
final_primary_direction->x3 * turn2_multiplier
|
||||||
&turn2
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Step 6: Combine turn1 and turn2:
|
// Step 6: Combine turn1 and turn2:
|
||||||
bgc_fp64_versor_combine(&turn1, &turn2, result);
|
bgc_fp64_versor_combine(versor, &turn1, &turn2);
|
||||||
|
|
||||||
return BGC_SUCCESS;
|
return BGC_SUCCESS;
|
||||||
}
|
}
|
||||||
|
|
||||||
// =============== Get Exponation =============== //
|
// =============== Get Exponation =============== //
|
||||||
|
|
||||||
void bgc_fp32_versor_get_exponation(const BGC_FP32_Versor* base, const float exponent, BGC_FP32_Versor* power)
|
void bgc_fp32_versor_get_exponation(BGC_FP32_Versor* power, const BGC_FP32_Versor* base, const float exponent)
|
||||||
{
|
{
|
||||||
const float square_vector = base->_x1 * base->_x1 + base->_x2 * base->_x2 + base->_x3 * base->_x3;
|
const float square_vector = base->_x1 * base->_x1 + base->_x2 * base->_x2 + base->_x3 * base->_x3;
|
||||||
|
|
||||||
|
|
@ -448,10 +448,10 @@ void bgc_fp32_versor_get_exponation(const BGC_FP32_Versor* base, const float exp
|
||||||
|
|
||||||
const float multiplier = sinf(angle) / vector_modulus;
|
const float multiplier = sinf(angle) / vector_modulus;
|
||||||
|
|
||||||
bgc_fp32_versor_make(cosf(angle), base->_x1 * multiplier, base->_x2 * multiplier, base->_x3 * multiplier, power);
|
bgc_fp32_versor_make(power, cosf(angle), base->_x1 * multiplier, base->_x2 * multiplier, base->_x3 * multiplier);
|
||||||
}
|
}
|
||||||
|
|
||||||
void bgc_fp64_versor_get_exponation(const BGC_FP64_Versor* base, const double exponent, BGC_FP64_Versor* power)
|
void bgc_fp64_versor_get_exponation(BGC_FP64_Versor* power, const BGC_FP64_Versor* base, const double exponent)
|
||||||
{
|
{
|
||||||
const double square_vector = base->_x1 * base->_x1 + base->_x2 * base->_x2 + base->_x3 * base->_x3;
|
const double square_vector = base->_x1 * base->_x1 + base->_x2 * base->_x2 + base->_x3 * base->_x3;
|
||||||
|
|
||||||
|
|
@ -466,12 +466,12 @@ void bgc_fp64_versor_get_exponation(const BGC_FP64_Versor* base, const double ex
|
||||||
|
|
||||||
const double multiplier = sin(angle) / vector_modulus;
|
const double multiplier = sin(angle) / vector_modulus;
|
||||||
|
|
||||||
bgc_fp64_versor_make(cos(angle), base->_x1 * multiplier, base->_x2 * multiplier, base->_x3 * multiplier, power);
|
bgc_fp64_versor_make(power, cos(angle), base->_x1 * multiplier, base->_x2 * multiplier, base->_x3 * multiplier);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============ Sphere Interpolation ============ //
|
// ============ Sphere Interpolation ============ //
|
||||||
|
|
||||||
void bgc_fp32_versor_spherically_interpolate(const BGC_FP32_Versor* start, const BGC_FP32_Versor* end, const float phase, BGC_FP32_Versor* result)
|
void bgc_fp32_versor_spherically_interpolate(BGC_FP32_Versor* interpolation, const BGC_FP32_Versor* start, const BGC_FP32_Versor* end, const float phase)
|
||||||
{
|
{
|
||||||
const float delta_s0 = (end->_s0 * start->_s0 + end->_x1 * start->_x1) + (end->_x2 * start->_x2 + end->_x3 * start->_x3);
|
const float delta_s0 = (end->_s0 * start->_s0 + end->_x1 * start->_x1) + (end->_x2 * start->_x2 + end->_x3 * start->_x3);
|
||||||
const float delta_x1 = (end->_x1 * start->_s0 + end->_x3 * start->_x2) - (end->_s0 * start->_x1 + end->_x2 * start->_x3);
|
const float delta_x1 = (end->_x1 * start->_s0 + end->_x3 * start->_x2) - (end->_s0 * start->_x1 + end->_x2 * start->_x3);
|
||||||
|
|
@ -481,8 +481,8 @@ void bgc_fp32_versor_spherically_interpolate(const BGC_FP32_Versor* start, const
|
||||||
const float square_vector = delta_x1 * delta_x1 + delta_x2 * delta_x2 + delta_x3 * delta_x3;
|
const float square_vector = delta_x1 * delta_x1 + delta_x2 * delta_x2 + delta_x3 * delta_x3;
|
||||||
|
|
||||||
// square_vector != square_vector means checking for NaN value at square_vector
|
// square_vector != square_vector means checking for NaN value at square_vector
|
||||||
if (square_vector <= BGC_FP32_SQUARE_EPSYLON || square_vector != square_vector) {
|
if (square_vector <= BGC_FP32_SQUARE_EPSYLON || isnan(square_vector)) {
|
||||||
bgc_fp32_versor_copy(end, result);
|
bgc_fp32_versor_copy(interpolation, end);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -498,15 +498,15 @@ void bgc_fp32_versor_spherically_interpolate(const BGC_FP32_Versor* start, const
|
||||||
|
|
||||||
// Combining of starting orientation with the turning
|
// Combining of starting orientation with the turning
|
||||||
bgc_fp32_versor_make(
|
bgc_fp32_versor_make(
|
||||||
|
interpolation,
|
||||||
(turn_s0 * start->_s0 - turn_x1 * start->_x1) - (turn_x2 * start->_x2 + turn_x3 * start->_x3),
|
(turn_s0 * start->_s0 - turn_x1 * start->_x1) - (turn_x2 * start->_x2 + turn_x3 * start->_x3),
|
||||||
(turn_x1 * start->_s0 + turn_s0 * start->_x1) - (turn_x3 * start->_x2 - turn_x2 * start->_x3),
|
(turn_x1 * start->_s0 + turn_s0 * start->_x1) - (turn_x3 * start->_x2 - turn_x2 * start->_x3),
|
||||||
(turn_x2 * start->_s0 + turn_s0 * start->_x2) - (turn_x1 * start->_x3 - turn_x3 * start->_x1),
|
(turn_x2 * start->_s0 + turn_s0 * start->_x2) - (turn_x1 * start->_x3 - turn_x3 * start->_x1),
|
||||||
(turn_x3 * start->_s0 + turn_s0 * start->_x3) - (turn_x2 * start->_x1 - turn_x1 * start->_x2),
|
(turn_x3 * start->_s0 + turn_s0 * start->_x3) - (turn_x2 * start->_x1 - turn_x1 * start->_x2)
|
||||||
result
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
void bgc_fp64_versor_spherically_interpolate(const BGC_FP64_Versor* start, const BGC_FP64_Versor* end, const double phase, BGC_FP64_Versor* result)
|
void bgc_fp64_versor_spherically_interpolate(BGC_FP64_Versor* interpolation, const BGC_FP64_Versor* start, const BGC_FP64_Versor* end, const double phase)
|
||||||
{
|
{
|
||||||
const double delta_s0 = (end->_s0 * start->_s0 + end->_x1 * start->_x1) + (end->_x2 * start->_x2 + end->_x3 * start->_x3);
|
const double delta_s0 = (end->_s0 * start->_s0 + end->_x1 * start->_x1) + (end->_x2 * start->_x2 + end->_x3 * start->_x3);
|
||||||
const double delta_x1 = (end->_x1 * start->_s0 + end->_x3 * start->_x2) - (end->_s0 * start->_x1 + end->_x2 * start->_x3);
|
const double delta_x1 = (end->_x1 * start->_s0 + end->_x3 * start->_x2) - (end->_s0 * start->_x1 + end->_x2 * start->_x3);
|
||||||
|
|
@ -516,8 +516,8 @@ void bgc_fp64_versor_spherically_interpolate(const BGC_FP64_Versor* start, const
|
||||||
const double square_vector = delta_x1 * delta_x1 + delta_x2 * delta_x2 + delta_x3 * delta_x3;
|
const double square_vector = delta_x1 * delta_x1 + delta_x2 * delta_x2 + delta_x3 * delta_x3;
|
||||||
|
|
||||||
// square_vector != square_vector means checking for NaN value at square_vector
|
// square_vector != square_vector means checking for NaN value at square_vector
|
||||||
if (square_vector <= BGC_FP64_SQUARE_EPSYLON || square_vector != square_vector) {
|
if (square_vector <= BGC_FP64_SQUARE_EPSYLON || isnan(square_vector)) {
|
||||||
bgc_fp64_versor_copy(end, result);
|
bgc_fp64_versor_copy(interpolation, end);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -533,22 +533,22 @@ void bgc_fp64_versor_spherically_interpolate(const BGC_FP64_Versor* start, const
|
||||||
|
|
||||||
// Combining of starting orientation with the turning
|
// Combining of starting orientation with the turning
|
||||||
bgc_fp64_versor_make(
|
bgc_fp64_versor_make(
|
||||||
|
interpolation,
|
||||||
(turn_s0 * start->_s0 - turn_x1 * start->_x1) - (turn_x2 * start->_x2 + turn_x3 * start->_x3),
|
(turn_s0 * start->_s0 - turn_x1 * start->_x1) - (turn_x2 * start->_x2 + turn_x3 * start->_x3),
|
||||||
(turn_x1 * start->_s0 + turn_s0 * start->_x1) - (turn_x3 * start->_x2 - turn_x2 * start->_x3),
|
(turn_x1 * start->_s0 + turn_s0 * start->_x1) - (turn_x3 * start->_x2 - turn_x2 * start->_x3),
|
||||||
(turn_x2 * start->_s0 + turn_s0 * start->_x2) - (turn_x1 * start->_x3 - turn_x3 * start->_x1),
|
(turn_x2 * start->_s0 + turn_s0 * start->_x2) - (turn_x1 * start->_x3 - turn_x3 * start->_x1),
|
||||||
(turn_x3 * start->_s0 + turn_s0 * start->_x3) - (turn_x2 * start->_x1 - turn_x1 * start->_x2),
|
(turn_x3 * start->_s0 + turn_s0 * start->_x3) - (turn_x2 * start->_x1 - turn_x1 * start->_x2)
|
||||||
result
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================ Get Rotation ================ //
|
// ================ Get Rotation ================ //
|
||||||
|
|
||||||
void bgc_fp32_versor_get_rotation(const BGC_FP32_Versor* versor, BGC_FP32_Rotation3* result)
|
void bgc_fp32_versor_get_rotation(BGC_FP32_Rotation3* rotation, const BGC_FP32_Versor* versor)
|
||||||
{
|
{
|
||||||
const float square_modulus = versor->_x1 * versor->_x1 + versor->_x2 * versor->_x2 + versor->_x3 * versor->_x3;
|
const float square_modulus = versor->_x1 * versor->_x1 + versor->_x2 * versor->_x2 + versor->_x3 * versor->_x3;
|
||||||
|
|
||||||
if (square_modulus <= BGC_FP32_SQUARE_EPSYLON) {
|
if (square_modulus <= BGC_FP32_SQUARE_EPSYLON) {
|
||||||
bgc_fp32_rotation3_reset(result);
|
bgc_fp32_rotation3_reset(rotation);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -556,19 +556,19 @@ void bgc_fp32_versor_get_rotation(const BGC_FP32_Versor* versor, BGC_FP32_Rotati
|
||||||
|
|
||||||
const float multiplier = 1.0f / vector_modulus;
|
const float multiplier = 1.0f / vector_modulus;
|
||||||
|
|
||||||
result->radians = 2.0f * atan2f(vector_modulus, versor->_s0);
|
rotation->radians = 2.0f * atan2f(vector_modulus, versor->_s0);
|
||||||
|
|
||||||
result->axis.x1 = versor->_x1 * multiplier;
|
rotation->axis.x1 = versor->_x1 * multiplier;
|
||||||
result->axis.x2 = versor->_x2 * multiplier;
|
rotation->axis.x2 = versor->_x2 * multiplier;
|
||||||
result->axis.x3 = versor->_x3 * multiplier;
|
rotation->axis.x3 = versor->_x3 * multiplier;
|
||||||
}
|
}
|
||||||
|
|
||||||
void bgc_fp64_versor_get_rotation(const BGC_FP64_Versor* versor, BGC_FP64_Rotation3* result)
|
void bgc_fp64_versor_get_rotation(BGC_FP64_Rotation3* rotation, const BGC_FP64_Versor* versor)
|
||||||
{
|
{
|
||||||
const double square_modulus = versor->_x1 * versor->_x1 + versor->_x2 * versor->_x2 + versor->_x3 * versor->_x3;
|
const double square_modulus = versor->_x1 * versor->_x1 + versor->_x2 * versor->_x2 + versor->_x3 * versor->_x3;
|
||||||
|
|
||||||
if (square_modulus <= BGC_FP64_SQUARE_EPSYLON) {
|
if (square_modulus <= BGC_FP64_SQUARE_EPSYLON) {
|
||||||
bgc_fp64_rotation3_reset(result);
|
bgc_fp64_rotation3_reset(rotation);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -576,9 +576,9 @@ void bgc_fp64_versor_get_rotation(const BGC_FP64_Versor* versor, BGC_FP64_Rotati
|
||||||
|
|
||||||
const double multiplier = 1.0 / vector_modulus;
|
const double multiplier = 1.0 / vector_modulus;
|
||||||
|
|
||||||
result->radians = 2.0 * atan2(vector_modulus, versor->_s0);
|
rotation->radians = 2.0 * atan2(vector_modulus, versor->_s0);
|
||||||
|
|
||||||
result->axis.x1 = versor->_x1 * multiplier;
|
rotation->axis.x1 = versor->_x1 * multiplier;
|
||||||
result->axis.x2 = versor->_x2 * multiplier;
|
rotation->axis.x2 = versor->_x2 * multiplier;
|
||||||
result->axis.x3 = versor->_x3 * multiplier;
|
rotation->axis.x3 = versor->_x3 * multiplier;
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -62,7 +62,7 @@ void _bgc_fp32_versor_normalize(BGC_FP32_Versor* twin);
|
||||||
|
|
||||||
void _bgc_fp64_versor_normalize(BGC_FP64_Versor* twin);
|
void _bgc_fp64_versor_normalize(BGC_FP64_Versor* twin);
|
||||||
|
|
||||||
inline void bgc_fp32_versor_make(const float s0, const float x1, const float x2, const float x3, BGC_FP32_Versor* versor)
|
inline void bgc_fp32_versor_make(BGC_FP32_Versor* versor, const float s0, const float x1, const float x2, const float x3)
|
||||||
{
|
{
|
||||||
versor->_s0 = s0;
|
versor->_s0 = s0;
|
||||||
versor->_x1 = x1;
|
versor->_x1 = x1;
|
||||||
|
|
@ -76,7 +76,7 @@ inline void bgc_fp32_versor_make(const float s0, const float x1, const float x2,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_make(const double s0, const double x1, const double x2, const double x3, BGC_FP64_Versor* versor)
|
inline void bgc_fp64_versor_make(BGC_FP64_Versor* versor, const double s0, const double x1, const double x2, const double x3)
|
||||||
{
|
{
|
||||||
versor->_s0 = s0;
|
versor->_s0 = s0;
|
||||||
versor->_x1 = x1;
|
versor->_x1 = x1;
|
||||||
|
|
@ -92,49 +92,49 @@ inline void bgc_fp64_versor_make(const double s0, const double x1, const double
|
||||||
|
|
||||||
// ================== Set Turn ================== //
|
// ================== Set Turn ================== //
|
||||||
|
|
||||||
void bgc_fp32_versor_make_for_turn(const float x1, const float x2, const float x3, const float angle, const int unit, BGC_FP32_Versor* result);
|
void bgc_fp32_versor_make_for_turn(BGC_FP32_Versor* versor, const float x1, const float x2, const float x3, const float angle, const int unit);
|
||||||
|
|
||||||
void bgc_fp64_versor_make_for_turn(const double x1, const double x2, const double x3, const double angle, const int unit, BGC_FP64_Versor* result);
|
void bgc_fp64_versor_make_for_turn(BGC_FP64_Versor* versor, const double x1, const double x2, const double x3, const double angle, const int unit);
|
||||||
|
|
||||||
// ================ Set Rotation ================ //
|
// ================ Set Rotation ================ //
|
||||||
|
|
||||||
inline void bgc_fp32_versor_make_for_rotation(const BGC_FP32_Rotation3* rotation, BGC_FP32_Versor* result)
|
inline void bgc_fp32_versor_make_for_rotation(BGC_FP32_Versor* versor, const BGC_FP32_Rotation3* rotation)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_make_for_turn(rotation->axis.x1, rotation->axis.x2, rotation->axis.x3, rotation->radians, BGC_ANGLE_UNIT_RADIANS, result);
|
bgc_fp32_versor_make_for_turn(versor, rotation->axis.x1, rotation->axis.x2, rotation->axis.x3, rotation->radians, BGC_ANGLE_UNIT_RADIANS);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_make_for_rotation(const BGC_FP64_Rotation3* rotation, BGC_FP64_Versor* result)
|
inline void bgc_fp64_versor_make_for_rotation(BGC_FP64_Versor* versor, const BGC_FP64_Rotation3* rotation)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_make_for_turn(rotation->axis.x1, rotation->axis.x2, rotation->axis.x3, rotation->radians, BGC_ANGLE_UNIT_RADIANS, result);
|
bgc_fp64_versor_make_for_turn(versor, rotation->axis.x1, rotation->axis.x2, rotation->axis.x3, rotation->radians, BGC_ANGLE_UNIT_RADIANS);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ========= Make Direction Difference ========== //
|
// ========= Make Direction Difference ========== //
|
||||||
|
|
||||||
int bgc_fp32_versor_make_direction_difference(const BGC_FP32_Vector3* start, const BGC_FP32_Vector3* end, BGC_FP32_Versor* result);
|
int bgc_fp32_versor_make_direction_difference(BGC_FP32_Versor* difference, const BGC_FP32_Vector3* start, const BGC_FP32_Vector3* end);
|
||||||
|
|
||||||
int bgc_fp64_versor_make_direction_difference(const BGC_FP64_Vector3* start, const BGC_FP64_Vector3* end, BGC_FP64_Versor* result);
|
int bgc_fp64_versor_make_direction_difference(BGC_FP64_Versor* difference, const BGC_FP64_Vector3* start, const BGC_FP64_Vector3* end);
|
||||||
|
|
||||||
// =============== Set Directions =============== //
|
// =============== Set Directions =============== //
|
||||||
|
|
||||||
int bgc_fp32_versor_make_basis_difference(
|
int bgc_fp32_versor_make_basis_difference(
|
||||||
|
BGC_FP32_Versor* versor,
|
||||||
const BGC_FP32_Vector3* initial_primary_direction,
|
const BGC_FP32_Vector3* initial_primary_direction,
|
||||||
const BGC_FP32_Vector3* initial_auxiliary_direction,
|
const BGC_FP32_Vector3* initial_auxiliary_direction,
|
||||||
const BGC_FP32_Vector3* final_primary_direction,
|
const BGC_FP32_Vector3* final_primary_direction,
|
||||||
const BGC_FP32_Vector3* final_auxiliary_direction,
|
const BGC_FP32_Vector3* final_auxiliary_direction
|
||||||
BGC_FP32_Versor* result
|
|
||||||
);
|
);
|
||||||
|
|
||||||
int bgc_fp64_versor_make_basis_difference(
|
int bgc_fp64_versor_make_basis_difference(
|
||||||
|
BGC_FP64_Versor* versor,
|
||||||
const BGC_FP64_Vector3* initial_primary_direction,
|
const BGC_FP64_Vector3* initial_primary_direction,
|
||||||
const BGC_FP64_Vector3* initial_auxiliary_direction,
|
const BGC_FP64_Vector3* initial_auxiliary_direction,
|
||||||
const BGC_FP64_Vector3* final_primary_direction,
|
const BGC_FP64_Vector3* final_primary_direction,
|
||||||
const BGC_FP64_Vector3* final_auxiliary_direction,
|
const BGC_FP64_Vector3* final_auxiliary_direction
|
||||||
BGC_FP64_Versor* result
|
|
||||||
);
|
);
|
||||||
|
|
||||||
// ==================== Copy ==================== //
|
// ==================== Copy ==================== //
|
||||||
|
|
||||||
inline void bgc_fp32_versor_copy(const BGC_FP32_Versor* source, BGC_FP32_Versor* destination)
|
inline void bgc_fp32_versor_copy(BGC_FP32_Versor* destination, const BGC_FP32_Versor* source)
|
||||||
{
|
{
|
||||||
destination->_s0 = source->_s0;
|
destination->_s0 = source->_s0;
|
||||||
destination->_x1 = source->_x1;
|
destination->_x1 = source->_x1;
|
||||||
|
|
@ -142,7 +142,7 @@ inline void bgc_fp32_versor_copy(const BGC_FP32_Versor* source, BGC_FP32_Versor*
|
||||||
destination->_x3 = source->_x3;
|
destination->_x3 = source->_x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_copy(const BGC_FP64_Versor* source, BGC_FP64_Versor* destination)
|
inline void bgc_fp64_versor_copy(BGC_FP64_Versor* destination, const BGC_FP64_Versor* source)
|
||||||
{
|
{
|
||||||
destination->_s0 = source->_s0;
|
destination->_s0 = source->_s0;
|
||||||
destination->_x1 = source->_x1;
|
destination->_x1 = source->_x1;
|
||||||
|
|
@ -202,25 +202,25 @@ inline int bgc_fp64_versor_is_idle(const BGC_FP64_Versor* versor)
|
||||||
|
|
||||||
// ================== Convert =================== //
|
// ================== Convert =================== //
|
||||||
|
|
||||||
inline void bgc_fp64_versor_convert_to_fp32(const BGC_FP64_Versor* source, BGC_FP32_Versor* destination)
|
inline void bgc_fp32_versor_convert_to_fp64(BGC_FP64_Versor* destination, const BGC_FP32_Versor* source)
|
||||||
{
|
|
||||||
bgc_fp32_versor_make(
|
|
||||||
(float)source->_s0,
|
|
||||||
(float)source->_x1,
|
|
||||||
(float)source->_x2,
|
|
||||||
(float)source->_x3,
|
|
||||||
destination
|
|
||||||
);
|
|
||||||
}
|
|
||||||
|
|
||||||
inline void bgc_fp32_versor_convert_to_fp64(const BGC_FP32_Versor* source, BGC_FP64_Versor* destination)
|
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_make(
|
bgc_fp64_versor_make(
|
||||||
|
destination,
|
||||||
source->_s0,
|
source->_s0,
|
||||||
source->_x1,
|
source->_x1,
|
||||||
source->_x2,
|
source->_x2,
|
||||||
source->_x3,
|
source->_x3
|
||||||
destination
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
inline void bgc_fp64_versor_convert_to_fp32(BGC_FP32_Versor* destination, const BGC_FP64_Versor* source)
|
||||||
|
{
|
||||||
|
bgc_fp32_versor_make(
|
||||||
|
destination,
|
||||||
|
(float)source->_s0,
|
||||||
|
(float)source->_x1,
|
||||||
|
(float)source->_x2,
|
||||||
|
(float)source->_x3
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -246,7 +246,7 @@ inline void bgc_fp64_versor_shorten(BGC_FP64_Versor* versor)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_versor_get_shortened(const BGC_FP32_Versor* versor, BGC_FP32_Versor* shortened)
|
inline void bgc_fp32_versor_get_shortened(BGC_FP32_Versor* shortened, const BGC_FP32_Versor* versor)
|
||||||
{
|
{
|
||||||
if (versor->_s0 >= 0.0f) {
|
if (versor->_s0 >= 0.0f) {
|
||||||
shortened->_s0 = versor->_s0;
|
shortened->_s0 = versor->_s0;
|
||||||
|
|
@ -262,7 +262,7 @@ inline void bgc_fp32_versor_get_shortened(const BGC_FP32_Versor* versor, BGC_FP3
|
||||||
shortened->_x3 = -versor->_x3;
|
shortened->_x3 = -versor->_x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_get_shortened(const BGC_FP64_Versor* versor, BGC_FP64_Versor* shortened)
|
inline void bgc_fp64_versor_get_shortened(BGC_FP64_Versor* shortened, const BGC_FP64_Versor* versor)
|
||||||
{
|
{
|
||||||
if (versor->_s0 >= 0.0) {
|
if (versor->_s0 >= 0.0) {
|
||||||
shortened->_s0 = versor->_s0;
|
shortened->_s0 = versor->_s0;
|
||||||
|
|
@ -296,20 +296,20 @@ inline void bgc_fp64_versor_alternate(BGC_FP64_Versor* versor)
|
||||||
versor->_x3 = -versor->_x3;
|
versor->_x3 = -versor->_x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_versor_get_alternative(const BGC_FP32_Versor* versor, BGC_FP32_Versor* opposite)
|
inline void bgc_fp32_versor_get_alternative(BGC_FP32_Versor* alternative, const BGC_FP32_Versor* versor)
|
||||||
{
|
{
|
||||||
opposite->_s0 = -versor->_s0;
|
alternative->_s0 = -versor->_s0;
|
||||||
opposite->_x1 = -versor->_x1;
|
alternative->_x1 = -versor->_x1;
|
||||||
opposite->_x2 = -versor->_x2;
|
alternative->_x2 = -versor->_x2;
|
||||||
opposite->_x3 = -versor->_x3;
|
alternative->_x3 = -versor->_x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_get_alternative(const BGC_FP64_Versor* versor, BGC_FP64_Versor* opposite)
|
inline void bgc_fp64_versor_get_alternative(BGC_FP64_Versor* alternative, const BGC_FP64_Versor* versor)
|
||||||
{
|
{
|
||||||
opposite->_s0 = -versor->_s0;
|
alternative->_s0 = -versor->_s0;
|
||||||
opposite->_x1 = -versor->_x1;
|
alternative->_x1 = -versor->_x1;
|
||||||
opposite->_x2 = -versor->_x2;
|
alternative->_x2 = -versor->_x2;
|
||||||
opposite->_x3 = -versor->_x3;
|
alternative->_x3 = -versor->_x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
// =================== Invert =================== //
|
// =================== Invert =================== //
|
||||||
|
|
@ -328,7 +328,7 @@ inline void bgc_fp64_versor_revert(BGC_FP64_Versor* versor)
|
||||||
versor->_x3 = -versor->_x3;
|
versor->_x3 = -versor->_x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp32_versor_get_reverse(const BGC_FP32_Versor* versor, BGC_FP32_Versor* inverse)
|
inline void bgc_fp32_versor_get_reverse(BGC_FP32_Versor* inverse, const BGC_FP32_Versor* versor)
|
||||||
{
|
{
|
||||||
inverse->_s0 = versor->_s0;
|
inverse->_s0 = versor->_s0;
|
||||||
inverse->_x1 = -versor->_x1;
|
inverse->_x1 = -versor->_x1;
|
||||||
|
|
@ -336,7 +336,7 @@ inline void bgc_fp32_versor_get_reverse(const BGC_FP32_Versor* versor, BGC_FP32_
|
||||||
inverse->_x3 = -versor->_x3;
|
inverse->_x3 = -versor->_x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_get_reverse(const BGC_FP64_Versor* versor, BGC_FP64_Versor* inverse)
|
inline void bgc_fp64_versor_get_reverse(BGC_FP64_Versor* inverse, const BGC_FP64_Versor* versor)
|
||||||
{
|
{
|
||||||
inverse->_s0 = versor->_s0;
|
inverse->_s0 = versor->_s0;
|
||||||
inverse->_x1 = -versor->_x1;
|
inverse->_x1 = -versor->_x1;
|
||||||
|
|
@ -346,37 +346,37 @@ inline void bgc_fp64_versor_get_reverse(const BGC_FP64_Versor* versor, BGC_FP64_
|
||||||
|
|
||||||
// =============== Get Exponation =============== //
|
// =============== Get Exponation =============== //
|
||||||
|
|
||||||
void bgc_fp32_versor_get_exponation(const BGC_FP32_Versor* base, const float exponent, BGC_FP32_Versor* power);
|
void bgc_fp32_versor_get_exponation(BGC_FP32_Versor* power, const BGC_FP32_Versor* base, const float exponent);
|
||||||
|
|
||||||
void bgc_fp64_versor_get_exponation(const BGC_FP64_Versor* base, const double exponent, BGC_FP64_Versor* power);
|
void bgc_fp64_versor_get_exponation(BGC_FP64_Versor* power, const BGC_FP64_Versor* base, const double exponent);
|
||||||
|
|
||||||
// ================ Combination ================= //
|
// ================ Combination ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_versor_combine(const BGC_FP32_Versor* first, const BGC_FP32_Versor* second, BGC_FP32_Versor* result)
|
inline void bgc_fp32_versor_combine(BGC_FP32_Versor* combination, const BGC_FP32_Versor* first, const BGC_FP32_Versor* second)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_make(
|
bgc_fp32_versor_make(
|
||||||
|
combination,
|
||||||
(second->_s0 * first->_s0 - second->_x1 * first->_x1) - (second->_x2 * first->_x2 + second->_x3 * first->_x3),
|
(second->_s0 * first->_s0 - second->_x1 * first->_x1) - (second->_x2 * first->_x2 + second->_x3 * first->_x3),
|
||||||
(second->_x1 * first->_s0 + second->_s0 * first->_x1) - (second->_x3 * first->_x2 - second->_x2 * first->_x3),
|
(second->_x1 * first->_s0 + second->_s0 * first->_x1) - (second->_x3 * first->_x2 - second->_x2 * first->_x3),
|
||||||
(second->_x2 * first->_s0 + second->_s0 * first->_x2) - (second->_x1 * first->_x3 - second->_x3 * first->_x1),
|
(second->_x2 * first->_s0 + second->_s0 * first->_x2) - (second->_x1 * first->_x3 - second->_x3 * first->_x1),
|
||||||
(second->_x3 * first->_s0 + second->_s0 * first->_x3) - (second->_x2 * first->_x1 - second->_x1 * first->_x2),
|
(second->_x3 * first->_s0 + second->_s0 * first->_x3) - (second->_x2 * first->_x1 - second->_x1 * first->_x2)
|
||||||
result
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_combine(const BGC_FP64_Versor* first, const BGC_FP64_Versor* second, BGC_FP64_Versor* result)
|
inline void bgc_fp64_versor_combine(BGC_FP64_Versor* combination, const BGC_FP64_Versor* first, const BGC_FP64_Versor* second)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_make(
|
bgc_fp64_versor_make(
|
||||||
|
combination,
|
||||||
(second->_s0 * first->_s0 - second->_x1 * first->_x1) - (second->_x2 * first->_x2 + second->_x3 * first->_x3),
|
(second->_s0 * first->_s0 - second->_x1 * first->_x1) - (second->_x2 * first->_x2 + second->_x3 * first->_x3),
|
||||||
(second->_x1 * first->_s0 + second->_s0 * first->_x1) - (second->_x3 * first->_x2 - second->_x2 * first->_x3),
|
(second->_x1 * first->_s0 + second->_s0 * first->_x1) - (second->_x3 * first->_x2 - second->_x2 * first->_x3),
|
||||||
(second->_x2 * first->_s0 + second->_s0 * first->_x2) - (second->_x1 * first->_x3 - second->_x3 * first->_x1),
|
(second->_x2 * first->_s0 + second->_s0 * first->_x2) - (second->_x1 * first->_x3 - second->_x3 * first->_x1),
|
||||||
(second->_x3 * first->_s0 + second->_s0 * first->_x3) - (second->_x2 * first->_x1 - second->_x1 * first->_x2),
|
(second->_x3 * first->_s0 + second->_s0 * first->_x3) - (second->_x2 * first->_x1 - second->_x1 * first->_x2)
|
||||||
result
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============ Combination of three ============ //
|
// ============ Combination of three ============ //
|
||||||
|
|
||||||
inline void bgc_fp32_versor_combine3(const BGC_FP32_Versor* first, const BGC_FP32_Versor* second, const BGC_FP32_Versor* third, BGC_FP32_Versor* result)
|
inline void bgc_fp32_versor_combine3(BGC_FP32_Versor* combination, const BGC_FP32_Versor* first, const BGC_FP32_Versor* second, const BGC_FP32_Versor* third)
|
||||||
{
|
{
|
||||||
const float s0 = (second->_s0 * first->_s0 - second->_x1 * first->_x1) - (second->_x2 * first->_x2 + second->_x3 * first->_x3);
|
const float s0 = (second->_s0 * first->_s0 - second->_x1 * first->_x1) - (second->_x2 * first->_x2 + second->_x3 * first->_x3);
|
||||||
const float x1 = (second->_x1 * first->_s0 + second->_s0 * first->_x1) - (second->_x3 * first->_x2 - second->_x2 * first->_x3);
|
const float x1 = (second->_x1 * first->_s0 + second->_s0 * first->_x1) - (second->_x3 * first->_x2 - second->_x2 * first->_x3);
|
||||||
|
|
@ -384,15 +384,15 @@ inline void bgc_fp32_versor_combine3(const BGC_FP32_Versor* first, const BGC_FP3
|
||||||
const float x3 = (second->_x3 * first->_s0 + second->_s0 * first->_x3) - (second->_x2 * first->_x1 - second->_x1 * first->_x2);
|
const float x3 = (second->_x3 * first->_s0 + second->_s0 * first->_x3) - (second->_x2 * first->_x1 - second->_x1 * first->_x2);
|
||||||
|
|
||||||
bgc_fp32_versor_make(
|
bgc_fp32_versor_make(
|
||||||
|
combination,
|
||||||
(third->_s0 * s0 - third->_x1 * x1) - (third->_x2 * x2 + third->_x3 * x3),
|
(third->_s0 * s0 - third->_x1 * x1) - (third->_x2 * x2 + third->_x3 * x3),
|
||||||
(third->_x1 * s0 + third->_s0 * x1) - (third->_x3 * x2 - third->_x2 * x3),
|
(third->_x1 * s0 + third->_s0 * x1) - (third->_x3 * x2 - third->_x2 * x3),
|
||||||
(third->_x2 * s0 + third->_s0 * x2) - (third->_x1 * x3 - third->_x3 * x1),
|
(third->_x2 * s0 + third->_s0 * x2) - (third->_x1 * x3 - third->_x3 * x1),
|
||||||
(third->_x3 * s0 + third->_s0 * x3) - (third->_x2 * x1 - third->_x1 * x2),
|
(third->_x3 * s0 + third->_s0 * x3) - (third->_x2 * x1 - third->_x1 * x2)
|
||||||
result
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_combine3(const BGC_FP64_Versor* first, const BGC_FP64_Versor* second, const BGC_FP64_Versor* third, BGC_FP64_Versor* result)
|
inline void bgc_fp64_versor_combine3(BGC_FP64_Versor* combination, const BGC_FP64_Versor* first, const BGC_FP64_Versor* second, const BGC_FP64_Versor* third)
|
||||||
{
|
{
|
||||||
const double s0 = (second->_s0 * first->_s0 - second->_x1 * first->_x1) - (second->_x2 * first->_x2 + second->_x3 * first->_x3);
|
const double s0 = (second->_s0 * first->_s0 - second->_x1 * first->_x1) - (second->_x2 * first->_x2 + second->_x3 * first->_x3);
|
||||||
const double x1 = (second->_x1 * first->_s0 + second->_s0 * first->_x1) - (second->_x3 * first->_x2 - second->_x2 * first->_x3);
|
const double x1 = (second->_x1 * first->_s0 + second->_s0 * first->_x1) - (second->_x3 * first->_x2 - second->_x2 * first->_x3);
|
||||||
|
|
@ -400,53 +400,53 @@ inline void bgc_fp64_versor_combine3(const BGC_FP64_Versor* first, const BGC_FP6
|
||||||
const double x3 = (second->_x3 * first->_s0 + second->_s0 * first->_x3) - (second->_x2 * first->_x1 - second->_x1 * first->_x2);
|
const double x3 = (second->_x3 * first->_s0 + second->_s0 * first->_x3) - (second->_x2 * first->_x1 - second->_x1 * first->_x2);
|
||||||
|
|
||||||
bgc_fp64_versor_make(
|
bgc_fp64_versor_make(
|
||||||
|
combination,
|
||||||
(third->_s0 * s0 - third->_x1 * x1) - (third->_x2 * x2 + third->_x3 * x3),
|
(third->_s0 * s0 - third->_x1 * x1) - (third->_x2 * x2 + third->_x3 * x3),
|
||||||
(third->_x1 * s0 + third->_s0 * x1) - (third->_x3 * x2 - third->_x2 * x3),
|
(third->_x1 * s0 + third->_s0 * x1) - (third->_x3 * x2 - third->_x2 * x3),
|
||||||
(third->_x2 * s0 + third->_s0 * x2) - (third->_x1 * x3 - third->_x3 * x1),
|
(third->_x2 * s0 + third->_s0 * x2) - (third->_x1 * x3 - third->_x3 * x1),
|
||||||
(third->_x3 * s0 + third->_s0 * x3) - (third->_x2 * x1 - third->_x1 * x2),
|
(third->_x3 * s0 + third->_s0 * x3) - (third->_x2 * x1 - third->_x1 * x2)
|
||||||
result
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================= Exclusion ================== //
|
// ================= Exclusion ================== //
|
||||||
|
|
||||||
inline void bgc_fp32_versor_exclude(const BGC_FP32_Versor* base, const BGC_FP32_Versor* excludant, BGC_FP32_Versor* difference)
|
inline void bgc_fp32_versor_exclude(BGC_FP32_Versor* difference, const BGC_FP32_Versor* base, const BGC_FP32_Versor* excludant)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_make(
|
bgc_fp32_versor_make(
|
||||||
|
difference,
|
||||||
(base->_s0 * excludant->_s0 + base->_x1 * excludant->_x1) + (base->_x2 * excludant->_x2 + base->_x3 * excludant->_x3),
|
(base->_s0 * excludant->_s0 + base->_x1 * excludant->_x1) + (base->_x2 * excludant->_x2 + base->_x3 * excludant->_x3),
|
||||||
(base->_x1 * excludant->_s0 + base->_x3 * excludant->_x2) - (base->_s0 * excludant->_x1 + base->_x2 * excludant->_x3),
|
(base->_x1 * excludant->_s0 + base->_x3 * excludant->_x2) - (base->_s0 * excludant->_x1 + base->_x2 * excludant->_x3),
|
||||||
(base->_x2 * excludant->_s0 + base->_x1 * excludant->_x3) - (base->_s0 * excludant->_x2 + base->_x3 * excludant->_x1),
|
(base->_x2 * excludant->_s0 + base->_x1 * excludant->_x3) - (base->_s0 * excludant->_x2 + base->_x3 * excludant->_x1),
|
||||||
(base->_x3 * excludant->_s0 + base->_x2 * excludant->_x1) - (base->_s0 * excludant->_x3 + base->_x1 * excludant->_x2),
|
(base->_x3 * excludant->_s0 + base->_x2 * excludant->_x1) - (base->_s0 * excludant->_x3 + base->_x1 * excludant->_x2)
|
||||||
difference
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_exclude(const BGC_FP64_Versor* base, const BGC_FP64_Versor* excludant, BGC_FP64_Versor* difference)
|
inline void bgc_fp64_versor_exclude(BGC_FP64_Versor* difference, const BGC_FP64_Versor* base, const BGC_FP64_Versor* excludant)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_make(
|
bgc_fp64_versor_make(
|
||||||
|
difference,
|
||||||
(base->_s0 * excludant->_s0 + base->_x1 * excludant->_x1) + (base->_x2 * excludant->_x2 + base->_x3 * excludant->_x3),
|
(base->_s0 * excludant->_s0 + base->_x1 * excludant->_x1) + (base->_x2 * excludant->_x2 + base->_x3 * excludant->_x3),
|
||||||
(base->_x1 * excludant->_s0 + base->_x3 * excludant->_x2) - (base->_s0 * excludant->_x1 + base->_x2 * excludant->_x3),
|
(base->_x1 * excludant->_s0 + base->_x3 * excludant->_x2) - (base->_s0 * excludant->_x1 + base->_x2 * excludant->_x3),
|
||||||
(base->_x2 * excludant->_s0 + base->_x1 * excludant->_x3) - (base->_s0 * excludant->_x2 + base->_x3 * excludant->_x1),
|
(base->_x2 * excludant->_s0 + base->_x1 * excludant->_x3) - (base->_s0 * excludant->_x2 + base->_x3 * excludant->_x1),
|
||||||
(base->_x3 * excludant->_s0 + base->_x2 * excludant->_x1) - (base->_s0 * excludant->_x3 + base->_x1 * excludant->_x2),
|
(base->_x3 * excludant->_s0 + base->_x2 * excludant->_x1) - (base->_s0 * excludant->_x3 + base->_x1 * excludant->_x2)
|
||||||
difference
|
|
||||||
);
|
);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============ Sphere Interpolation ============ //
|
// ============ Sphere Interpolation ============ //
|
||||||
|
|
||||||
void bgc_fp32_versor_spherically_interpolate(const BGC_FP32_Versor* start, const BGC_FP32_Versor* end, const float phase, BGC_FP32_Versor* result);
|
void bgc_fp32_versor_spherically_interpolate(BGC_FP32_Versor* interpolation, const BGC_FP32_Versor* start, const BGC_FP32_Versor* end, const float phase);
|
||||||
|
|
||||||
void bgc_fp64_versor_spherically_interpolate(const BGC_FP64_Versor* start, const BGC_FP64_Versor* end, const double phase, BGC_FP64_Versor* result);
|
void bgc_fp64_versor_spherically_interpolate(BGC_FP64_Versor* interpolation, const BGC_FP64_Versor* start, const BGC_FP64_Versor* end, const double phase);
|
||||||
|
|
||||||
// ================ Get Rotation ================ //
|
// ================ Get Rotation ================ //
|
||||||
|
|
||||||
void bgc_fp32_versor_get_rotation(const BGC_FP32_Versor* versor, BGC_FP32_Rotation3* result);
|
void bgc_fp32_versor_get_rotation(BGC_FP32_Rotation3* rotation, const BGC_FP32_Versor* versor);
|
||||||
|
|
||||||
void bgc_fp64_versor_get_rotation(const BGC_FP64_Versor* versor, BGC_FP64_Rotation3* result);
|
void bgc_fp64_versor_get_rotation(BGC_FP64_Rotation3* rotation, const BGC_FP64_Versor* versor);
|
||||||
|
|
||||||
// ============ Get Rotation Matrix ============= //
|
// ============ Get Rotation Matrix ============= //
|
||||||
|
|
||||||
inline void bgc_fp32_versor_get_rotation_matrix(const BGC_FP32_Versor* versor, BGC_FP32_Matrix3x3* matrix)
|
inline void bgc_fp32_versor_get_rotation_matrix(BGC_FP32_Matrix3x3* matrix, const BGC_FP32_Versor* versor)
|
||||||
{
|
{
|
||||||
const float s0s0 = versor->_s0 * versor->_s0;
|
const float s0s0 = versor->_s0 * versor->_s0;
|
||||||
const float x1x1 = versor->_x1 * versor->_x1;
|
const float x1x1 = versor->_x1 * versor->_x1;
|
||||||
|
|
@ -473,7 +473,7 @@ inline void bgc_fp32_versor_get_rotation_matrix(const BGC_FP32_Versor* versor, B
|
||||||
matrix->r1c3 = 2.0f * (x1x3 + s0x2);
|
matrix->r1c3 = 2.0f * (x1x3 + s0x2);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_get_rotation_matrix(const BGC_FP64_Versor* versor, BGC_FP64_Matrix3x3* matrix)
|
inline void bgc_fp64_versor_get_rotation_matrix(BGC_FP64_Matrix3x3* matrix, const BGC_FP64_Versor* versor)
|
||||||
{
|
{
|
||||||
const double s0s0 = versor->_s0 * versor->_s0;
|
const double s0s0 = versor->_s0 * versor->_s0;
|
||||||
const double x1x1 = versor->_x1 * versor->_x1;
|
const double x1x1 = versor->_x1 * versor->_x1;
|
||||||
|
|
@ -502,7 +502,7 @@ inline void bgc_fp64_versor_get_rotation_matrix(const BGC_FP64_Versor* versor, B
|
||||||
|
|
||||||
// ============= Get Reverse Matrix ============= //
|
// ============= Get Reverse Matrix ============= //
|
||||||
|
|
||||||
inline void bgc_fp32_versor_get_reverse_matrix(const BGC_FP32_Versor* versor, BGC_FP32_Matrix3x3* matrix)
|
inline void bgc_fp32_versor_get_reverse_matrix(BGC_FP32_Matrix3x3* matrix, const BGC_FP32_Versor* versor)
|
||||||
{
|
{
|
||||||
const float s0s0 = versor->_s0 * versor->_s0;
|
const float s0s0 = versor->_s0 * versor->_s0;
|
||||||
const float x1x1 = versor->_x1 * versor->_x1;
|
const float x1x1 = versor->_x1 * versor->_x1;
|
||||||
|
|
@ -529,7 +529,7 @@ inline void bgc_fp32_versor_get_reverse_matrix(const BGC_FP32_Versor* versor, BG
|
||||||
matrix->r1c3 = 2.0f * (x1x3 - s0x2);
|
matrix->r1c3 = 2.0f * (x1x3 - s0x2);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_get_reverse_matrix(const BGC_FP64_Versor* versor, BGC_FP64_Matrix3x3* matrix)
|
inline void bgc_fp64_versor_get_reverse_matrix(BGC_FP64_Matrix3x3* matrix, const BGC_FP64_Versor* versor)
|
||||||
{
|
{
|
||||||
const double s0s0 = versor->_s0 * versor->_s0;
|
const double s0s0 = versor->_s0 * versor->_s0;
|
||||||
const double x1x1 = versor->_x1 * versor->_x1;
|
const double x1x1 = versor->_x1 * versor->_x1;
|
||||||
|
|
@ -558,21 +558,21 @@ inline void bgc_fp64_versor_get_reverse_matrix(const BGC_FP64_Versor* versor, BG
|
||||||
|
|
||||||
// ============= Get Both Matrixes ============== //
|
// ============= Get Both Matrixes ============== //
|
||||||
|
|
||||||
inline void bgc_fp32_versor_get_both_matrices(const BGC_FP32_Versor* versor, BGC_FP32_Matrix3x3* rotation, BGC_FP32_Matrix3x3* reverse)
|
inline void bgc_fp32_versor_get_both_matrices(BGC_FP32_Matrix3x3* rotation, BGC_FP32_Matrix3x3* reverse, const BGC_FP32_Versor* versor)
|
||||||
{
|
{
|
||||||
bgc_fp32_versor_get_reverse_matrix(versor, reverse);
|
bgc_fp32_versor_get_reverse_matrix(reverse, versor);
|
||||||
bgc_fp32_matrix3x3_get_transposed(reverse, rotation);
|
bgc_fp32_matrix3x3_get_transposed(rotation, reverse);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_get_both_matrices(const BGC_FP64_Versor* versor, BGC_FP64_Matrix3x3* rotation, BGC_FP64_Matrix3x3* reverse)
|
inline void bgc_fp64_versor_get_both_matrices(BGC_FP64_Matrix3x3* rotation, BGC_FP64_Matrix3x3* reverse, const BGC_FP64_Versor* versor)
|
||||||
{
|
{
|
||||||
bgc_fp64_versor_get_reverse_matrix(versor, reverse);
|
bgc_fp64_versor_get_reverse_matrix(reverse, versor);
|
||||||
bgc_fp64_matrix3x3_get_transposed(reverse, rotation);
|
bgc_fp64_matrix3x3_get_transposed(rotation, reverse);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================ Turn Vector ================= //
|
// ================ Turn Vector ================= //
|
||||||
|
|
||||||
inline void bgc_fp32_versor_turn_vector(const BGC_FP32_Versor* versor, const BGC_FP32_Vector3* vector, BGC_FP32_Vector3* result)
|
inline void bgc_fp32_versor_turn_vector(BGC_FP32_Vector3* turned_vector, const BGC_FP32_Versor* versor, const BGC_FP32_Vector3* vector)
|
||||||
{
|
{
|
||||||
const float tx1 = 2.0f * (versor->_x2 * vector->x3 - versor->_x3 * vector->x2);
|
const float tx1 = 2.0f * (versor->_x2 * vector->x3 - versor->_x3 * vector->x2);
|
||||||
const float tx2 = 2.0f * (versor->_x3 * vector->x1 - versor->_x1 * vector->x3);
|
const float tx2 = 2.0f * (versor->_x3 * vector->x1 - versor->_x1 * vector->x3);
|
||||||
|
|
@ -582,12 +582,12 @@ inline void bgc_fp32_versor_turn_vector(const BGC_FP32_Versor* versor, const BGC
|
||||||
const float x2 = (vector->x2 + tx2 * versor->_s0) + (versor->_x3 * tx1 - versor->_x1 * tx3);
|
const float x2 = (vector->x2 + tx2 * versor->_s0) + (versor->_x3 * tx1 - versor->_x1 * tx3);
|
||||||
const float x3 = (vector->x3 + tx3 * versor->_s0) + (versor->_x1 * tx2 - versor->_x2 * tx1);
|
const float x3 = (vector->x3 + tx3 * versor->_s0) + (versor->_x1 * tx2 - versor->_x2 * tx1);
|
||||||
|
|
||||||
result->x1 = x1;
|
turned_vector->x1 = x1;
|
||||||
result->x2 = x2;
|
turned_vector->x2 = x2;
|
||||||
result->x3 = x3;
|
turned_vector->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_turn_vector(const BGC_FP64_Versor* versor, const BGC_FP64_Vector3* vector, BGC_FP64_Vector3* result)
|
inline void bgc_fp64_versor_turn_vector(BGC_FP64_Vector3* turned_vector, const BGC_FP64_Versor* versor, const BGC_FP64_Vector3* vector)
|
||||||
{
|
{
|
||||||
const double tx1 = 2.0 * (versor->_x2 * vector->x3 - versor->_x3 * vector->x2);
|
const double tx1 = 2.0 * (versor->_x2 * vector->x3 - versor->_x3 * vector->x2);
|
||||||
const double tx2 = 2.0 * (versor->_x3 * vector->x1 - versor->_x1 * vector->x3);
|
const double tx2 = 2.0 * (versor->_x3 * vector->x1 - versor->_x1 * vector->x3);
|
||||||
|
|
@ -597,14 +597,14 @@ inline void bgc_fp64_versor_turn_vector(const BGC_FP64_Versor* versor, const BGC
|
||||||
const double x2 = (vector->x2 + tx2 * versor->_s0) + (versor->_x3 * tx1 - versor->_x1 * tx3);
|
const double x2 = (vector->x2 + tx2 * versor->_s0) + (versor->_x3 * tx1 - versor->_x1 * tx3);
|
||||||
const double x3 = (vector->x3 + tx3 * versor->_s0) + (versor->_x1 * tx2 - versor->_x2 * tx1);
|
const double x3 = (vector->x3 + tx3 * versor->_s0) + (versor->_x1 * tx2 - versor->_x2 * tx1);
|
||||||
|
|
||||||
result->x1 = x1;
|
turned_vector->x1 = x1;
|
||||||
result->x2 = x2;
|
turned_vector->x2 = x2;
|
||||||
result->x3 = x3;
|
turned_vector->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============== Turn Vector Back ============== //
|
// ============== Turn Vector Back ============== //
|
||||||
|
|
||||||
inline void bgc_fp32_versor_turn_vector_back(const BGC_FP32_Versor* versor, const BGC_FP32_Vector3* vector, BGC_FP32_Vector3* result)
|
inline void bgc_fp32_versor_turn_vector_back(BGC_FP32_Vector3* turned_vector, const BGC_FP32_Versor* versor, const BGC_FP32_Vector3* vector)
|
||||||
{
|
{
|
||||||
const float tx1 = 2.0f * (versor->_x2 * vector->x3 - versor->_x3 * vector->x2);
|
const float tx1 = 2.0f * (versor->_x2 * vector->x3 - versor->_x3 * vector->x2);
|
||||||
const float tx2 = 2.0f * (versor->_x3 * vector->x1 - versor->_x1 * vector->x3);
|
const float tx2 = 2.0f * (versor->_x3 * vector->x1 - versor->_x1 * vector->x3);
|
||||||
|
|
@ -614,12 +614,12 @@ inline void bgc_fp32_versor_turn_vector_back(const BGC_FP32_Versor* versor, cons
|
||||||
const float x2 = (vector->x2 - tx2 * versor->_s0) + (versor->_x3 * tx1 - versor->_x1 * tx3);
|
const float x2 = (vector->x2 - tx2 * versor->_s0) + (versor->_x3 * tx1 - versor->_x1 * tx3);
|
||||||
const float x3 = (vector->x3 - tx3 * versor->_s0) + (versor->_x1 * tx2 - versor->_x2 * tx1);
|
const float x3 = (vector->x3 - tx3 * versor->_s0) + (versor->_x1 * tx2 - versor->_x2 * tx1);
|
||||||
|
|
||||||
result->x1 = x1;
|
turned_vector->x1 = x1;
|
||||||
result->x2 = x2;
|
turned_vector->x2 = x2;
|
||||||
result->x3 = x3;
|
turned_vector->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
inline void bgc_fp64_versor_turn_vector_back(const BGC_FP64_Versor* versor, const BGC_FP64_Vector3* vector, BGC_FP64_Vector3* result)
|
inline void bgc_fp64_versor_turn_vector_back(BGC_FP64_Vector3* turned_vector, const BGC_FP64_Versor* versor, const BGC_FP64_Vector3* vector)
|
||||||
{
|
{
|
||||||
const double tx1 = 2.0 * (versor->_x2 * vector->x3 - versor->_x3 * vector->x2);
|
const double tx1 = 2.0 * (versor->_x2 * vector->x3 - versor->_x3 * vector->x2);
|
||||||
const double tx2 = 2.0 * (versor->_x3 * vector->x1 - versor->_x1 * vector->x3);
|
const double tx2 = 2.0 * (versor->_x3 * vector->x1 - versor->_x1 * vector->x3);
|
||||||
|
|
@ -629,9 +629,9 @@ inline void bgc_fp64_versor_turn_vector_back(const BGC_FP64_Versor* versor, cons
|
||||||
const double x2 = (vector->x2 - tx2 * versor->_s0) + (versor->_x3 * tx1 - versor->_x1 * tx3);
|
const double x2 = (vector->x2 - tx2 * versor->_s0) + (versor->_x3 * tx1 - versor->_x1 * tx3);
|
||||||
const double x3 = (vector->x3 - tx3 * versor->_s0) + (versor->_x1 * tx2 - versor->_x2 * tx1);
|
const double x3 = (vector->x3 - tx3 * versor->_s0) + (versor->_x1 * tx2 - versor->_x2 * tx1);
|
||||||
|
|
||||||
result->x1 = x1;
|
turned_vector->x1 = x1;
|
||||||
result->x2 = x2;
|
turned_vector->x2 = x2;
|
||||||
result->x3 = x3;
|
turned_vector->x3 = x3;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================== Are Close ================= //
|
// ================== Are Close ================= //
|
||||||
|
|
|
||||||
Loading…
Add table
Add a link
Reference in a new issue