Нормализация унитарных дуальных кватернионов
This commit is contained in:
parent
a5a59f72f5
commit
7591b20f41
6 changed files with 78 additions and 12 deletions
|
|
@ -31,7 +31,7 @@
|
|||
<ClInclude Include="matrix2x3.h" />
|
||||
<ClInclude Include="matrix3x2.h" />
|
||||
<ClInclude Include="matrix3x3.h" />
|
||||
<ClInclude Include="posture3.h" />
|
||||
<ClInclude Include="rigid-pose3.h" />
|
||||
<ClInclude Include="types.h" />
|
||||
<ClInclude Include="position2.h" />
|
||||
<ClInclude Include="position3.h" />
|
||||
|
|
@ -53,7 +53,7 @@
|
|||
<ClCompile Include="dual-vector3.c" />
|
||||
<ClCompile Include="position2.c" />
|
||||
<ClCompile Include="position3.c" />
|
||||
<ClCompile Include="posture3.c" />
|
||||
<ClCompile Include="rigid-pose3.c" />
|
||||
<ClCompile Include="turn2.c" />
|
||||
<ClCompile Include="turn3.c" />
|
||||
<ClCompile Include="utilities.c" />
|
||||
|
|
|
|||
|
|
@ -84,7 +84,7 @@
|
|||
<ClInclude Include="slerp3.h">
|
||||
<Filter>Файлы заголовков</Filter>
|
||||
</ClInclude>
|
||||
<ClInclude Include="posture3.h">
|
||||
<ClInclude Include="rigid-pose3.h">
|
||||
<Filter>Файлы заголовков</Filter>
|
||||
</ClInclude>
|
||||
</ItemGroup>
|
||||
|
|
@ -146,7 +146,7 @@
|
|||
<ClCompile Include="slerp3.c">
|
||||
<Filter>Исходные файлы</Filter>
|
||||
</ClCompile>
|
||||
<ClCompile Include="posture3.c">
|
||||
<ClCompile Include="rigid-pose3.c">
|
||||
<Filter>Исходные файлы</Filter>
|
||||
</ClCompile>
|
||||
</ItemGroup>
|
||||
|
|
|
|||
|
|
@ -410,8 +410,8 @@ inline void bgc_fp32_dual_quaternion_multiply_by_dual_quaternion(BGC_FP32_DualQu
|
|||
{
|
||||
BGC_FP32_Quaternion dual_part1, dual_part2;
|
||||
|
||||
bgc_fp32_quaternion_multiply_by_quaternion(&dual_part1, &left->real_part, &right->dual_part);
|
||||
bgc_fp32_quaternion_multiply_by_quaternion(&dual_part2, &left->dual_part, &right->real_part);
|
||||
_bgc_fp32_restrict_quaternion_multiply_by_quaternion(&dual_part1, &left->real_part, &right->dual_part);
|
||||
_bgc_fp32_restrict_quaternion_multiply_by_quaternion(&dual_part2, &left->dual_part, &right->real_part);
|
||||
|
||||
bgc_fp32_quaternion_multiply_by_quaternion(&product->real_part, &left->real_part, &right->real_part);
|
||||
bgc_fp32_quaternion_add(&product->dual_part, &dual_part1, &dual_part2);
|
||||
|
|
|
|||
|
|
@ -58,6 +58,12 @@ extern inline void bgc_fp64_quaternion_multiply_by_dual_quaternion(BGC_FP64_Dual
|
|||
extern inline void bgc_fp32_quaternion_multiply_by_conjugate(BGC_FP32_Quaternion* product, const BGC_FP32_Quaternion* left, const BGC_FP32_Quaternion* right);
|
||||
extern inline void bgc_fp64_quaternion_multiply_by_conjugate(BGC_FP64_Quaternion* product, const BGC_FP64_Quaternion* left, const BGC_FP64_Quaternion* right);
|
||||
|
||||
extern inline void _bgc_fp32_restrict_quaternion_multiply_by_quaternion(BGC_FP32_Quaternion* restrict product, const BGC_FP32_Quaternion* left, const BGC_FP32_Quaternion* right);
|
||||