102 Dalmatians: Puppies to the Rescue
Decompilation Source Reference | GitLab repository
Loading...
Searching...
No Matches
interpolation.c
Go to the documentation of this file.
1/* Recovered game implementation; original addresses identify provenance. */
8#include "pcdogs/math/types.h"
9#include "spline.h"
10
11static int32_t blend_vector_component(int32_t current, int32_t sample, int32_t weight)
12{
13 uint32_t delta = (uint32_t)sample - current;
14 int32_t step = (int32_t)(delta * weight) >> MATH_Q12_SHIFT;
15 return (int32_t)((uint32_t)current + step);
16}
17
18// Original pcdogs.exe: 0x40be40
19void Animation_InterpolateKeyframeVec3Blend(uint32_t frame_time, int32_t blend_weight_q12,
20 struct Animation_SplineChannelVec3 *track, struct Math_Vec3I32 *vector)
21{
22 struct Math_Vec3I32 sample;
23 Animation_InterpolateVec3(frame_time, track, &sample);
24 vector->x = blend_vector_component(vector->x, sample.x, blend_weight_q12);
25 vector->y = blend_vector_component(vector->y, sample.y, blend_weight_q12);
26 vector->z = blend_vector_component(vector->z, sample.z, blend_weight_q12);
27}
28
29static int32_t interpolate_vector_component(struct HermiteWeights w, uint16_t flags,
30 int32_t start, int32_t end, int32_t out_tangent, int32_t in_tangent)
31{
32 uint32_t tangents = (uint32_t)out_tangent * w.start_tangent + (uint32_t)in_tangent * w.end_tangent;
34 {
35 return (int32_t)((uint32_t)spline_mul_q12(start, w.start_value) +
36 (uint32_t)spline_mul_q12(end, w.end_value) + ((int32_t)tangents >> MATH_Q12_SHIFT));
37 }
39 return (int32_t)(tangents + (uint32_t)start * w.start_value + (uint32_t)end * w.end_value) >> MATH_Q12_SHIFT;
40 return (int32_t)((uint32_t)spline_mul_q12(start, w.start_value) + (uint32_t)spline_mul_q12(end, w.end_value) +
41 (uint32_t)spline_mul_q12(out_tangent, w.start_tangent) + (uint32_t)spline_mul_q12(in_tangent, w.end_tangent));
42}
43
44// Original pcdogs.exe: 0x40beb0
45void Animation_InterpolateVec3(uint32_t frame_time, struct Animation_SplineChannelVec3 *vec3_track,
46 struct Math_Vec3I32 *out_vec3)
47{
49 if ((uintptr_t)keys == UINT32_MAX)
50 {
51 const struct Animation_SplineChannelVec3ConstantView *constant =
52 (const struct Animation_SplineChannelVec3ConstantView *)vec3_track;
53 out_vec3->x = constant->value_q12.x;
54 out_vec3->y = constant->value_q12.y;
55 out_vec3->z = constant->value_q12.z;
56 return;
57 }
58
59 int last = vec3_track->keyframe_count - 1;
60 struct Animation_Vec3Keyframe *start = &keys[last];
61 struct Animation_Vec3Keyframe *end = keys;
62 uint32_t time = frame_time + ((uint32_t)(uint16_t)vec3_track->packed_time_bias_and_end_time << 6);
63 uint32_t end_time = spline_key_time(start->timing.packed);
64 if (time < end_time)
65 {
66 int next = 1;
67 if (last <= 3)
68 {
69 while (time >= spline_key_time(keys[next].timing.packed))
70 ++next;
71 }
72 else
73 {
74 int high = last;
75 while (next <= high)
76 {
77 int mid = (next + high) / 2;
78 if (time < spline_key_time(keys[mid].timing.packed))
79 high = mid - 1;
80 else
81 next = mid + 1;
82 }
83 }
84 start = &keys[next - 1];
85 end = &keys[next];
86 end_time = spline_key_time(end->timing.packed);
87 }
88 else
89 {
90 bool at_last_key = time == end_time;
91 end_time = spline_key_time(vec3_track->packed_time_bias_and_end_time);
92 if (at_last_key || time >= end_time)
93 {
95 if (!at_last_key && (vec3_track->channel_flags & wrap) == wrap)
96 start = end;
97 out_vec3->x = start->value.x;
98 out_vec3->y = start->value.y;
99 out_vec3->z = start->value.z;
100 return;
101 }
102 }
103
104 int32_t t = Animation_CalculateSplineParameter(time, end_time, start->timing.packed, (uint8_t)end->timing.packed,
105 (uint8_t *)keys);
106 struct HermiteWeights w = spline_weights(t);
107 uint16_t flags = vec3_track->channel_flags;
108 out_vec3->x = interpolate_vector_component(w, flags, start->value.x, end->value.x, start->tangent_out.x, end->tangent_in.x);
109 out_vec3->y = interpolate_vector_component(w, flags, start->value.y, end->value.y, start->tangent_out.y, end->tangent_in.y);
110 out_vec3->z = interpolate_vector_component(w, flags, start->value.z, end->value.z, start->tangent_out.z, end->tangent_in.z);
111}
112
113static int32_t quadratic_ease(int32_t elapsed, int32_t shape, int32_t coefficient, int32_t reciprocal)
114{
115 int32_t square = spline_mul_q12(elapsed, elapsed);
116 int32_t curve = spline_mul_q12(coefficient, spline_mul_q12(square, shape));
117 return spline_mul_q12(reciprocal, curve) >> 8;
118}
119
120// Original pcdogs.exe: 0x40c2c0
121int32_t Animation_CalculateSplineParameter(uint32_t sample_time, uint32_t next_key_time, uint32_t prev_key_packed,
122 uint8_t next_ease_index, uint8_t *keyframe_data)
123{
124 uint32_t start_time = spline_key_time(prev_key_packed);
125 uint32_t frames = (next_key_time - start_time) >> 6;
126 int32_t reciprocal = frames > 256 ? 0x100000u / frames : animationReciprocalQ20[frames];
127 int32_t elapsed = (int32_t)((sample_time - start_time) << 6);
128 uint8_t prev_ease_index = (uint8_t)prev_key_packed;
129 if (!prev_ease_index && !next_ease_index)
130 return spline_mul_q12(reciprocal, elapsed);
131
132 const struct Animation_EaseRecord *base = (const struct Animation_EaseRecord *)keyframe_data;
133 const struct Animation_EaseRecord *prev = base - prev_ease_index;
134 const struct Animation_EaseRecord *next = base - next_ease_index;
135 int32_t shape = ((prev_key_packed >> 8) & 0xfff) + 0x800;
136 int32_t duration = (int32_t)(frames << MATH_Q12_SHIFT);
137 int32_t start_end = prev_ease_index ? (int32_t)(frames * prev->start_curve_end_q12) : 0;
138 int32_t adjusted;
139 if (prev_ease_index && elapsed < start_end)
140 adjusted = quadratic_ease(elapsed, shape, prev->start_curve_coefficient_q12, reciprocal);
141 else if (next_ease_index && elapsed >= (int32_t)(frames * next->end_curve_start_q12))
142 {
143 int32_t remaining = (int32_t)((uint32_t)duration - elapsed);
144 adjusted = (int32_t)((uint32_t)duration - quadratic_ease(remaining, shape, next->end_curve_coefficient_q12, reciprocal));
145 }
146 else if (!next_ease_index && elapsed >= duration)
147 adjusted = duration;
148 else
149 {
150 int32_t doubled = (int32_t)(2u * elapsed);
151 adjusted = (int32_t)((uint32_t)spline_mul_q12(doubled, shape) - spline_mul_q12(start_end, shape));
152 }
153 return spline_mul_q12(reciprocal, adjusted);
154}
155
156// Original pcdogs.exe: 0x40d330
157// Samples a scalar channel using constant values, endpoints, or fixed-point Hermite interpolation. Q20 interpolation parameters produce Q12 basis values, and the final stored sample is shifted right by 12 before narrowing to int16.
158void Animation_InterpolateSpline(uint32_t sample_time, struct Animation_SplineChannelScalar *channel, int16_t *out_value)
159{
160 if ((uintptr_t)channel->keyframes_or_minus_one_sentinel == UINT32_MAX)
161 *out_value = (int16_t)(channel->packed_time_bias_and_end_time >> MATH_Q12_SHIFT);
162 else
163 *out_value = (int16_t)(sample_scalar_keys(sample_time, channel, false) >> MATH_Q12_SHIFT);
164}
#define ANIMATION_SPLINE_REPEAT_ENDPOINT
Definition constants.h:31
#define ANIMATION_SPLINE_VEC3_COMBINED_32BIT_PRODUCTS
Definition enums.h:61
#define ANIMATION_SPLINE_VEC3_WIDE_ENDPOINT_PRODUCTS
Definition enums.h:64
#define ANIMATION_SPLINE_WRAP_SAMPLE_TIME
Definition enums.h:55
#define animationReciprocalQ20
Definition globals.h:19
int32_t Animation_CalculateSplineParameter(uint32_t sample_time, uint32_t next_key_time, uint32_t prev_key_packed, uint8_t next_ease_index, uint8_t *keyframe_data)
static int32_t blend_vector_component(int32_t current, int32_t sample, int32_t weight)
void Animation_InterpolateVec3(uint32_t frame_time, struct Animation_SplineChannelVec3 *vec3_track, struct Math_Vec3I32 *out_vec3)
static int32_t interpolate_vector_component(struct HermiteWeights w, uint16_t flags, int32_t start, int32_t end, int32_t out_tangent, int32_t in_tangent)
void Animation_InterpolateSpline(uint32_t sample_time, struct Animation_SplineChannelScalar *channel, int16_t *out_value)
static int32_t quadratic_ease(int32_t elapsed, int32_t shape, int32_t coefficient, int32_t reciprocal)
void Animation_InterpolateKeyframeVec3Blend(uint32_t frame_time, int32_t blend_weight_q12, struct Animation_SplineChannelVec3 *track, struct Math_Vec3I32 *vector)
#define MATH_Q12_SHIFT
Definition constants.h:8
static int32_t sample_scalar_keys(uint32_t frame_time, struct Animation_SplineChannelScalar *channel, bool signed_time)
Definition spline.h:40
static uint32_t spline_key_time(uint32_t packed)
Definition spline.h:15
static struct HermiteWeights spline_weights(int32_t t)
Definition spline.h:25
static int32_t spline_mul_q12(int32_t a, int32_t b)
Definition spline.h:20
int32_t start_curve_coefficient_q12
Definition types.h:128
int32_t end_curve_coefficient_q12
Definition types.h:127
int16_t start_curve_end_q12
Definition types.h:126
int16_t end_curve_start_q12
Definition types.h:125
struct Animation_ScalarKeyframe * keyframes_or_minus_one_sentinel
Definition types.h:353
int32_t packed_time_bias_and_end_time
Definition types.h:354
int32_t packed_time_bias_and_end_time
Definition types.h:381
Animation_SplineChannelFlags channel_flags
Definition types.h:385
struct Animation_Vec3Keyframe * keyframes_or_minus_one_sentinel
Definition types.h:380
struct Math_Vec3I32 value
Definition types.h:1190
struct Math_Vec3I32 tangent_out
Definition types.h:1191
struct Math_Vec3I32 tangent_in
Definition types.h:1192
union Animation_KeyframeTiming timing
Definition types.h:1189
int32_t end_tangent
Definition spline.h:12
int32_t start_tangent
Definition spline.h:12
int32_t end_value
Definition spline.h:11
int32_t start_value
Definition spline.h:11
int16_t z
Definition types.h:460
int16_t x
Definition types.h:458
int16_t y
Definition types.h:459
int32_t y
Definition types.h:471
int32_t x
Definition types.h:470
int32_t z
Definition types.h:472