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

Удаление combite3 функций, изменение названий параметров функицй combine и exclude

Browse source
This commit is contained in:
Andrey Pokidov 2026-04-03 15:10:57 +07:00
parent 54c762da14
commit 5425206401
10 changed files with 277 additions and 220 deletions
Download patch file Download diff file Expand all files Collapse all files

42
basic-geometry/turn3.h
View file

@ -52,6 +52,8 @@ inline void bgc_fp64_turn3_reset(BGC_FP64_Turn3* const turn)
// ============= Private: Normalize ============= //
extern int64_t turn3_normalize_counter;
inline void _bgc_fp32_turn3_normalize(BGC_FP32_Turn3* const turn)
{
const float square_magnitude = bgc_fp32_quaternion_get_square_magnitude(&turn->_versor);
@ -323,54 +325,30 @@ void bgc_fp64_turn3_get_power(BGC_FP64_Turn3* const power, const BGC_FP64_Turn3*
// ================ Combination ================= //
inline void bgc_fp32_turn3_combine(BGC_FP32_Turn3* const combination, const BGC_FP32_Turn3* const first, const BGC_FP32_Turn3* const second)
inline void bgc_fp32_turn3_combine(BGC_FP32_Turn3* const combination, const BGC_FP32_Turn3* const external_turn, const BGC_FP32_Turn3* const internal_turn)
{
bgc_fp32_quaternion_multiply_by_quaternion(&combination->_versor, &second->_versor, &first->_versor);
bgc_fp32_quaternion_multiply_by_quaternion(&combination->_versor, &external_turn->_versor, &internal_turn->_versor);
_bgc_fp32_turn3_normalize(combination);
}
inline void bgc_fp64_turn3_combine(BGC_FP64_Turn3* const combination, const BGC_FP64_Turn3* const first, const BGC_FP64_Turn3* const second)
inline void bgc_fp64_turn3_combine(BGC_FP64_Turn3* const combination, const BGC_FP64_Turn3* const external_turn, const BGC_FP64_Turn3* const internal_turn)
{
bgc_fp64_quaternion_multiply_by_quaternion(&combination->_versor, &second->_versor, &first->_versor);
_bgc_fp64_turn3_normalize(combination);
}
// ============ Combination of three ============ //
inline void bgc_fp32_turn3_combine3(BGC_FP32_Turn3* const combination, const BGC_FP32_Turn3* const first, const BGC_FP32_Turn3* const second, const BGC_FP32_Turn3* const third)
{
BGC_FP32_Quaternion product;
bgc_fp32_quaternion_multiply_by_quaternion(&product, &second->_versor, &first->_versor);
bgc_fp32_quaternion_multiply_by_quaternion(&combination->_versor, &third->_versor, &product);
_bgc_fp32_turn3_normalize(combination);
}
inline void bgc_fp64_turn3_combine3(BGC_FP64_Turn3* const combination, const BGC_FP64_Turn3* const first, const BGC_FP64_Turn3* const second, const BGC_FP64_Turn3* const third)
{
BGC_FP64_Quaternion product;
bgc_fp64_quaternion_multiply_by_quaternion(&product, &second->_versor, &first->_versor);
bgc_fp64_quaternion_multiply_by_quaternion(&combination->_versor, &third->_versor, &product);
bgc_fp64_quaternion_multiply_by_quaternion(&combination->_versor, &external_turn->_versor, &internal_turn->_versor);
_bgc_fp64_turn3_normalize(combination);
}
// ================= Exclusion ================== //
inline void bgc_fp32_turn3_exclude(BGC_FP32_Turn3* const difference, const BGC_FP32_Turn3* const base, const BGC_FP32_Turn3* const excludant)
inline void bgc_fp32_turn3_exclude(BGC_FP32_Turn3* const difference, const BGC_FP32_Turn3* const turn, const BGC_FP32_Turn3* const excludant)
{
bgc_fp32_quaternion_multiply_by_conjugate(&difference->_versor, &base->_versor, &excludant->_versor);
bgc_fp32_quaternion_multiply_by_conjugate(&difference->_versor, &turn->_versor, &excludant->_versor);
_bgc_fp32_turn3_normalize(difference);
}
inline void bgc_fp64_turn3_exclude(BGC_FP64_Turn3* const difference, const BGC_FP64_Turn3* const base, const BGC_FP64_Turn3* const excludant)
inline void bgc_fp64_turn3_exclude(BGC_FP64_Turn3* const difference, const BGC_FP64_Turn3* const turn, const BGC_FP64_Turn3* const excludant)
{
bgc_fp64_quaternion_multiply_by_conjugate(&difference->_versor, &base->_versor, &excludant->_versor);
bgc_fp64_quaternion_multiply_by_conjugate(&difference->_versor, &turn->_versor, &excludant->_versor);
_bgc_fp64_turn3_normalize(difference);
}