1use crate::camera::camera::{Camera, CameraTarget};
4
5#[derive(Clone, Debug, Default)]
19pub struct CameraTrack {
20 keyframes: Vec<(f64, CameraTarget)>,
22}
23
24impl CameraTrack {
25 pub fn new() -> Self {
27 Self::default()
28 }
29
30 pub fn from_keyframes(mut keyframes: Vec<(f64, CameraTarget)>) -> Self {
35 keyframes.sort_by(|a, b| a.0.partial_cmp(&b.0).unwrap_or(std::cmp::Ordering::Equal));
36 Self { keyframes }
37 }
38
39 pub fn push(&mut self, time: f64, target: CameraTarget) {
41 let pos = self.keyframes.partition_point(|(t, _)| *t <= time);
42 self.keyframes.insert(pos, (time, target));
43 }
44
45 pub fn keyframes(&self) -> &[(f64, CameraTarget)] {
47 &self.keyframes
48 }
49
50 pub fn duration(&self) -> f64 {
52 match (self.keyframes.first(), self.keyframes.last()) {
53 (Some(first), Some(last)) => (last.0 - first.0).max(0.0),
54 _ => 0.0,
55 }
56 }
57
58 pub fn is_empty(&self) -> bool {
60 self.keyframes.is_empty()
61 }
62
63 pub fn len(&self) -> usize {
65 self.keyframes.len()
66 }
67}
68
69pub fn interpolate_camera(track: &CameraTrack, t: f64) -> CameraTarget {
83 let kfs = track.keyframes();
84
85 match kfs.len() {
86 0 => CameraTarget {
87 center: glam::Vec3::ZERO,
88 distance: 5.0,
89 orientation: glam::Quat::IDENTITY,
90 },
91 1 => kfs[0].1,
92 _ => {
93 if t <= kfs[0].0 {
95 return kfs[0].1;
96 }
97 if t >= kfs[kfs.len() - 1].0 {
98 return kfs[kfs.len() - 1].1;
99 }
100
101 let i = kfs.partition_point(|(kt, _)| *kt <= t).saturating_sub(1);
103 let i = i.min(kfs.len() - 2);
104
105 let t0 = kfs[i].0;
106 let t1 = kfs[i + 1].0;
107 let s = if (t1 - t0).abs() < 1e-12 {
108 0.0_f32
109 } else {
110 ((t - t0) / (t1 - t0)) as f32
111 };
112
113 let p1 = kfs[i].1;
115 let p2 = kfs[i + 1].1;
116 let p0 = if i > 0 {
117 kfs[i - 1].1
118 } else {
119 CameraTarget {
121 center: p1.center * 2.0 - p2.center,
122 distance: p1.distance * 2.0 - p2.distance,
123 orientation: p1.orientation, }
125 };
126 let p3 = if i + 2 < kfs.len() {
127 kfs[i + 2].1
128 } else {
129 CameraTarget {
131 center: p2.center * 2.0 - p1.center,
132 distance: p2.distance * 2.0 - p1.distance,
133 orientation: p2.orientation,
134 }
135 };
136
137 CameraTarget {
138 center: catmull_rom_vec3(p0.center, p1.center, p2.center, p3.center, s),
139 distance: catmull_rom_f32(p0.distance, p1.distance, p2.distance, p3.distance, s)
140 .max(Camera::MIN_DISTANCE),
141 orientation: p1.orientation.slerp(p2.orientation, s).normalize(),
142 }
143 }
144 }
145}
146
147fn catmull_rom_f32(p0: f32, p1: f32, p2: f32, p3: f32, s: f32) -> f32 {
152 let s2 = s * s;
153 let s3 = s2 * s;
154 0.5 * (2.0 * p1
155 + (-p0 + p2) * s
156 + (2.0 * p0 - 5.0 * p1 + 4.0 * p2 - p3) * s2
157 + (-p0 + 3.0 * p1 - 3.0 * p2 + p3) * s3)
158}
159
160fn catmull_rom_vec3(
161 p0: glam::Vec3,
162 p1: glam::Vec3,
163 p2: glam::Vec3,
164 p3: glam::Vec3,
165 s: f32,
166) -> glam::Vec3 {
167 glam::Vec3::new(
168 catmull_rom_f32(p0.x, p1.x, p2.x, p3.x, s),
169 catmull_rom_f32(p0.y, p1.y, p2.y, p3.y, s),
170 catmull_rom_f32(p0.z, p1.z, p2.z, p3.z, s),
171 )
172}
173
174#[cfg(test)]
179mod tests {
180 use super::*;
181
182 fn target(x: f32, d: f32) -> CameraTarget {
183 CameraTarget {
184 center: glam::Vec3::new(x, 0.0, 0.0),
185 distance: d,
186 orientation: glam::Quat::IDENTITY,
187 }
188 }
189
190 #[test]
191 fn test_empty_track_returns_default() {
192 let track = CameraTrack::new();
193 let t = interpolate_camera(&track, 0.0);
194 assert_eq!(t.distance, 5.0);
195 }
196
197 #[test]
198 fn test_single_keyframe() {
199 let mut track = CameraTrack::new();
200 track.push(0.0, target(3.0, 7.0));
201 let t = interpolate_camera(&track, 5.0);
202 assert!((t.center.x - 3.0).abs() < 1e-5);
203 assert!((t.distance - 7.0).abs() < 1e-5);
204 }
205
206 #[test]
207 fn test_clamp_before_start() {
208 let mut track = CameraTrack::new();
209 track.push(1.0, target(1.0, 1.0));
210 track.push(2.0, target(2.0, 2.0));
211 let t = interpolate_camera(&track, 0.0);
212 assert!((t.center.x - 1.0).abs() < 1e-5);
213 }
214
215 #[test]
216 fn test_clamp_after_end() {
217 let mut track = CameraTrack::new();
218 track.push(1.0, target(1.0, 1.0));
219 track.push(2.0, target(2.0, 2.0));
220 let t = interpolate_camera(&track, 5.0);
221 assert!((t.center.x - 2.0).abs() < 1e-5);
222 }
223
224 #[test]
225 fn test_midpoint_two_keyframes() {
226 let mut track = CameraTrack::new();
227 track.push(0.0, target(0.0, 4.0));
228 track.push(1.0, target(2.0, 8.0));
229 let t = interpolate_camera(&track, 0.5);
232 assert!((t.center.x - 1.0).abs() < 0.05, "center.x={}", t.center.x);
233 assert!((t.distance - 6.0).abs() < 0.1, "distance={}", t.distance);
234 }
235
236 #[test]
237 fn test_keyframe_hit_exact() {
238 let mut track = CameraTrack::new();
239 track.push(0.0, target(0.0, 1.0));
240 track.push(1.0, target(5.0, 3.0));
241 track.push(2.0, target(10.0, 5.0));
242 let t = interpolate_camera(&track, 1.0);
244 assert!((t.center.x - 5.0).abs() < 1e-4, "center.x={}", t.center.x);
245 assert!((t.distance - 3.0).abs() < 1e-4, "distance={}", t.distance);
246 }
247
248 #[test]
249 fn test_from_keyframes_sorts() {
250 let kfs = vec![
251 (2.0_f64, target(2.0, 2.0)),
252 (0.0_f64, target(0.0, 0.0)),
253 (1.0_f64, target(1.0, 1.0)),
254 ];
255 let track = CameraTrack::from_keyframes(kfs);
256 assert_eq!(track.keyframes()[0].0, 0.0);
257 assert_eq!(track.keyframes()[1].0, 1.0);
258 assert_eq!(track.keyframes()[2].0, 2.0);
259 }
260
261 #[test]
262 fn test_duration() {
263 let mut track = CameraTrack::new();
264 assert_eq!(track.duration(), 0.0);
265 track.push(1.0, target(0.0, 1.0));
266 track.push(4.0, target(1.0, 2.0));
267 assert!((track.duration() - 3.0).abs() < 1e-10);
268 }
269
270 #[test]
271 fn test_push_keeps_sorted() {
272 let mut track = CameraTrack::new();
273 track.push(3.0, target(3.0, 3.0));
274 track.push(1.0, target(1.0, 1.0));
275 track.push(2.0, target(2.0, 2.0));
276 assert_eq!(track.keyframes()[0].0, 1.0);
277 assert_eq!(track.keyframes()[1].0, 2.0);
278 assert_eq!(track.keyframes()[2].0, 3.0);
279 }
280}