Base refactor 3/4
[blender.git] / source / blender / blenkernel / intern / anim.c
1 /*
2  * ***** BEGIN GPL LICENSE BLOCK *****
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU General Public License
6  * as published by the Free Software Foundation; either version 2
7  * of the License, or (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  * GNU General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License
15  * along with this program; if not, write to the Free Software Foundation,
16  * Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
17  *
18  * The Original Code is Copyright (C) 2001-2002 by NaN Holding BV.
19  * All rights reserved.
20  *
21  * The Original Code is: all of this file.
22  *
23  * Contributor(s): none yet.
24  *
25  * ***** END GPL LICENSE BLOCK *****
26  */
27
28 /** \file blender/blenkernel/intern/anim.c
29  *  \ingroup bke
30  */
31
32 #include "MEM_guardedalloc.h"
33
34 #include <stdlib.h>
35
36 #include "BLI_listbase.h"
37 #include "BLI_math.h"
38
39 #include "BLT_translation.h"
40
41 #include "DNA_anim_types.h"
42 #include "DNA_armature_types.h"
43 #include "DNA_key_types.h"
44 #include "DNA_scene_types.h"
45
46 #include "BKE_curve.h"
47 #include "BKE_depsgraph.h"
48 #include "BKE_global.h"
49 #include "BKE_key.h"
50 #include "BKE_main.h"
51 #include "BKE_object.h"
52 #include "BKE_particle.h"
53 #include "BKE_scene.h"
54 #include "BKE_anim.h"
55 #include "BKE_report.h"
56
57 // XXX bad level call...
58
59 /* --------------------- */
60 /* forward declarations */
61
62 /* ******************************************************************** */
63 /* Animation Visualization */
64
65 /* Initialize the default settings for animation visualization */
66 void animviz_settings_init(bAnimVizSettings *avs)
67 {
68         /* sanity check */
69         if (avs == NULL)
70                 return;
71
72         /* ghosting settings */
73         avs->ghost_bc = avs->ghost_ac = 10;
74
75         avs->ghost_sf = 1; /* xxx - take from scene instead? */
76         avs->ghost_ef = 250; /* xxx - take from scene instead? */
77
78         avs->ghost_step = 1;
79
80
81         /* path settings */
82         avs->path_bc = avs->path_ac = 10;
83
84         avs->path_sf = 1; /* xxx - take from scene instead? */
85         avs->path_ef = 250; /* xxx - take from scene instead? */
86
87         avs->path_viewflag = (MOTIONPATH_VIEW_KFRAS | MOTIONPATH_VIEW_KFNOS);
88
89         avs->path_step = 1;
90 }
91
92 /* ------------------- */
93
94 /* Free the given motion path's cache */
95 void animviz_free_motionpath_cache(bMotionPath *mpath) 
96 {
97         /* sanity check */
98         if (mpath == NULL) 
99                 return;
100                 
101         /* free the path if necessary */
102         if (mpath->points)
103                 MEM_freeN(mpath->points);
104         
105         /* reset the relevant parameters */
106         mpath->points = NULL;
107         mpath->length = 0;
108 }
109
110 /* Free the given motion path instance and its data 
111  * NOTE: this frees the motion path given!
112  */
113 void animviz_free_motionpath(bMotionPath *mpath)
114 {
115         /* sanity check */
116         if (mpath == NULL)
117                 return;
118         
119         /* free the cache first */
120         animviz_free_motionpath_cache(mpath);
121         
122         /* now the instance itself */
123         MEM_freeN(mpath);
124 }
125
126 /* ------------------- */
127
128 /**
129  * Setup motion paths for the given data.
130  * \note Only used when explicitly calculating paths on bones which may/may not be consider already
131  *
132  * \param scene Current scene (for frame ranges, etc.)
133  * \param ob Object to add paths for (must be provided)
134  * \param pchan Posechannel to add paths for (optional; if not provided, object-paths are assumed)
135  */
136 bMotionPath *animviz_verify_motionpaths(ReportList *reports, Scene *scene, Object *ob, bPoseChannel *pchan)
137 {
138         bAnimVizSettings *avs;
139         bMotionPath *mpath, **dst;
140         
141         /* sanity checks */
142         if (ELEM(NULL, scene, ob))
143                 return NULL;
144                 
145         /* get destination data */
146         if (pchan) {
147                 /* paths for posechannel - assume that posechannel belongs to the object */
148                 avs = &ob->pose->avs;
149                 dst = &pchan->mpath;
150         }
151         else {
152                 /* paths for object */
153                 avs = &ob->avs;
154                 dst = &ob->mpath;
155         }
156
157         /* avoid 0 size allocs */
158         if (avs->path_sf >= avs->path_ef) {
159                 BKE_reportf(reports, RPT_ERROR,
160                             "Motion path frame extents invalid for %s (%d to %d)%s",
161                             (pchan) ? pchan->name : ob->id.name,
162                             avs->path_sf, avs->path_ef,
163                             (avs->path_sf == avs->path_ef) ? TIP_(", cannot have single-frame paths") : "");
164                 return NULL;
165         }
166
167         /* if there is already a motionpath, just return that,
168          * provided it's settings are ok (saves extra free+alloc)
169          */
170         if (*dst != NULL) {
171                 int expected_length = avs->path_ef - avs->path_sf;
172                 
173                 mpath = *dst;
174                 
175                 /* path is "valid" if length is valid, but must also be of the same length as is being requested */
176                 if ((mpath->start_frame != mpath->end_frame) && (mpath->length > 0)) {
177                         /* outer check ensures that we have some curve data for this path */
178                         if (mpath->length == expected_length) {
179                                 /* return/use this as it is already valid length */
180                                 return mpath;
181                         }
182                         else {
183                                 /* clear the existing path (as the range has changed), and reallocate below */
184                                 animviz_free_motionpath_cache(mpath);
185                         }
186                 }
187         }
188         else {
189                 /* create a new motionpath, and assign it */
190                 mpath = MEM_callocN(sizeof(bMotionPath), "bMotionPath");
191                 *dst = mpath;
192         }
193         
194         /* set settings from the viz settings */
195         mpath->start_frame = avs->path_sf;
196         mpath->end_frame = avs->path_ef;
197         
198         mpath->length = mpath->end_frame - mpath->start_frame;
199         
200         if (avs->path_bakeflag & MOTIONPATH_BAKE_HEADS)
201                 mpath->flag |= MOTIONPATH_FLAG_BHEAD;
202         else
203                 mpath->flag &= ~MOTIONPATH_FLAG_BHEAD;
204
205         /* set default custom values */
206         mpath->color[0] = 1.0;    /* Red */
207         mpath->color[1] = 0.0;
208         mpath->color[2] = 0.0;
209
210         mpath->line_thickness = 1;
211         mpath->flag |= MOTIONPATH_FLAG_LINES;  /* draw lines by default */
212
213         /* allocate a cache */
214         mpath->points = MEM_callocN(sizeof(bMotionPathVert) * mpath->length, "bMotionPathVerts");
215         
216         /* tag viz settings as currently having some path(s) which use it */
217         avs->path_bakeflag |= MOTIONPATH_BAKE_HAS_PATHS;
218         
219         /* return it */
220         return mpath;
221 }
222
223 /* ------------------- */
224
225 /* Motion path needing to be baked (mpt) */
226 typedef struct MPathTarget {
227         struct MPathTarget *next, *prev;
228         
229         bMotionPath *mpath;         /* motion path in question */
230         
231         Object *ob;                 /* source object */
232         bPoseChannel *pchan;        /* source posechannel (if applicable) */
233 } MPathTarget;
234
235 /* ........ */
236
237 /* get list of motion paths to be baked for the given object
238  *  - assumes the given list is ready to be used
239  */
240 /* TODO: it would be nice in future to be able to update objects dependent on these bones too? */
241 void animviz_get_object_motionpaths(Object *ob, ListBase *targets)
242 {
243         MPathTarget *mpt;
244         
245         /* object itself first */
246         if ((ob->avs.recalc & ANIMVIZ_RECALC_PATHS) && (ob->mpath)) {
247                 /* new target for object */
248                 mpt = MEM_callocN(sizeof(MPathTarget), "MPathTarget Ob");
249                 BLI_addtail(targets, mpt);
250                 
251                 mpt->mpath = ob->mpath;
252                 mpt->ob = ob;
253         }
254         
255         /* bones */
256         if ((ob->pose) && (ob->pose->avs.recalc & ANIMVIZ_RECALC_PATHS)) {
257                 bArmature *arm = ob->data;
258                 bPoseChannel *pchan;
259                 
260                 for (pchan = ob->pose->chanbase.first; pchan; pchan = pchan->next) {
261                         if ((pchan->bone) && (arm->layer & pchan->bone->layer) && (pchan->mpath)) {
262                                 /* new target for bone */
263                                 mpt = MEM_callocN(sizeof(MPathTarget), "MPathTarget PoseBone");
264                                 BLI_addtail(targets, mpt);
265                                 
266                                 mpt->mpath = pchan->mpath;
267                                 mpt->ob = ob;
268                                 mpt->pchan = pchan;
269                         }
270                 }
271         }
272 }
273
274 /* ........ */
275
276 /* Note on evaluation optimizations:
277  * Optimization's currently used here play tricks with the depsgraph in order to try and
278  * evaluate as few objects as strictly necessary to get nicer performance under standard
279  * production conditions. For those people who really need the accurate version, 
280  * disable the ifdef (i.e. 1 -> 0) and comment out the call to motionpaths_calc_optimise_depsgraph()
281  */
282
283 /* tweak the object ordering to trick depsgraph into making MotionPath calculations run faster */
284 static void motionpaths_calc_optimise_depsgraph(Scene *scene, ListBase *targets)
285 {
286         BaseLegacy *base, *baseNext;
287         MPathTarget *mpt;
288         
289         /* make sure our temp-tag isn't already in use */
290         for (base = scene->base.first; base; base = base->next)
291                 base->object->flag &= ~BA_TEMP_TAG;
292         
293         /* for each target, dump its object to the start of the list if it wasn't moved already */
294         for (mpt = targets->first; mpt; mpt = mpt->next) {
295                 for (base = scene->base.first; base; base = baseNext) {
296                         baseNext = base->next;
297                         
298                         if ((base->object == mpt->ob) && !(mpt->ob->flag & BA_TEMP_TAG)) {
299                                 BLI_remlink(&scene->base, base);
300                                 BLI_addhead(&scene->base, base);
301                                 
302                                 mpt->ob->flag |= BA_TEMP_TAG;
303                                 
304                                 /* we really don't need to continue anymore once this happens, but this line might really 'break' */
305                                 break;
306                         }
307                 }
308         }
309         
310         /* "brew me a list that's sorted a bit faster now depsy" */
311         DAG_scene_relations_rebuild(G.main, scene);
312 }
313
314 /* update scene for current frame */
315 static void motionpaths_calc_update_scene(Scene *scene)
316 {
317 #if 1 // 'production' optimizations always on
318         /* rigid body simulation needs complete update to work correctly for now */
319         /* RB_TODO investigate if we could avoid updating everything */
320         if (BKE_scene_check_rigidbody_active(scene)) {
321                 BKE_scene_update_for_newframe(G.main->eval_ctx, G.main, scene, scene->lay);
322         }
323         else { /* otherwise we can optimize by restricting updates */
324                 BaseLegacy *base, *last = NULL;
325                 
326                 /* only stuff that moves or needs display still */
327                 DAG_scene_update_flags(G.main, scene, scene->lay, true, false);
328                 
329                 /* find the last object with the tag 
330                  * - all those afterwards are assumed to not be relevant for our calculations
331                  */
332                 /* optimize further by moving out... */
333                 for (base = scene->base.first; base; base = base->next) {
334                         if (base->object->flag & BA_TEMP_TAG)
335                                 last = base;
336                 }
337                 
338                 /* perform updates for tagged objects */
339                 /* XXX: this will break if rigs depend on scene or other data that
340                  * is animated but not attached to/updatable from objects */
341                 for (base = scene->base.first; base; base = base->next) {
342                         /* update this object */
343                         BKE_object_handle_update(G.main->eval_ctx, scene, base->object);
344                         
345                         /* if this is the last one we need to update, let's stop to save some time */
346                         if (base == last)
347                                 break;
348                 }
349         }
350 #else // original, 'always correct' version
351         /* do all updates
352          *  - if this is too slow, resort to using a more efficient way
353          *    that doesn't force complete update, but for now, this is the
354          *    most accurate way!
355          */
356         BKE_scene_update_for_newframe(G.main->eval_ctx, G.main, scene, scene->lay); /* XXX this is the best way we can get anything moving */
357 #endif
358 }
359
360 /* ........ */
361
362 /* perform baking for the targets on the current frame */
363 static void motionpaths_calc_bake_targets(Scene *scene, ListBase *targets)
364 {
365         MPathTarget *mpt;
366         
367         /* for each target, check if it can be baked on the current frame */
368         for (mpt = targets->first; mpt; mpt = mpt->next) {
369                 bMotionPath *mpath = mpt->mpath;
370                 bMotionPathVert *mpv;
371                 
372                 /* current frame must be within the range the cache works for 
373                  *      - is inclusive of the first frame, but not the last otherwise we get buffer overruns
374                  */
375                 if ((CFRA < mpath->start_frame) || (CFRA >= mpath->end_frame))
376                         continue;
377                 
378                 /* get the relevant cache vert to write to */
379                 mpv = mpath->points + (CFRA - mpath->start_frame);
380                 
381                 /* pose-channel or object path baking? */
382                 if (mpt->pchan) {
383                         /* heads or tails */
384                         if (mpath->flag & MOTIONPATH_FLAG_BHEAD) {
385                                 copy_v3_v3(mpv->co, mpt->pchan->pose_head);
386                         }
387                         else {
388                                 copy_v3_v3(mpv->co, mpt->pchan->pose_tail);
389                         }
390                         
391                         /* result must be in worldspace */
392                         mul_m4_v3(mpt->ob->obmat, mpv->co);
393                 }
394                 else {
395                         /* worldspace object location */
396                         copy_v3_v3(mpv->co, mpt->ob->obmat[3]);
397                 }
398         }
399 }
400
401 /* Perform baking of the given object's and/or its bones' transforms to motion paths 
402  *      - scene: current scene
403  *      - ob: object whose flagged motionpaths should get calculated
404  *      - recalc: whether we need to
405  */
406 /* TODO: include reports pointer? */
407 void animviz_calc_motionpaths(Scene *scene, ListBase *targets)
408 {
409         MPathTarget *mpt;
410         int sfra, efra;
411         int cfra;
412         
413         /* sanity check */
414         if (ELEM(NULL, targets, targets->first))
415                 return;
416         
417         /* set frame values */
418         cfra = CFRA;
419         sfra = efra = cfra;
420         
421         /* TODO: this method could be improved...
422          * 1) max range for standard baking
423          * 2) minimum range for recalc baking (i.e. between keyframes, but how?) */
424         for (mpt = targets->first; mpt; mpt = mpt->next) {
425                 /* try to increase area to do (only as much as needed) */
426                 sfra = MIN2(sfra, mpt->mpath->start_frame);
427                 efra = MAX2(efra, mpt->mpath->end_frame);
428         }
429         if (efra <= sfra) return;
430         
431         /* optimize the depsgraph for faster updates */
432         /* TODO: whether this is used should depend on some setting for the level of optimizations used */
433         motionpaths_calc_optimise_depsgraph(scene, targets);
434         
435         /* calculate path over requested range */
436         for (CFRA = sfra; CFRA <= efra; CFRA++) {
437                 /* update relevant data for new frame */
438                 motionpaths_calc_update_scene(scene);
439                 
440                 /* perform baking for targets */
441                 motionpaths_calc_bake_targets(scene, targets);
442         }
443         
444         /* reset original environment */
445         CFRA = cfra;
446         motionpaths_calc_update_scene(scene);
447         
448         /* clear recalc flags from targets */
449         for (mpt = targets->first; mpt; mpt = mpt->next) {
450                 bAnimVizSettings *avs;
451                 
452                 /* get pointer to animviz settings for each target */
453                 if (mpt->pchan)
454                         avs = &mpt->ob->pose->avs;
455                 else
456                         avs = &mpt->ob->avs;
457                 
458                 /* clear the flag requesting recalculation of targets */
459                 avs->recalc &= ~ANIMVIZ_RECALC_PATHS;
460         }
461 }
462
463 /* ******************************************************************** */
464 /* Curve Paths - for curve deforms and/or curve following */
465
466 /* free curve path data 
467  * NOTE: frees the path itself!
468  * NOTE: this is increasingly inaccurate with non-uniform BevPoint subdivisions [#24633]
469  */
470 void free_path(Path *path)
471 {
472         if (path->data) MEM_freeN(path->data);
473         MEM_freeN(path);
474 }
475
476 /* calculate a curve-deform path for a curve 
477  *  - only called from displist.c -> do_makeDispListCurveTypes
478  */
479 void calc_curvepath(Object *ob, ListBase *nurbs)
480 {
481         BevList *bl;
482         BevPoint *bevp, *bevpn, *bevpfirst, *bevplast;
483         PathPoint *pp;
484         Nurb *nu;
485         Path *path;
486         float *fp, *dist, *maxdist, xyz[3];
487         float fac, d = 0, fac1, fac2;
488         int a, tot, cycl = 0;
489         
490         /* in a path vertices are with equal differences: path->len = number of verts */
491         /* NOW WITH BEVELCURVE!!! */
492         
493         if (ob == NULL || ob->type != OB_CURVE) {
494                 return;
495         }
496
497         if (ob->curve_cache->path) free_path(ob->curve_cache->path);
498         ob->curve_cache->path = NULL;
499         
500         /* weak! can only use first curve */
501         bl = ob->curve_cache->bev.first;
502         if (bl == NULL || !bl->nr) {
503                 return;
504         }
505
506         nu = nurbs->first;
507
508         ob->curve_cache->path = path = MEM_callocN(sizeof(Path), "calc_curvepath");
509         
510         /* if POLY: last vertice != first vertice */
511         cycl = (bl->poly != -1);
512         
513         tot = cycl ? bl->nr : bl->nr - 1;
514         
515         path->len = tot + 1;
516         /* exception: vector handle paths and polygon paths should be subdivided at least a factor resolu */
517         if (path->len < nu->resolu * SEGMENTSU(nu)) {
518                 path->len = nu->resolu * SEGMENTSU(nu);
519         }
520         
521         dist = (float *)MEM_mallocN(sizeof(float) * (tot + 1), "calcpathdist");
522
523         /* all lengths in *dist */
524         bevp = bevpfirst = bl->bevpoints;
525         fp = dist;
526         *fp = 0.0f;
527         for (a = 0; a < tot; a++) {
528                 fp++;
529                 if (cycl && a == tot - 1)
530                         sub_v3_v3v3(xyz, bevpfirst->vec, bevp->vec);
531                 else
532                         sub_v3_v3v3(xyz, (bevp + 1)->vec, bevp->vec);
533                 
534                 *fp = *(fp - 1) + len_v3(xyz);
535                 bevp++;
536         }
537         
538         path->totdist = *fp;
539         
540         /* the path verts  in path->data */
541         /* now also with TILT value */
542         pp = path->data = (PathPoint *)MEM_callocN(sizeof(PathPoint) * path->len, "pathdata");
543
544         bevp = bevpfirst;
545         bevpn = bevp + 1;
546         bevplast = bevpfirst + (bl->nr - 1);
547         if (UNLIKELY(bevpn > bevplast)) {
548                 bevpn = cycl ? bevpfirst : bevplast;
549         }
550         fp = dist + 1;
551         maxdist = dist + tot;
552         fac = 1.0f / ((float)path->len - 1.0f);
553         fac = fac * path->totdist;
554         
555         for (a = 0; a < path->len; a++) {
556                 
557                 d = ((float)a) * fac;
558                 
559                 /* we're looking for location (distance) 'd' in the array */
560                 if (LIKELY(tot > 0)) {
561                         while ((fp < maxdist) && (d >= *fp)) {
562                                 fp++;
563                                 if (bevp < bevplast) bevp++;
564                                 bevpn = bevp + 1;
565                                 if (UNLIKELY(bevpn > bevplast)) {
566                                         bevpn = cycl ? bevpfirst : bevplast;
567                                 }
568                         }
569
570                         fac1 = (*(fp) - d) / (*(fp) - *(fp - 1));
571                         fac2 = 1.0f - fac1;
572                 }
573                 else {
574                         fac1 = 1.0f;
575                         fac2 = 0.0f;
576                 }
577
578                 interp_v3_v3v3(pp->vec, bevp->vec, bevpn->vec, fac2);
579                 pp->vec[3] = fac1 * bevp->alfa   + fac2 * bevpn->alfa;
580                 pp->radius = fac1 * bevp->radius + fac2 * bevpn->radius;
581                 pp->weight = fac1 * bevp->weight + fac2 * bevpn->weight;
582                 interp_qt_qtqt(pp->quat, bevp->quat, bevpn->quat, fac2);
583                 normalize_qt(pp->quat);
584                 
585                 pp++;
586         }
587         
588         MEM_freeN(dist);
589 }
590
591 static int interval_test(const int min, const int max, int p1, const int cycl)
592 {
593         if (cycl) {
594                 p1 = mod_i(p1 - min, (max - min + 1)) + min;
595         }
596         else {
597                 if      (p1 < min) p1 = min;
598                 else if (p1 > max) p1 = max;
599         }
600         return p1;
601 }
602
603
604 /* calculate the deformation implied by the curve path at a given parametric position,
605  * and returns whether this operation succeeded.
606  *
607  * note: ctime is normalized range <0-1>
608  *
609  * returns OK: 1/0
610  */
611 int where_on_path(Object *ob, float ctime, float vec[4], float dir[3], float quat[4], float *radius, float *weight)
612 {
613         Curve *cu;
614         Nurb *nu;
615         BevList *bl;
616         Path *path;
617         PathPoint *pp, *p0, *p1, *p2, *p3;
618         float fac;
619         float data[4];
620         int cycl = 0, s0, s1, s2, s3;
621         ListBase *nurbs;
622
623         if (ob == NULL || ob->type != OB_CURVE) return 0;
624         cu = ob->data;
625         if (ob->curve_cache == NULL || ob->curve_cache->path == NULL || ob->curve_cache->path->data == NULL) {
626                 printf("no path!\n");
627                 return 0;
628         }
629         path = ob->curve_cache->path;
630         pp = path->data;
631         
632         /* test for cyclic */
633         bl = ob->curve_cache->bev.first;
634         if (!bl) return 0;
635         if (!bl->nr) return 0;
636         if (bl->poly > -1) cycl = 1;
637
638         /* values below zero for non-cyclic curves give strange results */
639         BLI_assert(cycl || ctime >= 0.0f);
640
641         ctime *= (path->len - 1);
642         
643         s1 = (int)floor(ctime);
644         fac = (float)(s1 + 1) - ctime;
645
646         /* path->len is corected for cyclic */
647         s0 = interval_test(0, path->len - 1 - cycl, s1 - 1, cycl);
648         s1 = interval_test(0, path->len - 1 - cycl, s1, cycl);
649         s2 = interval_test(0, path->len - 1 - cycl, s1 + 1, cycl);
650         s3 = interval_test(0, path->len - 1 - cycl, s1 + 2, cycl);
651
652         p0 = pp + s0;
653         p1 = pp + s1;
654         p2 = pp + s2;
655         p3 = pp + s3;
656
657         /* NOTE: commented out for follow constraint
658          *
659          *       If it's ever be uncommented watch out for curve_deform_verts()
660          *       which used to temporary set CU_FOLLOW flag for the curve and no
661          *       longer does it (because of threading issues of such a thing.
662          */
663         //if (cu->flag & CU_FOLLOW) {
664
665         key_curve_tangent_weights(1.0f - fac, data, KEY_BSPLINE);
666
667         interp_v3_v3v3v3v3(dir, p0->vec, p1->vec, p2->vec, p3->vec, data);
668
669         /* make compatible with vectoquat */
670         negate_v3(dir);
671         //}
672
673         nurbs = BKE_curve_editNurbs_get(cu);
674         if (!nurbs)
675                 nurbs = &cu->nurb;
676         nu = nurbs->first;
677
678         /* make sure that first and last frame are included in the vectors here  */
679         if (nu->type == CU_POLY) key_curve_position_weights(1.0f - fac, data, KEY_LINEAR);
680         else if (nu->type == CU_BEZIER) key_curve_position_weights(1.0f - fac, data, KEY_LINEAR);
681         else if (s0 == s1 || p2 == p3) key_curve_position_weights(1.0f - fac, data, KEY_CARDINAL);
682         else key_curve_position_weights(1.0f - fac, data, KEY_BSPLINE);
683
684         vec[0] = data[0] * p0->vec[0] + data[1] * p1->vec[0] + data[2] * p2->vec[0] + data[3] * p3->vec[0]; /* X */
685         vec[1] = data[0] * p0->vec[1] + data[1] * p1->vec[1] + data[2] * p2->vec[1] + data[3] * p3->vec[1]; /* Y */
686         vec[2] = data[0] * p0->vec[2] + data[1] * p1->vec[2] + data[2] * p2->vec[2] + data[3] * p3->vec[2]; /* Z */
687         vec[3] = data[0] * p0->vec[3] + data[1] * p1->vec[3] + data[2] * p2->vec[3] + data[3] * p3->vec[3]; /* Tilt, should not be needed since we have quat still used */
688
689         if (quat) {
690                 float totfac, q1[4], q2[4];
691
692                 totfac = data[0] + data[3];
693                 if (totfac > FLT_EPSILON) interp_qt_qtqt(q1, p0->quat, p3->quat, data[3] / totfac);
694                 else copy_qt_qt(q1, p1->quat);
695
696                 totfac = data[1] + data[2];
697                 if (totfac > FLT_EPSILON) interp_qt_qtqt(q2, p1->quat, p2->quat, data[2] / totfac);
698                 else copy_qt_qt(q2, p3->quat);
699
700                 totfac = data[0] + data[1] + data[2] + data[3];
701                 if (totfac > FLT_EPSILON) interp_qt_qtqt(quat, q1, q2, (data[1] + data[2]) / totfac);
702                 else copy_qt_qt(quat, q2);
703         }
704
705         if (radius)
706                 *radius = data[0] * p0->radius + data[1] * p1->radius + data[2] * p2->radius + data[3] * p3->radius;
707
708         if (weight)
709                 *weight = data[0] * p0->weight + data[1] * p1->weight + data[2] * p2->weight + data[3] * p3->weight;
710
711         return 1;
712 }