Merge pull request #14 from omnisci3nce/realign

Realign

1 files changed, 38 insertions, 0 deletions

diff --git a/src/animation.c b/src/animation.c
new file mode 100644
index 0000000..7a79529
--- /dev/null
+++ b/src/animation.c
@@ -0,0 +1,38 @@
+#include "animation.h"
+#include "log.h"
+#include "maths.h"
+
+keyframe animation_sample(animation_sampler *sampler, f32 t) {
+  size_t previous_index = 0;
+  f32 previous_time = 0.0;
+  // look forwards
+  // DEBUG("%d\n", sampler->animation.values.kind);
+  TRACE("Total timestamps %d", sampler->animation.n_timestamps);
+  for (u32 i = 0; i < sampler->animation.n_timestamps; i++) {
+    f32 current_time = sampler->animation.timestamps[i];
+    if (current_time > t) {
+      break;
+    }
+    previous_time = sampler->animation.timestamps[i];
+    previous_index = i;
+  }
+
+  size_t next_index = (previous_index + 1) % sampler->animation.n_timestamps;
+  f32 next_time = sampler->animation.timestamps[next_index];
+  printf("%d %f %d %f\n", previous_index, previous_time, next_index, next_time);
+
+  keyframe prev_value = sampler->animation.values.values[previous_index];
+  keyframe next_value = sampler->animation.values.values[next_index];
+
+  printf("%d %d\n", previous_index, next_index);
+
+  f32 time_diff =
+      sampler->animation.timestamps[next_index] - sampler->animation.timestamps[previous_index];
+  f32 percent = (t - previous_time) / time_diff;
+
+  quat interpolated_rot =
+      quat_slerp(sampler->animation.values.values[previous_index].rotation,
+                 sampler->animation.values.values[next_index].rotation, percent);
+
+  return (keyframe){ .rotation = interpolated_rot };
+}
\ No newline at end of file