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

Функции вычисления длины для дуальных векторов

Browse source
This commit is contained in:
Andrey Pokidov 2026-04-17 23:03:08 +07:00
parent cfb5fb7378
commit aae46c3fe5
2 changed files with 54 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

6
basic-geometry/dual-vector3.c
View file

@ -3,6 +3,12 @@
extern inline void bgc_fp32_dual_vector3_reset(BGC_FP32_DualVector3* const vector);
extern inline void bgc_fp64_dual_vector3_reset(BGC_FP64_DualVector3* const vector);
extern inline void bgc_fp32_dual_vector3_get_squared_length(BGC_FP32_DualNumber* const squared_length, const BGC_FP32_DualVector3* const vector);
extern inline void bgc_fp64_dual_vector3_get_squared_length(BGC_FP64_DualNumber* const squared_length, const BGC_FP64_DualVector3* const vector);
extern inline void bgc_fp32_dual_vector3_get_length(BGC_FP32_DualNumber* const length, const BGC_FP32_DualVector3* const vector);
extern inline void bgc_fp64_dual_vector3_get_length(BGC_FP64_DualNumber* const length, const BGC_FP64_DualVector3* const vector);
extern inline void bgc_fp32_dual_vector3_copy(BGC_FP32_DualVector3* const destination, const BGC_FP32_DualVector3* const source);
extern inline void bgc_fp64_dual_vector3_copy(BGC_FP64_DualVector3* const destination, const BGC_FP64_DualVector3* const source);

48
basic-geometry/dual-vector3.h
View file

@ -18,6 +18,54 @@ inline void bgc_fp64_dual_vector3_reset(BGC_FP64_DualVector3* const vector)
bgc_fp64_vector3_reset(&vector->dual_part);
}
// =============== Squared Length =============== //
inline void bgc_fp32_dual_vector3_get_squared_length(BGC_FP32_DualNumber* const squared_length, const BGC_FP32_DualVector3* const vector)
{
squared_length->real_part = bgc_fp32_vector3_get_squared_length(&vector->real_part);
squared_length->dual_part = 2.0f * bgc_fp32_vector3_get_dot_product(&vector->real_part, &vector->dual_part);
}
inline void bgc_fp64_dual_vector3_get_squared_length(BGC_FP64_DualNumber* const squared_length, const BGC_FP64_DualVector3* const vector)
{
squared_length->real_part = bgc_fp64_vector3_get_squared_length(&vector->real_part);
squared_length->dual_part = 2.0 * bgc_fp64_vector3_get_dot_product(&vector->real_part, &vector->dual_part);
}
// =================== Length =================== //
inline void bgc_fp32_dual_vector3_get_length(BGC_FP32_DualNumber* const length, const BGC_FP32_DualVector3* const vector)
{
const float square_real_part = bgc_fp32_vector3_get_squared_length(&vector->real_part);
if (square_real_part <= BGC_FP32_SQUARE_EPSILON) {
length->real_part = 0.0f;
length->dual_part = 0.0f;
return;
}
const float real_part = sqrtf(square_real_part);
length->real_part = real_part;
length->dual_part = bgc_fp32_vector3_get_dot_product(&vector->real_part, &vector->dual_part) / real_part;
}
inline void bgc_fp64_dual_vector3_get_length(BGC_FP64_DualNumber* const length, const BGC_FP64_DualVector3* const vector)
{
const double square_real_part = bgc_fp64_vector3_get_squared_length(&vector->real_part);
if (square_real_part <= BGC_FP64_SQUARE_EPSILON) {
length->real_part = 0.0;
length->dual_part = 0.0;
return;
}
const double real_part = sqrt(square_real_part);
length->real_part = real_part;
length->dual_part = bgc_fp64_vector3_get_dot_product(&vector->real_part, &vector->dual_part) / real_part;
}
// ==================== Copy ==================== //
inline void bgc_fp32_dual_vector3_copy(BGC_FP32_DualVector3* const destination, const BGC_FP32_DualVector3* const source)