smoll fix

2023-11-27 10:52:47 +01:00
1 changed files with 1 additions and 1 deletions
--- a/src/fsfw/globalfunctions/math/QuaternionOperations.cpp
+++ b/src/fsfw/globalfunctions/math/QuaternionOperations.cpp
@@ -48,7 +48,7 @@ void QuaternionOperations::slerp(const double q1[4], const double q2[4], const d

  VectorOperations<double>::mulScalar(q1, std::sin((1 - weight) * angle) / std::sin(angle), left,
                                      4);
-  VectorOperations<double>::mulScalar(q1, std::sin(weight * angle) / std::sin(angle), right, 4);
+  VectorOperations<double>::mulScalar(q2, std::sin(weight * angle) / std::sin(angle), right, 4);
  VectorOperations<double>::add(left, right, q, 4);

  normalize(q);