diff --git a/basic-geometry/quaternion.c b/basic-geometry/quaternion.c index 1a6d100..dd9fac2 100644 --- a/basic-geometry/quaternion.c +++ b/basic-geometry/quaternion.c @@ -76,6 +76,9 @@ extern inline void bgc_fp64_quaternion_get_mean3(BGC_FP64_Quaternion* mean, cons extern inline void bgc_fp32_quaternion_interpolate(BGC_FP32_Quaternion* interpolation, const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2, const float phase); extern inline void bgc_fp64_quaternion_interpolate(BGC_FP64_Quaternion* interpolation, const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2, const double phase); +extern inline float bgc_fp32_quaternion_get_dot_product(const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2); +extern inline double bgc_fp64_quaternion_get_dot_product(const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2); + extern inline void bgc_fp32_quaternion_conjugate(BGC_FP32_Quaternion* quaternion); extern inline void bgc_fp64_quaternion_conjugate(BGC_FP64_Quaternion* quaternion); diff --git a/basic-geometry/quaternion.h b/basic-geometry/quaternion.h index 3501483..4edc232 100644 --- a/basic-geometry/quaternion.h +++ b/basic-geometry/quaternion.h @@ -500,6 +500,18 @@ inline void bgc_fp64_quaternion_interpolate(BGC_FP64_Quaternion* interpolation, interpolation->x3 = quaternion1->x3 * counter_phase + quaternion2->x3 * phase; } +// ============== Get Dot Product =============== // + +inline float bgc_fp32_quaternion_get_dot_product(const BGC_FP32_Quaternion* quaternion1, const BGC_FP32_Quaternion* quaternion2) +{ + return (quaternion1->s0 * quaternion2->s0 + quaternion1->x1 * quaternion2->x1) + (quaternion1->x2 * quaternion2->x2 + quaternion1->x3 * quaternion2->x3) +} + +inline double bgc_fp64_quaternion_get_dot_product(const BGC_FP64_Quaternion* quaternion1, const BGC_FP64_Quaternion* quaternion2) +{ + return (quaternion1->s0 * quaternion2->s0 + quaternion1->x1 * quaternion2->x1) + (quaternion1->x2 * quaternion2->x2 + quaternion1->x3 * quaternion2->x3) +} + // ================= Conjugate ================== // inline void bgc_fp32_quaternion_conjugate(BGC_FP32_Quaternion* quaternion)