Добавление restricted функций, нормализация дуальных кватернионов и позиции твёрдого тела (rigid pose3)
This commit is contained in:
parent
7591b20f41
commit
24d37be75d
7 changed files with 130 additions and 82 deletions
|
|
@ -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);
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue