Добавление квалификатора const, который запрещает изменение указателя
This commit is contained in:
parent
51fafe50c8
commit
610756ffed
14 changed files with 1019 additions and 1039 deletions
|
|
@ -9,14 +9,14 @@
|
|||
|
||||
// =================== Reset ==================== //
|
||||
|
||||
inline void bgc_fp32_vector3_reset(BGC_FP32_Vector3* vector)
|
||||
inline void bgc_fp32_vector3_reset(BGC_FP32_Vector3* const vector)
|
||||
{
|
||||
vector->x1 = 0.0f;
|
||||
vector->x2 = 0.0f;
|
||||
vector->x3 = 0.0f;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_reset(BGC_FP64_Vector3* vector)
|
||||
inline void bgc_fp64_vector3_reset(BGC_FP64_Vector3* const vector)
|
||||
{
|
||||
vector->x1 = 0.0;
|
||||
vector->x2 = 0.0;
|
||||
|
|
@ -25,14 +25,14 @@ inline void bgc_fp64_vector3_reset(BGC_FP64_Vector3* vector)
|
|||
|
||||
// ==================== Set ===================== //
|
||||
|
||||
inline void bgc_fp32_vector3_make(BGC_FP32_Vector3* destination, const float x1, const float x2, const float x3)
|
||||
inline void bgc_fp32_vector3_make(BGC_FP32_Vector3* const destination, const float x1, const float x2, const float x3)
|
||||
{
|
||||
destination->x1 = x1;
|
||||
destination->x2 = x2;
|
||||
destination->x3 = x3;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_make(BGC_FP64_Vector3* destination, const double x1, const double x2, const double x3)
|
||||
inline void bgc_fp64_vector3_make(BGC_FP64_Vector3* const destination, const double x1, const double x2, const double x3)
|
||||
{
|
||||
destination->x1 = x1;
|
||||
destination->x2 = x2;
|
||||
|
|
@ -41,58 +41,58 @@ inline void bgc_fp64_vector3_make(BGC_FP64_Vector3* destination, const double x1
|
|||
|
||||
// ================== Modulus =================== //
|
||||
|
||||
inline float bgc_fp32_vector3_get_squared_length(const BGC_FP32_Vector3* vector)
|
||||
inline float bgc_fp32_vector3_get_squared_length(const BGC_FP32_Vector3* const vector)
|
||||
{
|
||||
return vector->x1 * vector->x1 + vector->x2 * vector->x2 + vector->x3 * vector->x3;
|
||||
}
|
||||
|
||||
inline double bgc_fp64_vector3_get_squared_length(const BGC_FP64_Vector3* vector)
|
||||
inline double bgc_fp64_vector3_get_squared_length(const BGC_FP64_Vector3* const vector)
|
||||
{
|
||||
return vector->x1 * vector->x1 + vector->x2 * vector->x2 + vector->x3 * vector->x3;
|
||||
}
|
||||
|
||||
inline float bgc_fp32_vector3_get_length(const BGC_FP32_Vector3* vector)
|
||||
inline float bgc_fp32_vector3_get_length(const BGC_FP32_Vector3* const vector)
|
||||
{
|
||||
return sqrtf(bgc_fp32_vector3_get_squared_length(vector));
|
||||
}
|
||||
|
||||
inline double bgc_fp64_vector3_get_length(const BGC_FP64_Vector3* vector)
|
||||
inline double bgc_fp64_vector3_get_length(const BGC_FP64_Vector3* const vector)
|
||||
{
|
||||
return sqrt(bgc_fp64_vector3_get_squared_length(vector));
|
||||
}
|
||||
|
||||
// ================= Comparison ================= //
|
||||
|
||||
inline int bgc_fp32_vector3_is_zero(const BGC_FP32_Vector3* vector)
|
||||
inline int bgc_fp32_vector3_is_zero(const BGC_FP32_Vector3* const vector)
|
||||
{
|
||||
return bgc_fp32_vector3_get_squared_length(vector) <= BGC_FP32_SQUARE_EPSILON;
|
||||
}
|
||||
|
||||
inline int bgc_fp64_vector3_is_zero(const BGC_FP64_Vector3* vector)
|
||||
inline int bgc_fp64_vector3_is_zero(const BGC_FP64_Vector3* const vector)
|
||||
{
|
||||
return bgc_fp64_vector3_get_squared_length(vector) <= BGC_FP64_SQUARE_EPSILON;
|
||||
}
|
||||
|
||||
inline int bgc_fp32_vector3_is_unit(const BGC_FP32_Vector3* vector)
|
||||
inline int bgc_fp32_vector3_is_unit(const BGC_FP32_Vector3* const vector)
|
||||
{
|
||||
return bgc_fp32_is_square_unit(bgc_fp32_vector3_get_squared_length(vector));
|
||||
}
|
||||
|
||||
inline int bgc_fp64_vector3_is_unit(const BGC_FP64_Vector3* vector)
|
||||
inline int bgc_fp64_vector3_is_unit(const BGC_FP64_Vector3* const vector)
|
||||
{
|
||||
return bgc_fp64_is_square_unit(bgc_fp64_vector3_get_squared_length(vector));
|
||||
}
|
||||
|
||||
// ==================== Copy ==================== //
|
||||
|
||||
inline void bgc_fp32_vector3_copy(BGC_FP32_Vector3* destination, const BGC_FP32_Vector3* source)
|
||||
inline void bgc_fp32_vector3_copy(BGC_FP32_Vector3* const destination, const BGC_FP32_Vector3* const source)
|
||||
{
|
||||
destination->x1 = source->x1;
|
||||
destination->x2 = source->x2;
|
||||
destination->x3 = source->x3;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_copy(BGC_FP64_Vector3* destination, const BGC_FP64_Vector3* source)
|
||||
inline void bgc_fp64_vector3_copy(BGC_FP64_Vector3* const destination, const BGC_FP64_Vector3* const source)
|
||||
{
|
||||
destination->x1 = source->x1;
|
||||
destination->x2 = source->x2;
|
||||
|
|
@ -101,7 +101,7 @@ inline void bgc_fp64_vector3_copy(BGC_FP64_Vector3* destination, const BGC_FP64_
|
|||
|
||||
// ==================== Swap ==================== //
|
||||
|
||||
inline void bgc_fp32_vector3_swap(BGC_FP32_Vector3* vector1, BGC_FP32_Vector3* vector2)
|
||||
inline void bgc_fp32_vector3_swap(BGC_FP32_Vector3* const vector1, BGC_FP32_Vector3* const vector2)
|
||||
{
|
||||
const float x1 = vector2->x1;
|
||||
const float x2 = vector2->x2;
|
||||
|
|
@ -116,7 +116,7 @@ inline void bgc_fp32_vector3_swap(BGC_FP32_Vector3* vector1, BGC_FP32_Vector3* v
|
|||
vector1->x3 = x3;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_swap(BGC_FP64_Vector3* vector1, BGC_FP64_Vector3* vector2)
|
||||
inline void bgc_fp64_vector3_swap(BGC_FP64_Vector3* const vector1, BGC_FP64_Vector3* const vector2)
|
||||
{
|
||||
const double x1 = vector2->x1;
|
||||
const double x2 = vector2->x2;
|
||||
|
|
@ -133,14 +133,14 @@ inline void bgc_fp64_vector3_swap(BGC_FP64_Vector3* vector1, BGC_FP64_Vector3* v
|
|||
|
||||
// ================== Convert =================== //
|
||||
|
||||
inline void bgc_fp32_vector3_convert_to_fp64(BGC_FP64_Vector3* destination, const BGC_FP32_Vector3* source)
|
||||
inline void bgc_fp32_vector3_convert_to_fp64(BGC_FP64_Vector3* const destination, const BGC_FP32_Vector3* const source)
|
||||
{
|
||||
destination->x1 = source->x1;
|
||||
destination->x2 = source->x2;
|
||||
destination->x3 = source->x3;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_convert_to_fp32(BGC_FP32_Vector3* destination, const BGC_FP64_Vector3* source)
|
||||
inline void bgc_fp64_vector3_convert_to_fp32(BGC_FP32_Vector3* const destination, const BGC_FP64_Vector3* const source)
|
||||
{
|
||||
destination->x1 = (float)source->x1;
|
||||
destination->x2 = (float)source->x2;
|
||||
|
|
@ -149,14 +149,14 @@ inline void bgc_fp64_vector3_convert_to_fp32(BGC_FP32_Vector3* destination, cons
|
|||
|
||||
// ==================== Add ===================== //
|
||||
|
||||
inline void bgc_fp32_vector3_add(BGC_FP32_Vector3* sum, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||
inline void bgc_fp32_vector3_add(BGC_FP32_Vector3* const sum, const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2)
|
||||
{
|
||||
sum->x1 = vector1->x1 + vector2->x1;
|
||||
sum->x2 = vector1->x2 + vector2->x2;
|
||||
sum->x3 = vector1->x3 + vector2->x3;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_add(BGC_FP64_Vector3* sum, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||
inline void bgc_fp64_vector3_add(BGC_FP64_Vector3* const sum, const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2)
|
||||
{
|
||||
sum->x1 = vector1->x1 + vector2->x1;
|
||||
sum->x2 = vector1->x2 + vector2->x2;
|
||||
|
|
@ -165,14 +165,14 @@ inline void bgc_fp64_vector3_add(BGC_FP64_Vector3* sum, const BGC_FP64_Vector3*
|
|||
|
||||
// ================= Add scaled ================= //
|
||||
|
||||
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)
|
||||
inline void bgc_fp32_vector3_add_scaled(BGC_FP32_Vector3* const sum, const BGC_FP32_Vector3* const basic_vector, const BGC_FP32_Vector3* const scalable_vector, const float scale)
|
||||
{
|
||||
sum->x1 = basic_vector->x1 + scalable_vector->x1 * scale;
|
||||
sum->x2 = basic_vector->x2 + scalable_vector->x2 * scale;
|
||||
sum->x3 = basic_vector->x3 + scalable_vector->x3 * scale;
|
||||
}
|
||||
|
||||
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)
|
||||
inline void bgc_fp64_vector3_add_scaled(BGC_FP64_Vector3* const sum, const BGC_FP64_Vector3* const basic_vector, const BGC_FP64_Vector3* const scalable_vector, const double scale)
|
||||
{
|
||||
sum->x1 = basic_vector->x1 + scalable_vector->x1 * scale;
|
||||
sum->x2 = basic_vector->x2 + scalable_vector->x2 * scale;
|
||||
|
|
@ -181,14 +181,14 @@ inline void bgc_fp64_vector3_add_scaled(BGC_FP64_Vector3* sum, const BGC_FP64_Ve
|
|||
|
||||
// ================== Subtract ================== //
|
||||
|
||||
inline void bgc_fp32_vector3_subtract(BGC_FP32_Vector3* difference, const BGC_FP32_Vector3* minuend, const BGC_FP32_Vector3* subtrahend)
|
||||
inline void bgc_fp32_vector3_subtract(BGC_FP32_Vector3* const difference, const BGC_FP32_Vector3* const minuend, const BGC_FP32_Vector3* const subtrahend)
|
||||
{
|
||||
difference->x1 = minuend->x1 - subtrahend->x1;
|
||||
difference->x2 = minuend->x2 - subtrahend->x2;
|
||||
difference->x3 = minuend->x3 - subtrahend->x3;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_subtract(BGC_FP64_Vector3* difference, const BGC_FP64_Vector3* minuend, const BGC_FP64_Vector3* subtrahend)
|
||||
inline void bgc_fp64_vector3_subtract(BGC_FP64_Vector3* const difference, const BGC_FP64_Vector3* const minuend, const BGC_FP64_Vector3* const subtrahend)
|
||||
{
|
||||
difference->x1 = minuend->x1 - subtrahend->x1;
|
||||
difference->x2 = minuend->x2 - subtrahend->x2;
|
||||
|
|
@ -197,14 +197,14 @@ inline void bgc_fp64_vector3_subtract(BGC_FP64_Vector3* difference, const BGC_FP
|
|||
|
||||
// ============== Subtract Scaled =============== //
|
||||
|
||||
inline void bgc_fp32_vector3_subtract_scaled(BGC_FP32_Vector3* difference, const BGC_FP32_Vector3* basic_vector, const BGC_FP32_Vector3* scalable_vector, const float scale)
|
||||
inline void bgc_fp32_vector3_subtract_scaled(BGC_FP32_Vector3* const difference, const BGC_FP32_Vector3* const basic_vector, const BGC_FP32_Vector3* const scalable_vector, const float scale)
|
||||
{
|
||||
difference->x1 = basic_vector->x1 - scalable_vector->x1 * scale;
|
||||
difference->x2 = basic_vector->x2 - scalable_vector->x2 * scale;
|
||||
difference->x3 = basic_vector->x3 - scalable_vector->x3 * scale;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_subtract_scaled(BGC_FP64_Vector3* difference, const BGC_FP64_Vector3* basic_vector, const BGC_FP64_Vector3* scalable_vector, const double scale)
|
||||
inline void bgc_fp64_vector3_subtract_scaled(BGC_FP64_Vector3* const difference, const BGC_FP64_Vector3* const basic_vector, const BGC_FP64_Vector3* const scalable_vector, const double scale)
|
||||
{
|
||||
difference->x1 = basic_vector->x1 - scalable_vector->x1 * scale;
|
||||
difference->x2 = basic_vector->x2 - scalable_vector->x2 * scale;
|
||||
|
|
@ -213,14 +213,14 @@ inline void bgc_fp64_vector3_subtract_scaled(BGC_FP64_Vector3* difference, const
|
|||
|
||||
// ================== Multiply ================== //
|
||||
|
||||
inline void bgc_fp32_vector3_multiply_by_real(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* multiplicand, const float multiplier)
|
||||
inline void bgc_fp32_vector3_multiply_by_real(BGC_FP32_Vector3* const product, const BGC_FP32_Vector3* const multiplicand, const float multiplier)
|
||||
{
|
||||
product->x1 = multiplicand->x1 * multiplier;
|
||||
product->x2 = multiplicand->x2 * multiplier;
|
||||
product->x3 = multiplicand->x3 * multiplier;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_multiply_by_real(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* multiplicand, const double multiplier)
|
||||
inline void bgc_fp64_vector3_multiply_by_real(BGC_FP64_Vector3* const product, const BGC_FP64_Vector3* const multiplicand, const double multiplier)
|
||||
{
|
||||
product->x1 = multiplicand->x1 * multiplier;
|
||||
product->x2 = multiplicand->x2 * multiplier;
|
||||
|
|
@ -229,13 +229,13 @@ inline void bgc_fp64_vector3_multiply_by_real(BGC_FP64_Vector3* product, const B
|
|||
|
||||
// ============ Left Vector Product ============= //
|
||||
|
||||
inline void bgc_fp32_vector3_multiply_by_matrix2x3(BGC_FP32_Vector2* product, const BGC_FP32_Vector3* vector, const BGC_FP32_Matrix2x3* matrix)
|
||||
inline void bgc_fp32_vector3_multiply_by_matrix2x3(BGC_FP32_Vector2* const product, const BGC_FP32_Vector3* const vector, const BGC_FP32_Matrix2x3* const matrix)
|
||||
{
|
||||
product->x1 = vector->x1 * matrix->r1c1 + vector->x2 * matrix->r2c1 + vector->x3 * matrix->r3c1;
|
||||
product->x2 = vector->x1 * matrix->r1c2 + vector->x2 * matrix->r2c2 + vector->x3 * matrix->r3c2;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_multiply_by_matrix2x3(BGC_FP64_Vector2* product, const BGC_FP64_Vector3* vector, const BGC_FP64_Matrix2x3* matrix)
|
||||
inline void bgc_fp64_vector3_multiply_by_matrix2x3(BGC_FP64_Vector2* const product, const BGC_FP64_Vector3* const vector, const BGC_FP64_Matrix2x3* const matrix)
|
||||
{
|
||||
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;
|
||||
|
|
@ -243,7 +243,7 @@ inline void bgc_fp64_vector3_multiply_by_matrix2x3(BGC_FP64_Vector2* product, co
|
|||
|
||||
// ============ Left Vector Product ============= //
|
||||
|
||||
inline void bgc_fp32_vector3_multiply_by_matrix3x3(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* vector, const BGC_FP32_Matrix3x3* matrix)
|
||||
inline void bgc_fp32_vector3_multiply_by_matrix3x3(BGC_FP32_Vector3* const product, const BGC_FP32_Vector3* const vector, const BGC_FP32_Matrix3x3* const matrix)
|
||||
{
|
||||
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;
|
||||
|
|
@ -254,7 +254,7 @@ inline void bgc_fp32_vector3_multiply_by_matrix3x3(BGC_FP32_Vector3* product, co
|
|||
product->x3 = x3;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_multiply_by_matrix3x3(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* vector, const BGC_FP64_Matrix3x3* matrix)
|
||||
inline void bgc_fp64_vector3_multiply_by_matrix3x3(BGC_FP64_Vector3* const product, const BGC_FP64_Vector3* const vector, const BGC_FP64_Matrix3x3* const matrix)
|
||||
{
|
||||
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;
|
||||
|
|
@ -267,7 +267,7 @@ inline void bgc_fp64_vector3_multiply_by_matrix3x3(BGC_FP64_Vector3* product, co
|
|||
|
||||
// =================== Divide =================== //
|
||||
|
||||
inline int bgc_fp32_vector3_divide_by_real(BGC_FP32_Vector3* quotient, const BGC_FP32_Vector3* dividend, const float divisor)
|
||||
inline int bgc_fp32_vector3_divide_by_real(BGC_FP32_Vector3* const quotient, const BGC_FP32_Vector3* const dividend, const float divisor)
|
||||
{
|
||||
if (bgc_fp32_is_zero(divisor) || isnan(divisor)) {
|
||||
return BGC_FAILURE;
|
||||
|
|
@ -278,7 +278,7 @@ inline int bgc_fp32_vector3_divide_by_real(BGC_FP32_Vector3* quotient, const BGC
|
|||
return BGC_SUCCESS;
|
||||
}
|
||||
|
||||
inline int bgc_fp64_vector3_divide_by_real(BGC_FP64_Vector3* quotient, const BGC_FP64_Vector3* dividend, const double divisor)
|
||||
inline int bgc_fp64_vector3_divide_by_real(BGC_FP64_Vector3* const quotient, const BGC_FP64_Vector3* const dividend, const double divisor)
|
||||
{
|
||||
if (bgc_fp64_is_zero(divisor) || isnan(divisor)) {
|
||||
return BGC_FAILURE;
|
||||
|
|
@ -291,14 +291,14 @@ inline int bgc_fp64_vector3_divide_by_real(BGC_FP64_Vector3* quotient, const BGC
|
|||
|
||||
// ================== Average2 ================== //
|
||||
|
||||
inline void bgc_fp32_vector3_get_mean2(BGC_FP32_Vector3* mean, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||
inline void bgc_fp32_vector3_get_mean2(BGC_FP32_Vector3* const mean, const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2)
|
||||
{
|
||||
mean->x1 = (vector1->x1 + vector2->x1) * 0.5f;
|
||||
mean->x2 = (vector1->x2 + vector2->x2) * 0.5f;
|
||||
mean->x3 = (vector1->x3 + vector2->x3) * 0.5f;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_get_mean2(BGC_FP64_Vector3* mean, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||
inline void bgc_fp64_vector3_get_mean2(BGC_FP64_Vector3* const mean, const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2)
|
||||
{
|
||||
mean->x1 = (vector1->x1 + vector2->x1) * 0.5;
|
||||
mean->x2 = (vector1->x2 + vector2->x2) * 0.5;
|
||||
|
|
@ -307,14 +307,14 @@ inline void bgc_fp64_vector3_get_mean2(BGC_FP64_Vector3* mean, const BGC_FP64_Ve
|
|||
|
||||
// ================== Average3 ================== //
|
||||
|
||||
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)
|
||||
inline void bgc_fp32_vector3_get_mean3(BGC_FP32_Vector3* const mean, const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2, const BGC_FP32_Vector3* const vector3)
|
||||
{
|
||||
mean->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP32_ONE_THIRD;
|
||||
mean->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP32_ONE_THIRD;
|
||||
mean->x3 = (vector1->x3 + vector2->x3 + vector3->x3) * BGC_FP32_ONE_THIRD;
|
||||
}
|
||||
|
||||
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)
|
||||
inline void bgc_fp64_vector3_get_mean3(BGC_FP64_Vector3* const mean, const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2, const BGC_FP64_Vector3* const vector3)
|
||||
{
|
||||
mean->x1 = (vector1->x1 + vector2->x1 + vector3->x1) * BGC_FP64_ONE_THIRD;
|
||||
mean->x2 = (vector1->x2 + vector2->x2 + vector3->x2) * BGC_FP64_ONE_THIRD;
|
||||
|
|
@ -323,7 +323,7 @@ inline void bgc_fp64_vector3_get_mean3(BGC_FP64_Vector3* mean, const BGC_FP64_Ve
|
|||
|
||||
// =================== Linear =================== //
|
||||
|
||||
inline void bgc_fp32_vector3_interpolate(BGC_FP32_Vector3* interpolation, const BGC_FP32_Vector3* first, const BGC_FP32_Vector3* second, const float phase)
|
||||
inline void bgc_fp32_vector3_interpolate(BGC_FP32_Vector3* const interpolation, const BGC_FP32_Vector3* const first, const BGC_FP32_Vector3* const second, const float phase)
|
||||
{
|
||||
const float counter_phase = 1.0f - phase;
|
||||
|
||||
|
|
@ -332,7 +332,7 @@ inline void bgc_fp32_vector3_interpolate(BGC_FP32_Vector3* interpolation, const
|
|||
interpolation->x3 = first->x3 * counter_phase + second->x3 * phase;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_interpolate(BGC_FP64_Vector3* interpolation, const BGC_FP64_Vector3* first, const BGC_FP64_Vector3* second, const double phase)
|
||||
inline void bgc_fp64_vector3_interpolate(BGC_FP64_Vector3* const interpolation, const BGC_FP64_Vector3* const first, const BGC_FP64_Vector3* const second, const double phase)
|
||||
{
|
||||
const double counter_phase = 1.0 - phase;
|
||||
|
||||
|
|
@ -343,28 +343,28 @@ inline void bgc_fp64_vector3_interpolate(BGC_FP64_Vector3* interpolation, const
|
|||
|
||||
// ================== Negative ================== //
|
||||
|
||||
inline void bgc_fp32_vector3_revert(BGC_FP32_Vector3* vector)
|
||||
inline void bgc_fp32_vector3_revert(BGC_FP32_Vector3* const vector)
|
||||
{
|
||||
vector->x1 = -vector->x1;
|
||||
vector->x2 = -vector->x2;
|
||||
vector->x3 = -vector->x3;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_revert(BGC_FP64_Vector3* vector)
|
||||
inline void bgc_fp64_vector3_revert(BGC_FP64_Vector3* const vector)
|
||||
{
|
||||
vector->x1 = -vector->x1;
|
||||
vector->x2 = -vector->x2;
|
||||
vector->x3 = -vector->x3;
|
||||
}
|
||||
|
||||
inline void bgc_fp32_vector3_get_reverse(BGC_FP32_Vector3* reverse, const BGC_FP32_Vector3* vector)
|
||||
inline void bgc_fp32_vector3_get_reverse(BGC_FP32_Vector3* const reverse, const BGC_FP32_Vector3* const vector)
|
||||
{
|
||||
reverse->x1 = -vector->x1;
|
||||
reverse->x2 = -vector->x2;
|
||||
reverse->x3 = -vector->x3;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_get_reverse(BGC_FP64_Vector3* reverse, const BGC_FP64_Vector3* vector)
|
||||
inline void bgc_fp64_vector3_get_reverse(BGC_FP64_Vector3* const reverse, const BGC_FP64_Vector3* const vector)
|
||||
{
|
||||
reverse->x1 = -vector->x1;
|
||||
reverse->x2 = -vector->x2;
|
||||
|
|
@ -373,7 +373,7 @@ inline void bgc_fp64_vector3_get_reverse(BGC_FP64_Vector3* reverse, const BGC_FP
|
|||
|
||||
// ================= Normalize ================== //
|
||||
|
||||
inline int bgc_fp32_vector3_normalize(BGC_FP32_Vector3* vector)
|
||||
inline int bgc_fp32_vector3_normalize(BGC_FP32_Vector3* const vector)
|
||||
{
|
||||
const float square_modulus = bgc_fp32_vector3_get_squared_length(vector);
|
||||
|
||||
|
|
@ -394,7 +394,7 @@ inline int bgc_fp32_vector3_normalize(BGC_FP32_Vector3* vector)
|
|||
return BGC_SUCCESS;
|
||||
}
|
||||
|
||||
inline int bgc_fp64_vector3_normalize(BGC_FP64_Vector3* vector)
|
||||
inline int bgc_fp64_vector3_normalize(BGC_FP64_Vector3* const vector)
|
||||
{
|
||||
const double square_modulus = bgc_fp64_vector3_get_squared_length(vector);
|
||||
|
||||
|
|
@ -415,7 +415,7 @@ inline int bgc_fp64_vector3_normalize(BGC_FP64_Vector3* vector)
|
|||
return BGC_SUCCESS;
|
||||
}
|
||||
|
||||
inline int bgc_fp32_vector3_get_normalized(BGC_FP32_Vector3* normalized, const BGC_FP32_Vector3* vector)
|
||||
inline int bgc_fp32_vector3_get_normalized(BGC_FP32_Vector3* const normalized, const BGC_FP32_Vector3* const vector)
|
||||
{
|
||||
const float square_modulus = bgc_fp32_vector3_get_squared_length(vector);
|
||||
|
||||
|
|
@ -433,7 +433,7 @@ inline int bgc_fp32_vector3_get_normalized(BGC_FP32_Vector3* normalized, const B
|
|||
return BGC_SUCCESS;
|
||||
}
|
||||
|
||||
inline int bgc_fp64_vector3_get_normalized(BGC_FP64_Vector3* normalized, const BGC_FP64_Vector3* vector)
|
||||
inline int bgc_fp64_vector3_get_normalized(BGC_FP64_Vector3* const normalized, const BGC_FP64_Vector3* const vector)
|
||||
{
|
||||
const double square_modulus = bgc_fp64_vector3_get_squared_length(vector);
|
||||
|
||||
|
|
@ -453,26 +453,26 @@ inline int bgc_fp64_vector3_get_normalized(BGC_FP64_Vector3* normalized, const B
|
|||
|
||||
// =============== Scalar Product =============== //
|
||||
|
||||
inline float bgc_fp32_vector3_get_dot_product(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||
inline float bgc_fp32_vector3_get_dot_product(const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2)
|
||||
{
|
||||
return vector1->x1 * vector2->x1 + vector1->x2 * vector2->x2 + vector1->x3 * vector2->x3;
|
||||
}
|
||||
|
||||
inline double bgc_fp64_vector3_get_dot_product(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||
inline double bgc_fp64_vector3_get_dot_product(const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2)
|
||||
{
|
||||
return vector1->x1 * vector2->x1 + vector1->x2 * vector2->x2 + vector1->x3 * vector2->x3;
|
||||
}
|
||||
|
||||
// =============== Triple Product =============== //
|
||||
|
||||
inline float bgc_fp32_vector3_get_triple_product(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3)
|
||||
inline float bgc_fp32_vector3_get_triple_product(const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2, const BGC_FP32_Vector3* const vector3)
|
||||
{
|
||||
return vector1->x1 * (vector2->x2 * vector3->x3 - vector2->x3 * vector3->x2)
|
||||
+ vector1->x2 * (vector2->x3 * vector3->x1 - vector2->x1 * vector3->x3)
|
||||
+ vector1->x3 * (vector2->x1 * vector3->x2 - vector2->x2 * vector3->x1);
|
||||
}
|
||||
|
||||
inline double bgc_fp64_vector3_get_triple_product(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3)
|
||||
inline double bgc_fp64_vector3_get_triple_product(const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2, const BGC_FP64_Vector3* const vector3)
|
||||
{
|
||||
return vector1->x1 * (vector2->x2 * vector3->x3 - vector2->x3 * vector3->x2)
|
||||
+ vector1->x2 * (vector2->x3 * vector3->x1 - vector2->x1 * vector3->x3)
|
||||
|
|
@ -481,14 +481,14 @@ inline double bgc_fp64_vector3_get_triple_product(const BGC_FP64_Vector3* vector
|
|||
|
||||
// =========== Restrict Cross Product =========== //
|
||||
|
||||
inline void _bgc_fp32_restrict_vector3_get_cross_product(BGC_FP32_Vector3* restrict product, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||
inline void _bgc_fp32_restrict_vector3_get_cross_product(BGC_FP32_Vector3* restrict const product, const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2)
|
||||
{
|
||||
product->x1 = vector1->x2 * vector2->x3 - vector1->x3 * vector2->x2;
|
||||
product->x2 = vector1->x3 * vector2->x1 - vector1->x1 * vector2->x3;
|
||||
product->x3 = vector1->x1 * vector2->x2 - vector1->x2 * vector2->x1;
|
||||
}
|
||||
|
||||
inline void _bgc_fp64_restrict_vector3_get_cross_product(BGC_FP64_Vector3* restrict product, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||
inline void _bgc_fp64_restrict_vector3_get_cross_product(BGC_FP64_Vector3* restrict const product, const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2)
|
||||
{
|
||||
product->x1 = vector1->x2 * vector2->x3 - vector1->x3 * vector2->x2;
|
||||
product->x2 = vector1->x3 * vector2->x1 - vector1->x1 * vector2->x3;
|
||||
|
|
@ -497,7 +497,7 @@ inline void _bgc_fp64_restrict_vector3_get_cross_product(BGC_FP64_Vector3* restr
|
|||
|
||||
// =============== Cross Product ================ //
|
||||
|
||||
inline void bgc_fp32_vector3_get_cross_product(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||
inline void bgc_fp32_vector3_get_cross_product(BGC_FP32_Vector3* const product, const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2)
|
||||
{
|
||||
const float x1 = vector1->x2 * vector2->x3 - vector1->x3 * vector2->x2;
|
||||
const float x2 = vector1->x3 * vector2->x1 - vector1->x1 * vector2->x3;
|
||||
|
|
@ -508,7 +508,7 @@ inline void bgc_fp32_vector3_get_cross_product(BGC_FP32_Vector3* product, const
|
|||
product->x3 = x3;
|
||||
}
|
||||
|
||||
inline void bgc_fp64_vector3_get_cross_product(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||
inline void bgc_fp64_vector3_get_cross_product(BGC_FP64_Vector3* const product, const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2)
|
||||
{
|
||||
const double x1 = vector1->x2 * vector2->x3 - vector1->x3 * vector2->x2;
|
||||
const double x2 = vector1->x3 * vector2->x1 - vector1->x1 * vector2->x3;
|
||||
|
|
@ -522,7 +522,7 @@ inline void bgc_fp64_vector3_get_cross_product(BGC_FP64_Vector3* product, const
|
|||
// ============ Double Cross Product ============ //
|
||||
|
||||
// [a x [b x c]] = b * (a, c) - c * (a, b)
|
||||
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)
|
||||
inline void bgc_fp32_vector3_get_double_cross(BGC_FP32_Vector3* const product, const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2, const BGC_FP32_Vector3* const vector3)
|
||||
{
|
||||
const float ac = bgc_fp32_vector3_get_dot_product(vector1, vector3);
|
||||
const float ab = bgc_fp32_vector3_get_dot_product(vector1, vector2);
|
||||
|
|
@ -533,7 +533,7 @@ inline void bgc_fp32_vector3_get_double_cross(BGC_FP32_Vector3* product, const B
|
|||
}
|
||||
|
||||
// [a x [b x c]] = b * (a, c) - c * (a, b)
|
||||
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)
|
||||
inline void bgc_fp64_vector3_get_double_cross(BGC_FP64_Vector3* const product, const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2, const BGC_FP64_Vector3* const vector3)
|
||||
{
|
||||
const double ac = bgc_fp64_vector3_get_dot_product(vector1, vector3);
|
||||
const double ab = bgc_fp64_vector3_get_dot_product(vector1, vector2);
|
||||
|
|
@ -546,7 +546,7 @@ inline void bgc_fp64_vector3_get_double_cross(BGC_FP64_Vector3* product, const B
|
|||
// ====== Alternative Double Cross Product ====== //
|
||||
|
||||
// [[a x b] x c] = - [c x [a x b]] = -(a * (c, b) - b * (c, a)) = b * (a, c) - a * (b, c)
|
||||
inline void bgc_fp32_vector3_get_alternative_double_cross(BGC_FP32_Vector3* product, const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const BGC_FP32_Vector3* vector3)
|
||||
inline void bgc_fp32_vector3_get_alternative_double_cross(BGC_FP32_Vector3* const product, const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2, const BGC_FP32_Vector3* const vector3)
|
||||
{
|
||||
const float ac = bgc_fp32_vector3_get_dot_product(vector1, vector3);
|
||||
const float bc = bgc_fp32_vector3_get_dot_product(vector2, vector3);
|
||||
|
|
@ -557,7 +557,7 @@ inline void bgc_fp32_vector3_get_alternative_double_cross(BGC_FP32_Vector3* prod
|
|||
}
|
||||
|
||||
// [[a x b] x c] = - [c x [a x b]] = -(a * (b, c) - b * (a, c)) = b * (a, c) - a * (b, c)
|
||||
inline void bgc_fp64_vector3_get_alternative_double_cross(BGC_FP64_Vector3* product, const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const BGC_FP64_Vector3* vector3)
|
||||
inline void bgc_fp64_vector3_get_alternative_double_cross(BGC_FP64_Vector3* const product, const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2, const BGC_FP64_Vector3* const vector3)
|
||||
{
|
||||
const double ac = bgc_fp64_vector3_get_dot_product(vector1, vector3);
|
||||
const double bc = bgc_fp64_vector3_get_dot_product(vector2, vector3);
|
||||
|
|
@ -569,13 +569,13 @@ inline void bgc_fp64_vector3_get_alternative_double_cross(BGC_FP64_Vector3* prod
|
|||
|
||||
// =================== Angle ==================== //
|
||||
|
||||
float bgc_fp32_vector3_get_angle(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const int angle_unit);
|
||||
float bgc_fp32_vector3_get_angle(const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2, const int angle_unit);
|
||||
|
||||
double bgc_fp64_vector3_get_angle(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const int angle_unit);
|
||||
double bgc_fp64_vector3_get_angle(const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2, const int angle_unit);
|
||||
|
||||
// =============== Square Distance ============== //
|
||||
|
||||
inline float bgc_fp32_vector3_get_square_distance(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||
inline float bgc_fp32_vector3_get_square_distance(const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2)
|
||||
{
|
||||
const float dx1 = (vector1->x1 - vector2->x1);
|
||||
const float dx2 = (vector1->x2 - vector2->x2);
|
||||
|
|
@ -584,7 +584,7 @@ inline float bgc_fp32_vector3_get_square_distance(const BGC_FP32_Vector3* vector
|
|||
return dx1 * dx1 + dx2 * dx2 + dx3 * dx3;
|
||||
}
|
||||
|
||||
inline double bgc_fp64_vector3_get_square_distance(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||
inline double bgc_fp64_vector3_get_square_distance(const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2)
|
||||
{
|
||||
const double dx1 = (vector1->x1 - vector2->x1);
|
||||
const double dx2 = (vector1->x2 - vector2->x2);
|
||||
|
|
@ -595,31 +595,31 @@ inline double bgc_fp64_vector3_get_square_distance(const BGC_FP64_Vector3* vecto
|
|||
|
||||
// ================== Distance ================== //
|
||||
|
||||
inline float bgc_fp32_vector3_get_distance(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||
inline float bgc_fp32_vector3_get_distance(const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2)
|
||||
{
|
||||
return sqrtf(bgc_fp32_vector3_get_square_distance(vector1, vector2));
|
||||
}
|
||||
|
||||
inline double bgc_fp64_vector3_get_distance(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||
inline double bgc_fp64_vector3_get_distance(const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2)
|
||||
{
|
||||
return sqrt(bgc_fp64_vector3_get_square_distance(vector1, vector2));
|
||||
}
|
||||
|
||||
// ============== Are Close Enough ============== //
|
||||
|
||||
inline int bgc_fp32_vector3_are_close_enough(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2, const float distance_limit)
|
||||
inline int bgc_fp32_vector3_are_close_enough(const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2, const float distance_limit)
|
||||
{
|
||||
return bgc_fp32_vector3_get_square_distance(vector1, vector2) <= distance_limit * distance_limit;
|
||||
}
|
||||
|
||||
inline int bgc_fp64_vector3_are_close_enough(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2, const double distance_limit)
|
||||
inline int bgc_fp64_vector3_are_close_enough(const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2, const double distance_limit)
|
||||
{
|
||||
return bgc_fp64_vector3_get_square_distance(vector1, vector2) <= distance_limit * distance_limit;
|
||||
}
|
||||
|
||||
// ================== Are Close ================= //
|
||||
|
||||
inline int bgc_fp32_vector3_are_close(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||
inline int bgc_fp32_vector3_are_close(const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2)
|
||||
{
|
||||
const float square_modulus1 = bgc_fp32_vector3_get_squared_length(vector1);
|
||||
const float square_modulus2 = bgc_fp32_vector3_get_squared_length(vector2);
|
||||
|
|
@ -632,7 +632,7 @@ inline int bgc_fp32_vector3_are_close(const BGC_FP32_Vector3* vector1, const BGC
|
|||
return square_distance <= BGC_FP32_SQUARE_EPSILON * square_modulus1 && square_distance <= BGC_FP32_SQUARE_EPSILON * square_modulus2;
|
||||
}
|
||||
|
||||
inline int bgc_fp64_vector3_are_close(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||
inline int bgc_fp64_vector3_are_close(const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2)
|
||||
{
|
||||
const double square_modulus1 = bgc_fp64_vector3_get_squared_length(vector1);
|
||||
const double square_modulus2 = bgc_fp64_vector3_get_squared_length(vector2);
|
||||
|
|
@ -647,7 +647,7 @@ inline int bgc_fp64_vector3_are_close(const BGC_FP64_Vector3* vector1, const BGC
|
|||
|
||||
// ================== Parallel ================== //
|
||||
|
||||
inline int bgc_fp32_vector3_are_parallel(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||
inline int bgc_fp32_vector3_are_parallel(const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2)
|
||||
{
|
||||
const float square_modulus1 = bgc_fp32_vector3_get_squared_length(vector1);
|
||||
const float square_modulus2 = bgc_fp32_vector3_get_squared_length(vector2);
|
||||
|
|
@ -663,7 +663,7 @@ inline int bgc_fp32_vector3_are_parallel(const BGC_FP32_Vector3* vector1, const
|
|||
return bgc_fp32_vector3_get_squared_length(&product) <= BGC_FP32_SQUARE_EPSILON * square_modulus1 * square_modulus2;
|
||||
}
|
||||
|
||||
inline int bgc_fp64_vector3_are_parallel(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||
inline int bgc_fp64_vector3_are_parallel(const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2)
|
||||
{
|
||||
const double square_modulus1 = bgc_fp64_vector3_get_squared_length(vector1);
|
||||
const double square_modulus2 = bgc_fp64_vector3_get_squared_length(vector2);
|
||||
|
|
@ -681,7 +681,7 @@ inline int bgc_fp64_vector3_are_parallel(const BGC_FP64_Vector3* vector1, const
|
|||
|
||||
// ================= Orthogonal ================= //
|
||||
|
||||
inline int bgc_fp32_vector3_are_orthogonal(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||
inline int bgc_fp32_vector3_are_orthogonal(const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2)
|
||||
{
|
||||
const float square_modulus1 = bgc_fp32_vector3_get_squared_length(vector1);
|
||||
const float square_modulus2 = bgc_fp32_vector3_get_squared_length(vector2);
|
||||
|
|
@ -695,7 +695,7 @@ inline int bgc_fp32_vector3_are_orthogonal(const BGC_FP32_Vector3* vector1, cons
|
|||
return scalar_product * scalar_product <= BGC_FP32_SQUARE_EPSILON * square_modulus1 * square_modulus2;
|
||||
}
|
||||
|
||||
inline int bgc_fp64_vector3_are_orthogonal(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||
inline int bgc_fp64_vector3_are_orthogonal(const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2)
|
||||
{
|
||||
const double square_modulus1 = bgc_fp64_vector3_get_squared_length(vector1);
|
||||
const double square_modulus2 = bgc_fp64_vector3_get_squared_length(vector2);
|
||||
|
|
@ -711,60 +711,8 @@ inline int bgc_fp64_vector3_are_orthogonal(const BGC_FP64_Vector3* vector1, cons
|
|||
|
||||
// ================== Attitude ================== //
|
||||
|
||||
inline int bgc_fp32_vector3_get_attitude(const BGC_FP32_Vector3* vector1, const BGC_FP32_Vector3* vector2)
|
||||
{
|
||||
const float square_modulus1 = bgc_fp32_vector3_get_squared_length(vector1);
|
||||
const float square_modulus2 = bgc_fp32_vector3_get_squared_length(vector2);
|
||||
int bgc_fp32_vector3_get_attitude(const BGC_FP32_Vector3* const vector1, const BGC_FP32_Vector3* const vector2);
|
||||
|
||||
if (square_modulus1 <= BGC_FP32_SQUARE_EPSILON || square_modulus2 <= BGC_FP32_SQUARE_EPSILON) {
|
||||
return BGC_ATTITUDE_ZERO;
|
||||
}
|
||||
|
||||
const float square_limit = BGC_FP32_SQUARE_EPSILON * square_modulus1 * square_modulus2;
|
||||
|
||||
const float scalar_product = bgc_fp32_vector3_get_dot_product(vector1, vector2);
|
||||
|
||||
if (scalar_product * scalar_product <= square_limit) {
|
||||
return BGC_ATTITUDE_ORTHOGONAL;
|
||||
}
|
||||
|
||||
BGC_FP32_Vector3 product;
|
||||
|
||||
_bgc_fp32_restrict_vector3_get_cross_product(&product, vector1, vector2);
|
||||
|
||||
if (bgc_fp32_vector3_get_squared_length(&product) > square_limit) {
|
||||
return BGC_ATTITUDE_ANY;
|
||||
}
|
||||
|
||||
return scalar_product > 0.0f ? BGC_ATTITUDE_CO_DIRECTIONAL : BGC_ATTITUDE_COUNTER_DIRECTIONAL;
|
||||
}
|
||||
|
||||
inline int bgc_fp64_vector3_get_attitude(const BGC_FP64_Vector3* vector1, const BGC_FP64_Vector3* vector2)
|
||||
{
|
||||
const double square_modulus1 = bgc_fp64_vector3_get_squared_length(vector1);
|
||||
const double square_modulus2 = bgc_fp64_vector3_get_squared_length(vector2);
|
||||
|
||||
if (square_modulus1 <= BGC_FP64_SQUARE_EPSILON || square_modulus2 <= BGC_FP64_SQUARE_EPSILON) {
|
||||
return BGC_ATTITUDE_ZERO;
|
||||
}
|
||||
|
||||
const double square_limit = BGC_FP64_SQUARE_EPSILON * square_modulus1 * square_modulus2;
|
||||
|
||||
const double scalar_product = bgc_fp64_vector3_get_dot_product(vector1, vector2);
|
||||
|
||||
if (scalar_product * scalar_product <= square_limit) {
|
||||
return BGC_ATTITUDE_ORTHOGONAL;
|
||||
}
|
||||
|
||||
BGC_FP64_Vector3 product;
|
||||
|
||||
_bgc_fp64_restrict_vector3_get_cross_product(&product, vector1, vector2);
|
||||
|
||||
if (bgc_fp64_vector3_get_squared_length(&product) > square_limit) {
|
||||
return BGC_ATTITUDE_ANY;
|
||||
}
|
||||
|
||||
return scalar_product > 0.0 ? BGC_ATTITUDE_CO_DIRECTIONAL : BGC_ATTITUDE_COUNTER_DIRECTIONAL;
|
||||
}
|
||||
int bgc_fp64_vector3_get_attitude(const BGC_FP64_Vector3* const vector1, const BGC_FP64_Vector3* const vector2);
|
||||
|
||||
#endif
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue