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-01-27 19:34:57 +07:00
parent 101df9f089
commit e1dce83d63
7 changed files with 82 additions and 40 deletions
Download patch file Download diff file Expand all files Collapse all files

38
basic-geometry/position3.h
View file

@ -107,20 +107,38 @@ inline void bgc_position3_get_inverse_fp64(const BgcPosition3FP64 * position, Bg
// =================== Combine =================== //
inline void bgc_position3_combine_fp32(const BgcPosition3FP32 * parent, const BgcPosition3FP32 * child, BgcPosition3FP32 * combination)
inline void bgc_position3_combine_fp32(const BgcPosition3FP32 * first, const BgcPosition3FP32 * second, BgcPosition3FP32 * combination)
{
BgcVector3FP32 relative_shift;
bgc_versor_turn_vector_fp32(&parent->turn, &child->shift, &relative_shift);
bgc_versor_combine_fp32(&child->turn, &parent->turn, &combination->turn);
bgc_vector3_add_fp32(&parent->shift, &relative_shift, &combination->shift);
bgc_versor_turn_vector_fp32(&second->turn, &first->shift, &relative_shift);
bgc_versor_combine_fp32(&first->turn, &second->turn, &combination->turn);
bgc_vector3_add_fp32(&relative_shift, &second->shift, &combination->shift);
}
inline void bgc_position3_combine_fp64(const BgcPosition3FP64 * parent, const BgcPosition3FP64 * child, BgcPosition3FP64 * combination)
inline void bgc_position3_combine_fp64(const BgcPosition3FP64 * first, const BgcPosition3FP64 * second, BgcPosition3FP64 * combination)
{
BgcVector3FP64 relative_shift;
bgc_versor_turn_vector_fp64(&parent->turn, &child->shift, &relative_shift);
bgc_versor_combine_fp64(&child->turn, &parent->turn, &combination->turn);
bgc_vector3_add_fp64(&parent->shift, &relative_shift, &combination->shift);
bgc_versor_turn_vector_fp64(&second->turn, &first->shift, &relative_shift);
bgc_versor_combine_fp64(&first->turn, &second->turn, &combination->turn);
bgc_vector3_add_fp64(&relative_shift, &second->shift, &combination->shift);
}
// =================== Exclude =================== //
inline void bgc_position3_exclude_fp32(const BgcPosition3FP32 * base, const BgcPosition3FP32 * excludant, BgcPosition3FP32 * difference)
{
BgcVector3FP32 relative_shift;
bgc_vector3_subtract_fp32(&base->shift, &excludant->shift, &relative_shift);
bgc_versor_turn_vector_back_fp32(&excludant->turn, &relative_shift, &difference->shift);
bgc_versor_exclude_fp32(&base->turn, &excludant->turn, &difference->turn);
}
inline void bgc_position3_exclude_fp64(const BgcPosition3FP64 * base, const BgcPosition3FP64 * excludant, BgcPosition3FP64 * difference)
{
BgcVector3FP64 relative_shift;
bgc_vector3_subtract_fp64(&base->shift, &excludant->shift, &relative_shift);
bgc_versor_turn_vector_back_fp64(&excludant->turn, &relative_shift, &difference->shift);
bgc_versor_exclude_fp64(&base->turn, &excludant->turn, &difference->turn);
}
// ============= Get Outward Affine ============== //
@ -201,12 +219,12 @@ inline void bgc_position3_transform_vector_outwards_fp64(const BgcPosition3FP64
// ========== Transform Vector Inwards =========== //
inline void bgc_position3_transform_vector_inward_fp32(const BgcPosition3FP32 * position, const BgcVector3FP32 * outer_vector, BgcVector3FP32 * inner_vector)
inline void bgc_position3_transform_vector_inwards_fp32(const BgcPosition3FP32 * position, const BgcVector3FP32 * outer_vector, BgcVector3FP32 * inner_vector)
{
bgc_versor_turn_vector_back_fp32(&position->turn, outer_vector, inner_vector);
}
inline void bgc_position3_transform_vector_inward_fp64(const BgcPosition3FP64 * position, const BgcVector3FP64 * outer_vector, BgcVector3FP64 * inner_vector)
inline void bgc_position3_transform_vector_inwards_fp64(const BgcPosition3FP64 * position, const BgcVector3FP64 * outer_vector, BgcVector3FP64 * inner_vector)
{
bgc_versor_turn_vector_back_fp64(&position->turn, outer_vector, inner_vector);
}