138 lines
10 KiB
C
138 lines
10 KiB
C
#include "./vector2.h"
|
|
|
|
extern inline void bgc_fp32_vector2_reset(BGC_FP32_Vector2* const vector);
|
|
extern inline void bgc_fp64_vector2_reset(BGC_FP64_Vector2* const vector);
|
|
|
|
extern inline void bgc_fp32_vector2_set_values(BGC_FP32_Vector2* const destination, const float x1, const float x2);
|
|
extern inline void bgc_fp64_vector2_set_values(BGC_FP64_Vector2* const destination, const double x1, const double x2);
|
|
|
|
extern inline float bgc_fp32_vector2_get_squared_length(const BGC_FP32_Vector2* const vector);
|
|
extern inline double bgc_fp64_vector2_get_squared_length(const BGC_FP64_Vector2* const vector);
|
|
|
|
extern inline float bgc_fp32_vector2_get_length(const BGC_FP32_Vector2* const vector);
|
|
extern inline double bgc_fp64_vector2_get_length(const BGC_FP64_Vector2* const vector);
|
|
|
|
extern inline int bgc_fp32_vector2_is_zero(const BGC_FP32_Vector2* const vector);
|
|
extern inline int bgc_fp64_vector2_is_zero(const BGC_FP64_Vector2* const vector);
|
|
|
|
extern inline int bgc_fp32_vector2_is_unit(const BGC_FP32_Vector2* const vector);
|
|
extern inline int bgc_fp64_vector2_is_unit(const BGC_FP64_Vector2* const vector);
|
|
|
|
extern inline void bgc_fp32_vector2_copy(BGC_FP32_Vector2* const destination, const BGC_FP32_Vector2* const source);
|
|
extern inline void bgc_fp64_vector2_copy(BGC_FP64_Vector2* const destination, const BGC_FP64_Vector2* const source);
|
|
|
|
extern inline void bgc_fp32_vector2_swap(BGC_FP32_Vector2* const vector1, BGC_FP32_Vector2* const vector2);
|
|
extern inline void bgc_fp64_vector2_swap(BGC_FP64_Vector2* const vector1, BGC_FP64_Vector2* const vector2);
|
|
|
|
extern inline void bgc_fp32_vector2_convert_to_fp64(BGC_FP64_Vector2* const destination, const BGC_FP32_Vector2* const source);
|
|
extern inline void bgc_fp64_vector2_convert_to_fp32(BGC_FP32_Vector2* const destination, const BGC_FP64_Vector2* const source);
|
|
|
|
extern inline void bgc_fp32_vector2_add(BGC_FP32_Vector2* sum, const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2);
|
|
extern inline void bgc_fp64_vector2_add(BGC_FP64_Vector2* sum, const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2);
|
|
|
|
extern inline void bgc_fp32_vector2_add_scaled(BGC_FP32_Vector2* const sum, const BGC_FP32_Vector2* const basic_vector, const BGC_FP32_Vector2* const scalable_vector, const float scale);
|
|
extern inline void bgc_fp64_vector2_add_scaled(BGC_FP64_Vector2* const sum, const BGC_FP64_Vector2* const basic_vector, const BGC_FP64_Vector2* const scalable_vector, const double scale);
|
|
|
|
extern inline void bgc_fp32_vector2_subtract(BGC_FP32_Vector2* const difference, const BGC_FP32_Vector2* const minuend, const BGC_FP32_Vector2* const subtrahend);
|
|
extern inline void bgc_fp64_vector2_subtract(BGC_FP64_Vector2* const difference, const BGC_FP64_Vector2* const minuend, const BGC_FP64_Vector2* const subtrahend);
|
|
|
|
extern inline void bgc_fp32_vector2_subtract_scaled(BGC_FP32_Vector2* const difference, const BGC_FP32_Vector2* const basic_vector, const BGC_FP32_Vector2* const scalable_vector, const float scale);
|
|
extern inline void bgc_fp64_vector2_subtract_scaled(BGC_FP64_Vector2* const difference, const BGC_FP64_Vector2* const basic_vector, const BGC_FP64_Vector2* const scalable_vector, const double scale);
|
|
|
|
extern inline void bgc_fp32_vector2_multiply_by_real_number(BGC_FP32_Vector2* const product, const BGC_FP32_Vector2* const multiplicand, const float multiplier);
|
|
extern inline void bgc_fp64_vector2_multiply_by_real_number(BGC_FP64_Vector2* const product, const BGC_FP64_Vector2* const multiplicand, const double multiplier);
|
|
|
|
extern inline void bgc_fp32_vector2_multiply_by_matrix2x2(BGC_FP32_Vector2* const product, const BGC_FP32_Vector2* const vector, const BGC_FP32_Matrix2x2* const matrix);
|
|
extern inline void bgc_fp64_vector2_multiply_by_matrix2x2(BGC_FP64_Vector2* const product, const BGC_FP64_Vector2* const vector, const BGC_FP64_Matrix2x2* const matrix);
|
|
|
|
extern inline void bgc_fp32_vector2_multiply_by_matrix3x2(BGC_FP32_Vector3* const product, const BGC_FP32_Vector2* const vector, const BGC_FP32_Matrix3x2* const matrix);
|
|
extern inline void bgc_fp64_vector2_multiply_by_matrix3x2(BGC_FP64_Vector3* const product, const BGC_FP64_Vector2* const vector, const BGC_FP64_Matrix3x2* const matrix);
|
|
|
|
extern inline int bgc_fp32_vector2_divide_by_real_number(BGC_FP32_Vector2* const quotient, const BGC_FP32_Vector2* const dividend, const float divisor);
|
|
extern inline int bgc_fp64_vector2_divide_by_real_number(BGC_FP64_Vector2* const quotient, const BGC_FP64_Vector2* const dividend, const double divisor);
|
|
|
|
extern inline void bgc_fp32_vector2_get_mean2(BGC_FP32_Vector2* const mean, const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2);
|
|
extern inline void bgc_fp64_vector2_get_mean2(BGC_FP64_Vector2* const mean, const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2);
|
|
|
|
extern inline void bgc_fp32_vector2_get_mean3(BGC_FP32_Vector2* const mean, const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2, const BGC_FP32_Vector2* const vector3);
|
|
extern inline void bgc_fp64_vector2_get_mean3(BGC_FP64_Vector2* const mean, const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2, const BGC_FP64_Vector2* const vector3);
|
|
|
|
extern inline void bgc_fp32_vector2_interpolate(BGC_FP32_Vector2* const interpolation, const BGC_FP32_Vector2* const first, const BGC_FP32_Vector2* const second, const float phase);
|
|
extern inline void bgc_fp64_vector2_interpolate(BGC_FP64_Vector2* const interpolation, const BGC_FP64_Vector2* const first, const BGC_FP64_Vector2* const second, const double phase);
|
|
|
|
extern inline void bgc_fp32_vector2_revert(BGC_FP32_Vector2* const vector);
|
|
extern inline void bgc_fp64_vector2_revert(BGC_FP64_Vector2* const vector);
|
|
|
|
extern inline void bgc_fp32_vector2_get_reverse(BGC_FP32_Vector2* const reverse, const BGC_FP32_Vector2* const vector);
|
|
extern inline void bgc_fp64_vector2_get_reverse(BGC_FP64_Vector2* const reverse, const BGC_FP64_Vector2* const vector);
|
|
|
|
extern inline int bgc_fp32_vector2_normalize(BGC_FP32_Vector2* const vector);
|
|
extern inline int bgc_fp64_vector2_normalize(BGC_FP64_Vector2* const vector);
|
|
|
|
extern inline int bgc_fp32_vector2_get_normalized(BGC_FP32_Vector2* const normalized, const BGC_FP32_Vector2* const vector);
|
|
extern inline int bgc_fp64_vector2_get_normalized(BGC_FP64_Vector2* const normalized, const BGC_FP64_Vector2* const vector);
|
|
|
|
extern inline float bgc_fp32_vector2_get_dot_product(const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2);
|
|
extern inline double bgc_fp64_vector2_get_dot_product(const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2);
|
|
|
|
extern inline float bgc_fp32_vector2_get_cross_product(const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2);
|
|
extern inline double bgc_fp64_vector2_get_cross_product(const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2);
|
|
|
|
extern inline float bgc_fp32_vector2_get_square_distance(const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2);
|
|
extern inline double bgc_fp64_vector2_get_square_distance(const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2);
|
|
|
|
extern inline float bgc_fp32_vector2_get_distance(const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2);
|
|
extern inline double bgc_fp64_vector2_get_distance(const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2);
|
|
|
|
extern inline int bgc_fp32_vector2_are_close_enough(const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2, const float distance);
|
|
extern inline int bgc_fp64_vector2_are_close_enough(const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2, const double distance);
|
|
|
|
extern inline int bgc_fp32_vector2_are_close(const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2);
|
|
extern inline int bgc_fp64_vector2_are_close(const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2);
|
|
|
|
extern inline int bgc_fp32_vector2_are_parallel(const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2);
|
|
extern inline int bgc_fp64_vector2_are_parallel(const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2);
|
|
|
|
extern inline int bgc_fp32_vector2_are_orthogonal(const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2);
|
|
extern inline int bgc_fp64_vector2_are_orthogonal(const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2);
|
|
|
|
extern inline int bgc_fp32_vector2_get_attitude(const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2);
|
|
extern inline int bgc_fp64_vector2_get_attitude(const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2);
|
|
|
|
// =================== Angle ==================== //
|
|
|
|
float bgc_fp32_vector2_get_angle(const BGC_FP32_Vector2* const vector1, const BGC_FP32_Vector2* const vector2, const int angle_unit)
|
|
{
|
|
const float square_modulus1 = bgc_fp32_vector2_get_squared_length(vector1);
|
|
const float square_modulus2 = bgc_fp32_vector2_get_squared_length(vector2);
|
|
|
|
if (square_modulus1 <= BGC_FP32_SQUARE_EPSILON || square_modulus2 <= BGC_FP32_SQUARE_EPSILON || isnan(square_modulus1) || isnan(square_modulus2)) {
|
|
return 0.0f;
|
|
}
|
|
|
|
const float multiplier = sqrtf(1.0f / (square_modulus1 * square_modulus2));
|
|
|
|
const float x = bgc_fp32_vector2_get_dot_product(vector1, vector2);
|
|
|
|
const float y = fabsf(bgc_fp32_vector2_get_cross_product(vector1, vector2));
|
|
|
|
return bgc_fp32_radians_to_units(atan2f(y * multiplier, x * multiplier), angle_unit);
|
|
}
|
|
|
|
double bgc_fp64_vector2_get_angle(const BGC_FP64_Vector2* const vector1, const BGC_FP64_Vector2* const vector2, const int angle_unit)
|
|
{
|
|
const double square_modulus1 = bgc_fp64_vector2_get_squared_length(vector1);
|
|
const double square_modulus2 = bgc_fp64_vector2_get_squared_length(vector2);
|
|
|
|
if (square_modulus1 <= BGC_FP64_SQUARE_EPSILON || square_modulus2 <= BGC_FP64_SQUARE_EPSILON || isnan(square_modulus1) || isnan(square_modulus2)) {
|
|
return 0.0;
|
|
}
|
|
|
|
const double multiplier = sqrt(1.0 / (square_modulus1 * square_modulus2));
|
|
|
|
const double x = bgc_fp64_vector2_get_dot_product(vector1, vector2);
|
|
|
|
const double y = bgc_fp64_vector2_get_cross_product(vector1, vector2);
|
|
|
|
return bgc_fp64_radians_to_units(atan2(y * multiplier, x * multiplier), angle_unit);
|
|
}
|