]> git.tdb.fi Git - libs/gl.git/blob - source/animation.cpp
Add the specializations for non-square matrix uniforms
[libs/gl.git] / source / animation.cpp
1 #include <cmath>
2 #include <msp/core/maputils.h>
3 #include <msp/datafile/collection.h>
4 #include <msp/interpolate/bezierspline.h>
5 #include "animation.h"
6 #include "animationeventobserver.h"
7 #include "armature.h"
8 #include "error.h"
9 #include "pose.h"
10
11 using namespace std;
12
13 namespace Msp {
14 namespace GL {
15
16 Animation::Animation():
17         armature(0),
18         looping(false)
19 { }
20
21 Animation::~Animation()
22 {
23         for(vector<Curve *>::iterator i=curves.begin(); i!=curves.end(); ++i)
24                 delete *i;
25 }
26
27 void Animation::set_armature(const Armature &a)
28 {
29         if(!keyframes.empty() && &a!=armature)
30                 throw invalid_operation("Animation::set_armature");
31         armature = &a;
32 }
33
34 unsigned Animation::get_slot_for_uniform(const string &n) const
35 {
36         for(unsigned i=0; i<uniforms.size(); ++i)
37                 if(uniforms[i].name==n)
38                         return i;
39         throw key_error(n);
40 }
41
42 const string &Animation::get_uniform_name(unsigned i) const
43 {
44         if(i>=uniforms.size())
45                 throw out_of_range("Animation::get_uniform_name");
46         return uniforms[i].name;
47 }
48
49 void Animation::add_keyframe(const Time::TimeDelta &t, const KeyFrame &kf)
50 {
51         add_keyframe(t, &kf, false, false);
52         create_curves();
53 }
54
55 void Animation::add_keyframe_owned(const Time::TimeDelta &t, const KeyFrame *kf)
56 {
57         add_keyframe(t, kf, false, true);
58         create_curves();
59 }
60
61 void Animation::add_keyframe(const Time::TimeDelta &t, const KeyFrame &kf, float slope)
62 {
63         add_keyframe(t, &kf, slope, slope, false);
64         create_curves();
65 }
66
67 void Animation::add_keyframe(const Time::TimeDelta &t, const KeyFrame &kf, float ss, float es)
68 {
69         add_keyframe(t, &kf, ss, es, false);
70         create_curves();
71 }
72
73 void Animation::add_control_keyframe(const KeyFrame &kf)
74 {
75         if(keyframes.empty())
76                 throw invalid_operation("Animation::add_control_keyframe");
77
78         add_keyframe(keyframes.back().time, &kf, true, false);
79 }
80
81 void Animation::add_control_keyframe_owned(const KeyFrame *kf)
82 {
83         if(keyframes.empty())
84                 throw invalid_operation("Animation::add_control_keyframe_owned");
85
86         add_keyframe(keyframes.back().time, kf, true, true);
87 }
88
89 void Animation::add_keyframe(const Time::TimeDelta &t, const KeyFrame *kf, float ss, float es, bool owned)
90 {
91         if(keyframes.empty())
92                 return add_keyframe(t, kf, false, owned);
93
94         if(keyframes.back().control)
95                 throw invalid_operation("Animation::add_keyframe");
96
97         const KeyFrame &last = *keyframes.back().keyframe;
98         const Transform &trn = kf->get_transform();
99         const Transform &last_trn = last.get_transform();
100         const KeyFrame::UniformMap &kf_unis = kf->get_uniforms();
101         const KeyFrame::UniformMap &last_unis = last.get_uniforms();
102         for(unsigned i=1; i<=2; ++i)
103         {
104                 float x = (i==1 ? ss/3 : 1-es/3);
105                 KeyFrame *ckf = new KeyFrame;
106                 Transform ctrn;
107                 ctrn.set_position(last_trn.get_position()*(1-x)+trn.get_position()*x);
108                 const Transform::AngleVector3 &e1 = last_trn.get_euler();
109                 const Transform::AngleVector3 &e2 = trn.get_euler();
110                 ctrn.set_euler(Transform::AngleVector3(e1.x*(1-x)+e2.x*x, e1.y*(1-x)+e2.y*x, e1.z*(1-x)+e2.z*x));
111                 ctrn.set_scale(last_trn.get_scale()*(1-x)+trn.get_scale()*x);
112                 ckf->set_transform(ctrn);
113
114                 for(KeyFrame::UniformMap::const_iterator j=kf_unis.begin(); j!=kf_unis.end(); ++j)
115                 {
116                         KeyFrame::UniformMap::const_iterator k = last_unis.find(j->first);
117                         if(k==last_unis.end())
118                                 continue;
119
120                         KeyFrame::AnimatedUniform uni(j->second.size, 0.0f);
121                         for(unsigned c=0; c<uni.size; ++c)
122                                 uni.values[c] = k->second.values[c]*(1-x)+j->second.values[c]*x;
123
124                         ckf->set_uniform(j->first, uni);
125                 }
126
127                 add_keyframe(t, ckf, true, true);
128         }
129
130         add_keyframe(t, kf, false, owned);
131 }
132
133 void Animation::add_keyframe(const Time::TimeDelta &t, const KeyFrame *kf, bool c, bool owned)
134 {
135         if(c && keyframes.empty())
136                 throw invalid_argument("Animation::add_keyframe");
137         if(keyframes.empty() && t!=Time::zero)
138                 throw invalid_argument("Animation::add_keyframe");
139         if(!keyframes.empty() && t<keyframes.back().time)
140                 throw invalid_argument("Animation::add_keyframe");
141         if(kf->get_pose() && armature && kf->get_pose()->get_armature()!=armature)
142                 throw invalid_argument("Animation::add_keyframe");
143
144         const KeyFrame::UniformMap &kf_uniforms = kf->get_uniforms();
145         for(vector<UniformInfo>::const_iterator i=uniforms.begin(); i!=uniforms.end(); ++i)
146         {
147                 KeyFrame::UniformMap::const_iterator j = kf_uniforms.find(i->name);
148                 if(j!=kf_uniforms.end() && j->second.size!=i->size)
149                         throw invalid_argument("Animation::add_keyframe");
150         }
151
152         if(kf->get_pose() && !armature)
153                 armature = kf->get_pose()->get_armature();
154
155         TimedKeyFrame tkf;
156         tkf.time = t;
157         tkf.keyframe = kf;
158         if(!owned)
159                 tkf.keyframe.keep();
160         tkf.control = c;
161
162         keyframes.push_back(tkf);
163
164         for(KeyFrame::UniformMap::const_iterator i=kf_uniforms.begin(); i!=kf_uniforms.end(); ++i)
165         {
166                 bool found = false;
167                 for(vector<UniformInfo>::const_iterator j=uniforms.begin(); (!found && j!=uniforms.end()); ++j)
168                         found = (j->name==i->first);
169
170                 if(!found)
171                         uniforms.push_back(UniformInfo(i->first, i->second.size));
172         }
173 }
174
175 void Animation::create_curves()
176 {
177         for(vector<Curve *>::iterator i=curves.begin(); i!=curves.end(); ++i)
178                 delete *i;
179         curves.clear();
180
181         curves.reserve(6+uniforms.size());
182         create_curve(POSITION, Transform::POSITION, &extract_position);
183         create_curve(EULER, Transform::EULER, &extract_euler);
184         create_curve(SCALE, Transform::SCALE, &extract_scale);
185
186         uniform_curve_offset = curves.size();
187         for(vector<UniformInfo>::const_iterator i=uniforms.begin(); i!=uniforms.end(); ++i)
188         {
189                 if(i->size==1)
190                         create_curve<1>(UNIFORM, -1, ExtractUniform<1>(i->name));
191                 else if(i->size==2)
192                         create_curve<2>(UNIFORM, -1, ExtractUniform<2>(i->name));
193                 else if(i->size==3)
194                         create_curve<3>(UNIFORM, -1, ExtractUniform<3>(i->name));
195                 else if(i->size==4)
196                         create_curve<4>(UNIFORM, -1, ExtractUniform<4>(i->name));
197         }
198 }
199
200 void Animation::create_curve(CurveTarget target, Transform::ComponentMask mask, ExtractComponent::Extract extract)
201 {
202         Transform::ComponentMask all = mask;
203         Transform::ComponentMask any = Transform::NONE;
204         for(vector<TimedKeyFrame>::const_iterator i=keyframes.begin(); i!=keyframes.end(); ++i)
205         {
206                 all = all&i->keyframe->get_transform().get_mask();
207                 any = any|i->keyframe->get_transform().get_mask();
208         }
209
210         if(all==mask)
211                 create_curve<3>(target, -1, extract);
212         else if(any&mask)
213         {
214                 unsigned low_bit = mask&(mask>>2);
215                 for(unsigned i=3; i-->0; )
216                 {
217                         Transform::ComponentMask bit = static_cast<Transform::ComponentMask>(low_bit<<i);
218                         if(any&bit)
219                                 create_curve<1>(target, i, ExtractComponent(extract, i, bit));
220                 }
221         }
222 }
223
224 template<unsigned N, typename T>
225 void Animation::create_curve(CurveTarget target, int component, const T &extract)
226 {
227         typedef typename ValueCurve<N>::Knot Knot;
228
229         vector<Knot> knots;
230         unsigned n_control = 0;
231         for(vector<TimedKeyFrame>::const_iterator i=keyframes.begin(); i!=keyframes.end(); ++i)
232         {
233                 if(i->control && knots.empty())
234                         continue;
235
236                 typename Interpolate::SplineValue<float, N>::Type value;
237                 if(extract(*i->keyframe, value))
238                 {
239                         typename Knot::Value dvalue = value;
240                         float x = i->time/Time::sec;
241                         if(i->control)
242                         {
243                                 ++n_control;
244                                 if(n_control>2)
245                                         throw logic_error("too many control keyframes");
246                         }
247                         else
248                         {
249                                 if(n_control==1)
250                                 {
251                                         typename Knot::Value cv = knots.back().y;
252                                         knots.back().y = (knots[knots.size()-2].y+cv*2.0)/3.0;
253                                         knots.push_back(Knot(x, (dvalue+cv*2.0)/3.0));
254                                 }
255                                 else if(n_control==0 && !knots.empty())
256                                 {
257                                         typename Knot::Value prev = knots.back().y;
258                                         knots.push_back(Knot(knots.back().x, (prev*2.0+dvalue)/3.0));
259                                         knots.push_back(Knot(x, (prev+dvalue*2.0)/3.0));
260                                 }
261                                 n_control = 0;
262                         }
263                         knots.push_back(Knot(x, value));
264                 }
265         }
266         
267         while(n_control--)
268                 knots.pop_back();
269
270         if(knots.size()==1)
271         {
272                 knots.push_back(knots.back());
273                 knots.push_back(knots.back());
274                 knots.back().x += 1;
275                 knots.push_back(knots.back());
276         }
277
278         curves.push_back(new ValueCurve<N>(target, component, knots));
279 }
280
281 bool Animation::extract_position(const KeyFrame &kf, Vector3 &value)
282 {
283         value = kf.get_transform().get_position();
284         return true;
285 }
286
287 bool Animation::extract_euler(const KeyFrame &kf, Vector3 &value)
288 {
289         const Transform::AngleVector3 &euler = kf.get_transform().get_euler();
290         value = Vector3(euler.x.radians(), euler.y.radians(), euler.z.radians());
291         return true;
292 }
293
294 bool Animation::extract_scale(const KeyFrame &kf, Vector3 &value)
295 {
296         value = kf.get_transform().get_scale();
297         return true;
298 }
299
300 void Animation::add_event(const Time::TimeDelta &t, const string &n, const Variant &v)
301 {
302         Event event;
303         event.time = t;
304         event.name = n;
305         event.value = v;
306         events.push_back(event);
307 }
308
309 const Time::TimeDelta &Animation::get_duration() const
310 {
311         if(keyframes.empty())
312                 return Time::zero;
313
314         return keyframes.back().time;
315 }
316
317 void Animation::set_looping(bool l)
318 {
319         looping = l;
320 }
321
322
323 Animation::Curve::Curve(CurveTarget t, int c):
324         target(t),
325         component(c)
326 { }
327
328
329 template<unsigned N>
330 Animation::ValueCurve<N>::ValueCurve(CurveTarget t, int c, const vector<Knot> &k):
331         Curve(t, c),
332         spline(Interpolate::BezierSpline<double, 3, N>(k))
333 { }
334
335 template<unsigned N>
336 void Animation::ValueCurve<N>::apply(float, Matrix &) const
337 {
338         throw invalid_operation("ValueCurve::apply");
339 }
340
341 template<>
342 void Animation::ValueCurve<1>::apply(float x, Matrix &matrix) const
343 {
344         float value = spline(x);
345         if(target==POSITION || target==SCALE)
346         {
347                 Vector3 vec;
348                 vec[component] = value;
349                 if(target==POSITION)
350                         matrix.translate(vec);
351                 else
352                         matrix.scale(vec);
353         }
354         else if(target==EULER)
355         {
356                 Vector3 vec;
357                 vec[component] = 1.0f;
358                 matrix.rotate(Geometry::Angle<float>::from_radians(value), vec);
359         }
360         else
361                 throw invalid_operation("ValueCurve::apply");
362 }
363
364 template<>
365 void Animation::ValueCurve<3>::apply(float x, Matrix &matrix) const
366 {
367         Vector3 value = spline(x);
368         if(target==POSITION)
369                 matrix.translate(value);
370         else if(target==EULER)
371         {
372                 matrix.rotate(Geometry::Angle<float>::from_radians(value.z), Vector3(0, 0, 1));
373                 matrix.rotate(Geometry::Angle<float>::from_radians(value.y), Vector3(0, 1, 0));
374                 matrix.rotate(Geometry::Angle<float>::from_radians(value.x), Vector3(1, 0, 0));
375         }
376         else if(target==SCALE)
377                 matrix.scale(value);
378         else
379                 throw invalid_operation("ValueCurve::apply");
380 }
381
382 template<unsigned N>
383 void Animation::ValueCurve<N>::apply(float x, KeyFrame::AnimatedUniform &uni) const
384 {
385         uni.size = N;
386         typename Interpolate::Spline<double, 3, N>::Value value = spline(x);
387         for(unsigned i=0; i<N; ++i)
388                 uni.values[i] = Interpolate::SplineValue<float, N>::get(value, i);
389 }
390
391
392 bool Animation::ExtractComponent::operator()(const KeyFrame &kf, float &value) const
393 {
394         Vector3 vec;
395         if(!extract(kf, vec))
396                 return false;
397
398         value = vec[index];
399         return kf.get_transform().get_mask()&mask;
400 }
401
402
403 template<unsigned N>
404 bool Animation::ExtractUniform<N>::operator()(const KeyFrame &kf, typename Interpolate::SplineValue<float, N>::Type &value) const
405 {
406         const KeyFrame::UniformMap &kf_uniforms = kf.get_uniforms();
407         const KeyFrame::UniformMap::const_iterator i = kf_uniforms.find(name);
408         if(i==kf_uniforms.end())
409                 return false;
410
411         value = Interpolate::SplineValue<float, N>::make(i->second.values);
412         return true;
413 }
414
415
416 Animation::UniformInfo::UniformInfo(const string &n, unsigned s):
417         name(n),
418         size(s)
419 { }
420
421
422 Animation::Iterator::Iterator(const Animation &a):
423         animation(&a),
424         event_iter(animation->events.begin()),
425         end(false)
426 {
427 }
428
429 Animation::Iterator &Animation::Iterator::operator+=(const Time::TimeDelta &t)
430 {
431         const Time::TimeDelta &duration = animation->get_duration();
432         if(!duration)
433                 return *this;
434
435         elapsed += t;
436         if(animation->looping)
437         {
438                 while(elapsed>=duration)
439                         elapsed -= duration;
440         }
441         else if(elapsed>=duration)
442         {
443                 end = true;
444                 elapsed = duration;
445         }
446
447         return *this;
448 }
449
450 void Animation::Iterator::dispatch_events(AnimationEventObserver &observer)
451 {
452         for(; (event_iter!=animation->events.end() && event_iter->time<=elapsed); ++event_iter)
453                 observer.animation_event(0, event_iter->name, event_iter->value);
454 }
455
456 Matrix Animation::Iterator::get_matrix() const
457 {
458         Matrix matrix;
459         for(unsigned i=0; i<animation->uniform_curve_offset; ++i)
460                 animation->curves[i]->apply(elapsed/Time::sec, matrix);
461         return matrix;
462 }
463
464 KeyFrame::AnimatedUniform Animation::Iterator::get_uniform(unsigned i) const
465 {
466         if(i>=animation->uniforms.size())
467                 throw out_of_range("Animation::Iterator::get_uniform");
468
469         KeyFrame::AnimatedUniform uni(animation->uniforms[i].size, 0.0f);
470         animation->curves[animation->uniform_curve_offset+i]->apply(elapsed/Time::sec, uni);
471         return uni;
472 }
473
474 Matrix Animation::Iterator::get_pose_matrix(unsigned link) const
475 {
476         if(!animation->armature)
477                 throw invalid_operation("Animation::Iterator::get_pose_matrix");
478         if(link>animation->armature->get_max_link_index())
479                 throw out_of_range("Animation::Iterator::get_pose_matrix");
480
481         throw logic_error("pose animations are currently unimplemented");
482 }
483
484
485 Animation::Loader::Loader(Animation &a):
486         DataFile::CollectionObjectLoader<Animation>(a, 0)
487 {
488         init();
489 }
490
491 Animation::Loader::Loader(Animation &a, Collection &c):
492         DataFile::CollectionObjectLoader<Animation>(a, &c)
493 {
494         init();
495 }
496
497 void Animation::Loader::init()
498 {
499         start_slope = 1;
500         end_slope = 1;
501         slopes_set = 0;
502         add("armature", &Animation::armature);
503         add("control_keyframe", &Loader::control_keyframe);
504         add("control_keyframe", &Loader::control_keyframe_inline);
505         add("event", &Loader::event);
506         add("event", &Loader::event1i);
507         add("event", &Loader::event1f);
508         add("event", &Loader::event2f);
509         add("event", &Loader::event3f);
510         add("event", &Loader::event4f);
511         add("interval", &Loader::interval);
512         add("keyframe", &Loader::keyframe);
513         add("keyframe", &Loader::keyframe_inline);
514         add("looping", &Animation::looping);
515         add("slopes", &Loader::slopes);
516 }
517
518 void Animation::Loader::finish()
519 {
520         obj.create_curves();
521 }
522
523 void Animation::Loader::check_slopes_and_control(bool s, bool c)
524 {
525         if(s && c)
526                 throw logic_error("can't use both slopes and control keyframes in same segment");
527 }
528
529 void Animation::Loader::add_kf(const KeyFrame *kf, bool c, bool owned)
530 {
531         if(slopes_set && !c)
532                 obj.add_keyframe(current_time, kf, start_slope, end_slope, owned);
533         else
534                 obj.add_keyframe(current_time, kf, c, owned);
535
536         start_slope = end_slope;
537         end_slope = 1;
538         slopes_set = (slopes_set<<1)&3;
539 }
540
541 void Animation::Loader::load_kf(const string &n, bool c)
542 {
543         add_kf(&get_collection().get<KeyFrame>(n), c, false);
544 }
545
546 void Animation::Loader::load_kf_inline(bool c)
547 {
548         RefPtr<KeyFrame> kf = new KeyFrame;
549         if(coll)
550                 load_sub(*kf, get_collection());
551         else
552                 load_sub(*kf);
553
554         add_kf(kf.get(), c, true);
555         kf.release();
556 }
557
558 void Animation::Loader::control_keyframe(const string &n)
559 {
560         slopes_set &= 1;
561         check_slopes_and_control(slopes_set, true);
562         load_kf(n, true);
563 }
564
565 void Animation::Loader::control_keyframe_inline()
566 {
567         slopes_set &= 1;
568         check_slopes_and_control(slopes_set, true);
569         load_kf_inline(true);
570 }
571
572 void Animation::Loader::event(const string &n)
573 {
574         obj.add_event(current_time, n);
575 }
576
577 void Animation::Loader::event1i(const string &n, int v)
578 {
579         obj.add_event(current_time, n, v);
580 }
581
582 void Animation::Loader::event1f(const string &n, float v)
583 {
584         obj.add_event(current_time, n, v);
585 }
586
587 void Animation::Loader::event2f(const string &n, float v0, float v1)
588 {
589         obj.add_event(current_time, n, LinAl::Vector<float, 2>(v0, v1));
590 }
591
592 void Animation::Loader::event3f(const string &n, float v0, float v1, float v2)
593 {
594         obj.add_event(current_time, n, Vector3(v0, v1, v2));
595 }
596
597 void Animation::Loader::event4f(const string &n, float v0, float v1, float v2, float v3)
598 {
599         obj.add_event(current_time, n, Vector4(v0, v1, v2, v3));
600 }
601
602 void Animation::Loader::interval(float t)
603 {
604         current_time += t*Time::sec;
605 }
606
607 void Animation::Loader::keyframe(const string &n)
608 {
609         load_kf(n, false);
610 }
611
612 void Animation::Loader::keyframe_inline()
613 {
614         load_kf_inline(false);
615 }
616
617 void Animation::Loader::slopes(float s, float e)
618 {
619         check_slopes_and_control(true, (!obj.keyframes.empty() && obj.keyframes.back().control));
620
621         start_slope = s;
622         end_slope = e;
623         slopes_set = 1;
624 }
625
626 } // namespace GL
627 } // namespace Msp