Добавление restricted функций, нормализация дуальных кватернионов и позиции твёрдого тела (rigid pose3)

This commit is contained in:
Andrey Pokidov 2026-03-17 19:54:53 +07:00
parent 7591b20f41
commit 24d37be75d
7 changed files with 130 additions and 82 deletions

View file

@ -358,8 +358,8 @@ inline void bgc_fp32_dual_vector3_get_cross_product(BGC_FP32_DualVector3* produc
{
BGC_FP32_Vector3 part1, part2;
bgc_fp32_vector3_get_cross_product(&part1, &first->dual_part, &second->real_part);
bgc_fp32_vector3_get_cross_product(&part2, &first->real_part, &second->dual_part);
_bgc_fp32_restrict_vector3_get_cross_product(&part1, &first->dual_part, &second->real_part);
_bgc_fp32_restrict_vector3_get_cross_product(&part2, &first->real_part, &second->dual_part);
bgc_fp32_vector3_get_cross_product(&product->real_part, &first->real_part, &second->real_part);
bgc_fp32_vector3_add(&product->dual_part, &part1, &part2);
@ -369,8 +369,8 @@ inline void bgc_fp64_dual_vector3_get_cross_product(BGC_FP64_DualVector3* produc
{
BGC_FP64_Vector3 part1, part2;
bgc_fp64_vector3_get_cross_product(&part1, &first->dual_part, &second->real_part);
bgc_fp64_vector3_get_cross_product(&part2, &first->real_part, &second->dual_part);
_bgc_fp64_restrict_vector3_get_cross_product(&part1, &first->dual_part, &second->real_part);
_bgc_fp64_restrict_vector3_get_cross_product(&part2, &first->real_part, &second->dual_part);
bgc_fp64_vector3_get_cross_product(&product->real_part, &first->real_part, &second->real_part);
bgc_fp64_vector3_add(&product->dual_part, &part1, &part2);