FilesExpand file tree

main

/

QuaternionSequence.cs

Copy path

Blame

More file actions

Blame

More file actions

Latest commit

 

History

History

History

62 lines (53 loc) · 1.68 KB

main

/

QuaternionSequence.cs

Copy path

Top

File metadata and controls

• Code
• Blame

62 lines (53 loc) · 1.68 KB

Raw

Copy raw file

Download raw file

Open symbols panel

Edit and raw actions

1

2

3

4

5

6

7

8

9

10

11

12

13

14

15

16

17

18

19

20

21

22

23

24

25

26

27

28

29

30

31

32

33

34

35

36

37

38

39

40

41

42

43

44

45

46

47

48

49

50

51

52

53

54

55

56

57

58

59

60

61

62

using OpenTK.Mathematics;

namespace Project3D

{

public class QuaternionSequence

{

private Keyframe<Quaternion>[] _keyframes;

private float lastTime;

private int lastIndex;

public QuaternionSequence(Keyframe<Quaternion>[] keyframes)

{

_keyframes = keyframes;

}

public Quaternion GetValue(float time)

{

if (_keyframes.Length == 1)

{

return _keyframes[0].Value;

}

if (time <= _keyframes[0].Time)

{

return _keyframes[0].Value;

}

if (time >= _keyframes[_keyframes.Length - 1].Time)

{

return _keyframes[_keyframes.Length - 1].Value;

}

FindClosestPair(time, out Keyframe<Quaternion> start, out Keyframe<Quaternion> end);

return Quaternion.Slerp(start.Value, end.Value, (time - start.Time) / (end.Time - start.Time));

}

private void FindClosestPair(float time, out Keyframe<Quaternion> start, out Keyframe<Quaternion> end)

{

if (time >= lastTime)

{

while (time >= _keyframes[lastIndex + 1].Time)

{

lastIndex++;

}

start = _keyframes[lastIndex];

end = _keyframes[lastIndex + 1];

}

else

{

while (time < _keyframes[lastIndex].Time)

{

lastIndex--;

}

start = _keyframes[lastIndex];

end = _keyframes[lastIndex + 1];

}

lastTime = time;

}

}

}