small merge needed for testing new animsys in 2.5 BGE, mixing own changes with merge...
[blender-staging.git] / source / blender / blenkernel / intern / action.c
1 /**
2  * $Id$
3  *
4  * ***** BEGIN GPL LICENSE BLOCK *****
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public License
8  * as published by the Free Software Foundation; either version 2
9  * of the License, or (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software Foundation,
18  * Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
19  *
20  * The Original Code is Copyright (C) 2001-2002 by NaN Holding BV.
21  * All rights reserved.
22  *
23  * Contributor(s): Full recode, Ton Roosendaal, Crete 2005
24  *
25  * ***** END GPL LICENSE BLOCK *****
26  */
27
28 #ifdef HAVE_CONFIG_H
29 #include <config.h>
30 #endif
31
32 #include <string.h>
33 #include <math.h>
34 #include <stdlib.h>     /* for NULL */
35
36 #include "MEM_guardedalloc.h"
37
38 #include "DNA_anim_types.h"
39 #include "DNA_action_types.h"
40 #include "DNA_armature_types.h"
41 #include "DNA_constraint_types.h"
42 #include "DNA_curve_types.h"
43 #include "DNA_key_types.h"
44 #include "DNA_nla_types.h"
45 #include "DNA_object_types.h"
46 #include "DNA_scene_types.h"
47
48 #include "BKE_animsys.h"
49 #include "BKE_action.h"
50 #include "BKE_anim.h"
51 #include "BKE_armature.h"
52 #include "BKE_blender.h"
53 #include "BKE_constraint.h"
54 #include "BKE_displist.h"
55 #include "BKE_global.h"
56 #include "BKE_fcurve.h"
57 #include "BKE_key.h"
58 #include "BKE_lattice.h"
59 #include "BKE_library.h"
60 #include "BKE_main.h"
61 #include "BKE_object.h"
62 #include "BKE_utildefines.h"
63
64 #include "BLI_arithb.h"
65 #include "BLI_blenlib.h"
66 #include "BLI_ghash.h"
67
68 #include "RNA_access.h"
69 #include "RNA_types.h"
70
71 //XXX #include "nla.h"
72
73 /* *********************** NOTE ON POSE AND ACTION **********************
74
75   - Pose is the local (object level) component of armature. The current
76     object pose is saved in files, and (will be) is presorted for dependency
77   - Actions have fewer (or other) channels, and write data to a Pose
78   - Currently ob->pose data is controlled in where_is_pose only. The (recalc)
79     event system takes care of calling that
80   - The NLA system (here too) uses Poses as interpolation format for Actions
81   - Therefore we assume poses to be static, and duplicates of poses have channels in
82     same order, for quick interpolation reasons
83
84   ****************************** (ton) ************************************ */
85
86 /* ***************** Library data level operations on action ************** */
87
88 bAction *add_empty_action(const char name[])
89 {
90         bAction *act;
91         
92         act= alloc_libblock(&G.main->action, ID_AC, name);
93         act->id.flag |= LIB_FAKEUSER; // XXX this is nasty for new users... maybe we don't want this anymore
94         act->id.us++;
95         
96         return act;
97 }       
98
99 // does copy_fcurve...
100 void make_local_action(bAction *act)
101 {
102         // Object *ob;
103         bAction *actn;
104         int local=0, lib=0;
105         
106         if (act->id.lib==0) return;
107         if (act->id.us==1) {
108                 act->id.lib= 0;
109                 act->id.flag= LIB_LOCAL;
110                 //make_local_action_channels(act);
111                 new_id(0, (ID *)act, 0);
112                 return;
113         }
114         
115 #if 0   // XXX old animation system
116         ob= G.main->object.first;
117         while(ob) {
118                 if(ob->action==act) {
119                         if(ob->id.lib) lib= 1;
120                         else local= 1;
121                 }
122                 ob= ob->id.next;
123         }
124 #endif
125         
126         if(local && lib==0) {
127                 act->id.lib= 0;
128                 act->id.flag= LIB_LOCAL;
129                 //make_local_action_channels(act);
130                 new_id(0, (ID *)act, 0);
131         }
132         else if(local && lib) {
133                 actn= copy_action(act);
134                 actn->id.us= 0;
135                 
136 #if 0   // XXX old animation system
137                 ob= G.main->object.first;
138                 while(ob) {
139                         if(ob->action==act) {
140                                 
141                                 if(ob->id.lib==0) {
142                                         ob->action = actn;
143                                         actn->id.us++;
144                                         act->id.us--;
145                                 }
146                         }
147                         ob= ob->id.next;
148                 }
149 #endif  // XXX old animation system
150         }
151 }
152
153
154 void free_action (bAction *act)
155 {
156         /* sanity check */
157         if (act == NULL)
158                 return;
159         
160         /* Free F-Curves */
161         free_fcurves(&act->curves);
162         
163         /* Free groups */
164         if (act->groups.first)
165                 BLI_freelistN(&act->groups);
166                 
167         /* Free pose-references (aka local markers) */
168         if (act->markers.first)
169                 BLI_freelistN(&act->markers);
170 }
171
172 bAction *copy_action (bAction *src)
173 {
174         bAction *dst = NULL;
175         bActionGroup *dgrp, *sgrp;
176         FCurve *dfcu, *sfcu;
177         
178         if (src == NULL) 
179                 return NULL;
180         dst= copy_libblock(src);
181         
182         /* duplicate the lists of groups and markers */
183         BLI_duplicatelist(&dst->groups, &src->groups);
184         BLI_duplicatelist(&dst->markers, &src->markers);
185         
186         /* copy F-Curves, fixing up the links as we go */
187         dst->curves.first= dst->curves.last= NULL;
188         
189         for (sfcu= src->curves.first; sfcu; sfcu= sfcu->next) {
190                 /* duplicate F-Curve */
191                 dfcu= copy_fcurve(sfcu);
192                 BLI_addtail(&dst->curves, dfcu);
193                 
194                 /* fix group links (kindof bad list-in-list search, but this is the most reliable way) */
195                 for (dgrp=dst->groups.first, sgrp=src->groups.first; dgrp && sgrp; dgrp=dgrp->next, sgrp=sgrp->next) {
196                         if (sfcu->grp == sgrp) {
197                                 dfcu->grp= dgrp;
198                                 
199                                 if (dgrp->channels.first == sfcu)
200                                         dgrp->channels.first= dfcu;
201                                 if (dgrp->channels.last == sfcu)
202                                         dgrp->channels.last= dfcu;
203                                         
204                                 break;
205                         }
206                 }
207         }
208         
209         dst->id.flag |= LIB_FAKEUSER; // XXX this is nasty for new users... maybe we don't want this anymore
210         dst->id.us++;
211         
212         return dst;
213 }
214
215
216 /* Get the active action-group for an Action */
217 bActionGroup *get_active_actiongroup (bAction *act)
218 {
219         bActionGroup *agrp= NULL;
220         
221         if (act && act->groups.first) { 
222                 for (agrp= act->groups.first; agrp; agrp= agrp->next) {
223                         if (agrp->flag & AGRP_ACTIVE)
224                                 break;
225                 }
226         }
227         
228         return agrp;
229 }
230
231 /* Make the given Action-Group the active one */
232 void set_active_action_group (bAction *act, bActionGroup *agrp, short select)
233 {
234         bActionGroup *grp;
235         
236         /* sanity checks */
237         if (act == NULL)
238                 return;
239         
240         /* Deactive all others */
241         for (grp= act->groups.first; grp; grp= grp->next) {
242                 if ((grp==agrp) && (select))
243                         grp->flag |= AGRP_ACTIVE;
244                 else    
245                         grp->flag &= ~AGRP_ACTIVE;
246         }
247 }
248
249 /* Add given channel into (active) group 
250  *      - assumes that channel is not linked to anything anymore
251  *      - always adds at the end of the group 
252  */
253 void action_groups_add_channel (bAction *act, bActionGroup *agrp, FCurve *fcurve)
254 {
255         FCurve *fcu;
256         short done=0;
257         
258         /* sanity checks */
259         if (ELEM3(NULL, act, agrp, fcurve))
260                 return;
261         
262         /* if no channels, just add to two lists at the same time */
263         if (act->curves.first == NULL) {
264                 fcurve->next = fcurve->prev = NULL;
265                 
266                 agrp->channels.first = agrp->channels.last = fcurve;
267                 act->curves.first = act->curves.last = fcurve;
268                 
269                 fcurve->grp= agrp;
270                 return;
271         }
272         
273         /* try to find a channel to slot this in before/after */
274         for (fcu= act->curves.first; fcu; fcu= fcu->next) {
275                 /* if channel has no group, then we have ungrouped channels, which should always occur after groups */
276                 if (fcu->grp == NULL) {
277                         BLI_insertlinkbefore(&act->curves, fcu, fcurve);
278                         
279                         if (agrp->channels.first == NULL)
280                                 agrp->channels.first= fcurve;
281                         agrp->channels.last= fcurve;
282                         
283                         done= 1;
284                         break;
285                 }
286                 
287                 /* if channel has group after current, we can now insert (otherwise we have gone too far) */
288                 else if (fcu->grp == agrp->next) {
289                         BLI_insertlinkbefore(&act->curves, fcu, fcurve);
290                         
291                         if (agrp->channels.first == NULL)
292                                 agrp->channels.first= fcurve;
293                         agrp->channels.last= fcurve;
294                         
295                         done= 1;
296                         break;
297                 }
298                 
299                 /* if channel has group we're targeting, check whether it is the last one of these */
300                 else if (fcu->grp == agrp) {
301                         if ((fcu->next) && (fcu->next->grp != agrp)) {
302                                 BLI_insertlinkafter(&act->curves, fcu, fcurve);
303                                 agrp->channels.last= fcurve;
304                                 done= 1;
305                                 break;
306                         }
307                         else if (fcu->next == NULL) {
308                                 BLI_addtail(&act->curves, fcurve);
309                                 agrp->channels.last= fcurve;
310                                 done= 1;
311                                 break;
312                         }
313                 }
314                 
315                 /* if channel has group before target, check whether the next one is something after target */
316                 else if (fcu->grp == agrp->prev) {
317                         if (fcu->next) {
318                                 if ((fcu->next->grp != fcu->grp) && (fcu->next->grp != agrp)) {
319                                         BLI_insertlinkafter(&act->curves, fcu, fcurve);
320                                         
321                                         agrp->channels.first= fcurve;
322                                         agrp->channels.last= fcurve;
323                                         
324                                         done= 1;
325                                         break;
326                                 }
327                         }
328                         else {
329                                 BLI_insertlinkafter(&act->curves, fcu, fcurve);
330                                 
331                                 agrp->channels.first= fcurve;
332                                 agrp->channels.last= fcurve;
333                                 
334                                 done= 1;
335                                 break;
336                         }
337                 }
338         }
339         
340         /* only if added, set channel as belonging to this group */
341         if (done) {
342                 //printf("FCurve added to group \n");
343                 fcurve->grp= agrp;
344         }
345         else {
346                 printf("Error: FCurve '%s' couldn't be added to Group '%s' \n", fcurve->rna_path, agrp->name);
347                 BLI_addtail(&act->curves, fcurve);
348         }
349 }       
350
351 /* Remove the given channel from all groups */
352 void action_groups_remove_channel (bAction *act, FCurve *fcu)
353 {
354         /* sanity checks */
355         if (ELEM(NULL, act, fcu))       
356                 return;
357         
358         /* check if any group used this directly */
359         if (fcu->grp) {
360                 bActionGroup *agrp= fcu->grp;
361                 
362                 if (agrp->channels.first == agrp->channels.last) {
363                         if (agrp->channels.first == fcu) {
364                                 agrp->channels.first= NULL;
365                                 agrp->channels.last= NULL;
366                         }
367                 }
368                 else if (agrp->channels.first == fcu) {
369                         if ((fcu->next) && (fcu->next->grp==agrp))
370                                 agrp->channels.first= fcu->next;
371                         else
372                                 agrp->channels.first= NULL;
373                 }
374                 else if (agrp->channels.last == fcu) {
375                         if ((fcu->prev) && (fcu->prev->grp==agrp))
376                                 agrp->channels.last= fcu->prev;
377                         else
378                                 agrp->channels.last= NULL;
379                 }
380                 
381                 fcu->grp= NULL;
382         }
383         
384         /* now just remove from list */
385         BLI_remlink(&act->curves, fcu);
386 }
387
388 /* Find a group with the given name */
389 bActionGroup *action_groups_find_named (bAction *act, const char name[])
390 {
391         bActionGroup *grp;
392         
393         /* sanity checks */
394         if (ELEM3(NULL, act, act->groups.first, name) || (name[0] == 0))
395                 return NULL;
396                 
397         /* do string comparisons */
398         for (grp= act->groups.first; grp; grp= grp->next) {
399                 if (strcmp(grp->name, name) == 0)
400                         return grp;
401         }
402         
403         /* not found */
404         return NULL;
405 }
406
407 /* ************************ Pose channels *************** */
408
409 /* usually used within a loop, so we got a N^2 slowdown */
410 bPoseChannel *get_pose_channel(const bPose *pose, const char *name)
411 {
412         bPoseChannel *chan;
413
414         if (pose==NULL) return NULL;
415         
416         for (chan=pose->chanbase.first; chan; chan=chan->next) {
417                 if (chan->name[0] == name[0]) {
418                         if (!strcmp (chan->name, name))
419                                 return chan;
420                 }
421         }
422
423         return NULL;
424 }
425
426 /* Use with care, not on Armature poses but for temporal ones */
427 /* (currently used for action constraints and in rebuild_pose) */
428 bPoseChannel *verify_pose_channel(bPose* pose, const char* name)
429 {
430         bPoseChannel *chan;
431         
432         if (pose == NULL)
433                 return NULL;
434         
435         /* See if this channel exists */
436         for (chan=pose->chanbase.first; chan; chan=chan->next) {
437                 if (!strcmp (name, chan->name))
438                         return chan;
439         }
440         
441         /* If not, create it and add it */
442         chan = MEM_callocN(sizeof(bPoseChannel), "verifyPoseChannel");
443         
444         strncpy(chan->name, name, 31);
445         /* init vars to prevent math errors */
446         chan->quat[0] = 1.0f;
447         chan->size[0] = chan->size[1] = chan->size[2] = 1.0f;
448         
449         chan->limitmin[0]= chan->limitmin[1]= chan->limitmin[2]= -180.0f;
450         chan->limitmax[0]= chan->limitmax[1]= chan->limitmax[2]= 180.0f;
451         chan->stiffness[0]= chan->stiffness[1]= chan->stiffness[2]= 0.0f;
452         
453         Mat4One(chan->constinv);
454         
455         BLI_addtail(&pose->chanbase, chan);
456         
457         return chan;
458 }
459
460 /* Find the active posechannel for an object (we can't just use pose, as layer info is in armature) */
461 bPoseChannel *get_active_posechannel (Object *ob)
462 {
463         bArmature *arm= (ob) ? ob->data : NULL;
464         bPoseChannel *pchan;
465         
466         if ELEM3(NULL, ob, ob->pose, arm)
467                 return NULL;
468         
469         /* find active */
470         for (pchan= ob->pose->chanbase.first; pchan; pchan= pchan->next) {
471                 if ((pchan->bone) && (pchan->bone->flag & BONE_ACTIVE) && (pchan->bone->layer & arm->layer))
472                         return pchan;
473         }
474         
475         return NULL;
476 }
477
478
479 /* dst should be freed already, makes entire duplicate */
480 void copy_pose (bPose **dst, bPose *src, int copycon)
481 {
482         bPose *outPose;
483         bPoseChannel    *pchan;
484         ListBase listb;
485         
486         if (!src){
487                 *dst=NULL;
488                 return;
489         }
490         
491         if (*dst==src) {
492                 printf("copy_pose source and target are the same\n");
493                 *dst=NULL;
494                 return;
495         }
496         
497         outPose= MEM_callocN(sizeof(bPose), "pose");
498         
499         BLI_duplicatelist(&outPose->chanbase, &src->chanbase);
500         
501         if (copycon) {
502                 for (pchan=outPose->chanbase.first; pchan; pchan=pchan->next) {
503                         copy_constraints(&listb, &pchan->constraints);  // copy_constraints NULLs listb
504                         pchan->constraints= listb;
505                         pchan->path= NULL;
506                 }
507         }
508         
509         *dst=outPose;
510 }
511
512 void free_pose_channels(bPose *pose) 
513 {
514         bPoseChannel *pchan;
515         
516         if (pose->chanbase.first) {
517                 for (pchan = pose->chanbase.first; pchan; pchan=pchan->next){
518                         if (pchan->path)
519                                 MEM_freeN(pchan->path);
520                         free_constraints(&pchan->constraints);
521                 }
522                 BLI_freelistN(&pose->chanbase);
523         }
524 }
525
526 void free_pose(bPose *pose)
527 {
528         if (pose) {
529                 /* free pose-channels */
530                 free_pose_channels(pose);
531                 
532                 /* free pose-groups */
533                 if (pose->agroups.first)
534                         BLI_freelistN(&pose->agroups);
535                 
536                 /* free pose */
537                 MEM_freeN(pose);
538         }
539 }
540
541 void game_copy_pose(bPose **dst, bPose *src)
542 {
543         bPose *out;
544         bPoseChannel *pchan, *outpchan;
545         GHash *ghash;
546         
547         /* the game engine copies the current armature pose and then swaps
548          * the object pose pointer. this makes it possible to change poses
549          * without affecting the original blender data. */
550
551         if (!src) {
552                 *dst=NULL;
553                 return;
554         }
555         else if (*dst==src) {
556                 printf("copy_pose source and target are the same\n");
557                 *dst=NULL;
558                 return;
559         }
560         
561         out= MEM_dupallocN(src);
562         out->agroups.first= out->agroups.last= NULL;
563         BLI_duplicatelist(&out->chanbase, &src->chanbase);
564
565         /* remap pointers */
566         ghash= BLI_ghash_new(BLI_ghashutil_ptrhash, BLI_ghashutil_ptrcmp);
567
568         pchan= src->chanbase.first;
569         outpchan= out->chanbase.first;
570         for (; pchan; pchan=pchan->next, outpchan=outpchan->next)
571                 BLI_ghash_insert(ghash, pchan, outpchan);
572
573         for (pchan=out->chanbase.first; pchan; pchan=pchan->next) {
574                 pchan->parent= BLI_ghash_lookup(ghash, pchan->parent);
575                 pchan->child= BLI_ghash_lookup(ghash, pchan->child);
576                 pchan->path= NULL;
577         }
578
579         BLI_ghash_free(ghash, NULL, NULL);
580         
581         *dst=out;
582 }
583
584 void game_free_pose(bPose *pose)
585 {
586         if (pose) {
587                 /* we don't free constraints, those are owned by the original pose */
588                 if(pose->chanbase.first)
589                         BLI_freelistN(&pose->chanbase);
590                 
591                 MEM_freeN(pose);
592         }
593 }
594
595 static void copy_pose_channel_data(bPoseChannel *pchan, const bPoseChannel *chan)
596 {
597         bConstraint *pcon, *con;
598         
599         VECCOPY(pchan->loc, chan->loc);
600         VECCOPY(pchan->size, chan->size);
601         VECCOPY(pchan->eul, chan->eul);
602         QUATCOPY(pchan->quat, chan->quat);
603         pchan->rotmode= chan->rotmode;
604         Mat4CpyMat4(pchan->chan_mat, (float(*)[4])chan->chan_mat);
605         Mat4CpyMat4(pchan->pose_mat, (float(*)[4])chan->pose_mat);
606         pchan->flag= chan->flag;
607         
608         con= chan->constraints.first;
609         for(pcon= pchan->constraints.first; pcon; pcon= pcon->next, con= con->next) {
610                 pcon->enforce= con->enforce;
611                 pcon->headtail= con->headtail;
612         }
613 }
614
615 /* checks for IK constraint, and also for Follow-Path constraint.
616  * can do more constraints flags later 
617  */
618 /* pose should be entirely OK */
619 void update_pose_constraint_flags(bPose *pose)
620 {
621         bPoseChannel *pchan, *parchan;
622         bConstraint *con;
623         
624         /* clear */
625         for (pchan= pose->chanbase.first; pchan; pchan= pchan->next) {
626                 pchan->constflag= 0;
627         }
628         pose->flag &= ~POSE_CONSTRAINTS_TIMEDEPEND;
629         
630         /* detect */
631         for (pchan= pose->chanbase.first; pchan; pchan=pchan->next) {
632                 for (con= pchan->constraints.first; con; con= con->next) {
633                         if (con->type==CONSTRAINT_TYPE_KINEMATIC) {
634                                 bKinematicConstraint *data = (bKinematicConstraint*)con->data;
635                                 
636                                 pchan->constflag |= PCHAN_HAS_IK;
637                                 
638                                 if(data->tar==NULL || (data->tar->type==OB_ARMATURE && data->subtarget[0]==0))
639                                         pchan->constflag |= PCHAN_HAS_TARGET;
640                                 
641                                 /* negative rootbone = recalc rootbone index. used in do_versions */
642                                 if(data->rootbone<0) {
643                                         data->rootbone= 0;
644                                         
645                                         if(data->flag & CONSTRAINT_IK_TIP) parchan= pchan;
646                                         else parchan= pchan->parent;
647                                         
648                                         while(parchan) {
649                                                 data->rootbone++;
650                                                 if((parchan->bone->flag & BONE_CONNECTED)==0)
651                                                         break;
652                                                 parchan= parchan->parent;
653                                         }
654                                 }
655                         }
656                         else if (con->type == CONSTRAINT_TYPE_FOLLOWPATH) {
657                                 bFollowPathConstraint *data= (bFollowPathConstraint *)con->data;
658                                 
659                                 /* for drawing constraint colors when color set allows this */
660                                 pchan->constflag |= PCHAN_HAS_CONST;
661                                 
662                                 /* if we have a valid target, make sure that this will get updated on frame-change
663                                  * (needed for when there is no anim-data for this pose)
664                                  */
665                                 if ((data->tar) && (data->tar->type==OB_CURVE))
666                                         pose->flag |= POSE_CONSTRAINTS_TIMEDEPEND;
667                         }
668                         else 
669                                 pchan->constflag |= PCHAN_HAS_CONST;
670                 }
671         }
672 }
673
674 /* Clears all BONE_UNKEYED flags for every pose channel in every pose 
675  * This should only be called on frame changing, when it is acceptable to
676  * do this. Otherwise, these flags should not get cleared as poses may get lost.
677  */
678 void framechange_poses_clear_unkeyed(void)
679 {
680         Object *ob;
681         bPose *pose;
682         bPoseChannel *pchan;
683         
684         /* This needs to be done for each object that has a pose */
685         // TODO: proxies may/may not be correctly handled here... (this needs checking) 
686         for (ob= G.main->object.first; ob; ob= ob->id.next) {
687                 /* we only need to do this on objects with a pose */
688                 if ( (pose= ob->pose) ) {
689                         for (pchan= pose->chanbase.first; pchan; pchan= pchan->next) {
690                                 if (pchan->bone) 
691                                         pchan->bone->flag &= ~BONE_UNKEYED;
692                         }
693                 }
694         }
695 }
696
697 /* ************************ END Pose channels *************** */
698
699 /* ************** time ****************** */
700
701 static bActionStrip *get_active_strip(Object *ob)
702 {
703 #if 0   // XXX old animation system
704         bActionStrip *strip;
705         
706         if(ob->action==NULL)
707                 return NULL;
708                 
709         for (strip=ob->nlastrips.first; strip; strip=strip->next)
710                 if(strip->flag & ACTSTRIP_ACTIVE)
711                         break;
712         
713         if(strip && strip->act==ob->action)
714                 return strip;
715 #endif // XXX old animation system
716                 
717         return NULL;
718 }
719
720 /* non clipped mapping of strip */
721 static float get_actionstrip_frame(bActionStrip *strip, float cframe, int invert)
722 {
723         float length, actlength, repeat, scale;
724         
725         if (strip->repeat == 0.0f) strip->repeat = 1.0f;
726         repeat = (strip->flag & ACTSTRIP_USESTRIDE) ? (1.0f) : (strip->repeat);
727         
728         if (strip->scale == 0.0f) strip->scale= 1.0f;
729         scale = (float)fabs(strip->scale); /* scale must be positive (for now) */
730         
731         actlength = strip->actend-strip->actstart;
732         if (actlength == 0.0f) actlength = 1.0f;
733         length = repeat * scale * actlength;
734         
735         /* invert = convert action-strip time to global time */
736         if (invert)
737                 return length*(cframe - strip->actstart)/(repeat*actlength) + strip->start;
738         else
739                 return repeat*actlength*(cframe - strip->start)/length + strip->actstart;
740 }
741
742 /* if the conditions match, it converts current time to strip time */
743 float get_action_frame(Object *ob, float cframe)
744 {
745         bActionStrip *strip= get_active_strip(ob);
746         
747         if(strip)
748                 return get_actionstrip_frame(strip, cframe, 0);
749         return cframe;
750 }
751
752 /* inverted, strip time to current time */
753 float get_action_frame_inv(Object *ob, float cframe)
754 {
755         bActionStrip *strip= get_active_strip(ob);
756         
757         if(strip)
758                 return get_actionstrip_frame(strip, cframe, 1);
759         return cframe;
760 }
761
762
763
764
765 /* Calculate the extents of given action */
766 void calc_action_range(const bAction *act, float *start, float *end, int incl_hidden)
767 {
768         FCurve *fcu;
769         float min=999999999.0f, max=-999999999.0f;
770         short foundvert=0;
771
772         if (act) {
773                 for (fcu= act->curves.first; fcu; fcu= fcu->next) {
774                         if (fcu->totvert) {
775                                 float nmin, nmax;
776                                 
777                                 /* get extents for this curve */
778                                 calc_fcurve_range(fcu, &nmin, &nmax);
779                                 
780                                 /* compare to the running tally */
781                                 min= MIN2(min, nmin);
782                                 max= MAX2(max, nmax);
783                                 
784                                 foundvert= 1;
785                         }
786                 }
787         }       
788         
789         if (foundvert) {
790                 if(min==max) max+= 1.0f;
791                 *start= min;
792                 *end= max;
793         }
794         else {
795                 *start= 0.0f;
796                 *end= 1.0f;
797         }
798 }
799
800 /* Copy the data from the action-pose (src) into the pose */
801 /* both args are assumed to be valid */
802 /* exported to game engine */
803 /* Note! this assumes both poses are aligned, this isnt always true when dealing with user poses */
804 void extract_pose_from_pose(bPose *pose, const bPose *src)
805 {
806         const bPoseChannel *schan;
807         bPoseChannel *pchan= pose->chanbase.first;
808
809         if (pose==src) {
810                 printf("extract_pose_from_pose source and target are the same\n");
811                 return;
812         }
813
814         for (schan=src->chanbase.first; (schan && pchan); schan=schan->next, pchan= pchan->next) {
815                 copy_pose_channel_data(pchan, schan);
816         }
817 }
818
819 /* for do_all_pose_actions, clears the pose. Now also exported for proxy and tools */
820 void rest_pose(bPose *pose)
821 {
822         bPoseChannel *pchan;
823         int i;
824         
825         if (!pose)
826                 return;
827         
828         memset(pose->stride_offset, 0, sizeof(pose->stride_offset));
829         memset(pose->cyclic_offset, 0, sizeof(pose->cyclic_offset));
830         
831         for (pchan=pose->chanbase.first; pchan; pchan= pchan->next){
832                 for (i=0; i<3; i++) {
833                         pchan->loc[i]= 0.0f;
834                         pchan->quat[i+1]= 0.0f;
835                         pchan->eul[i]= 0.0f;
836                         pchan->size[i]= 1.0f;
837                 }
838                 pchan->quat[0]= 1.0f;
839                 
840                 pchan->flag &= ~(POSE_LOC|POSE_ROT|POSE_SIZE);
841         }
842 }
843
844 /* both poses should be in sync */
845 void copy_pose_result(bPose *to, bPose *from)
846 {
847         bPoseChannel *pchanto, *pchanfrom;
848         
849         if(to==NULL || from==NULL) {
850                 printf("pose result copy error\n"); // debug temp
851                 return;
852         }
853
854         if (to==from) {
855                 printf("copy_pose_result source and target are the same\n");
856                 return;
857         }
858
859
860         for(pchanfrom= from->chanbase.first; pchanfrom; pchanfrom= pchanfrom->next) {
861                 pchanto= get_pose_channel(to, pchanfrom->name);
862                 if(pchanto) {
863                         Mat4CpyMat4(pchanto->pose_mat, pchanfrom->pose_mat);
864                         Mat4CpyMat4(pchanto->chan_mat, pchanfrom->chan_mat);
865                         
866                         /* used for local constraints */
867                         VECCOPY(pchanto->loc, pchanfrom->loc);
868                         QUATCOPY(pchanto->quat, pchanfrom->quat);
869                         VECCOPY(pchanto->eul, pchanfrom->eul);
870                         VECCOPY(pchanto->size, pchanfrom->size);
871                         
872                         VECCOPY(pchanto->pose_head, pchanfrom->pose_head);
873                         VECCOPY(pchanto->pose_tail, pchanfrom->pose_tail);
874                         pchanto->flag= pchanfrom->flag;
875                 }
876         }
877 }
878
879 /* For the calculation of the effects of an Action at the given frame on an object 
880  * This is currently only used for the Action Constraint 
881  */
882 void what_does_obaction (Scene *scene, Object *ob, Object *workob, bPose *pose, bAction *act, char groupname[], float cframe)
883 {
884         bActionGroup *agrp= action_groups_find_named(act, groupname);
885         
886         /* clear workob */
887         clear_workob(workob);
888         
889         /* init workob */
890         Mat4CpyMat4(workob->obmat, ob->obmat);
891         Mat4CpyMat4(workob->parentinv, ob->parentinv);
892         Mat4CpyMat4(workob->constinv, ob->constinv);
893         workob->parent= ob->parent;
894         workob->track= ob->track;
895
896         workob->trackflag= ob->trackflag;
897         workob->upflag= ob->upflag;
898         
899         workob->partype= ob->partype;
900         workob->par1= ob->par1;
901         workob->par2= ob->par2;
902         workob->par3= ob->par3;
903
904         workob->constraints.first = ob->constraints.first;
905         workob->constraints.last = ob->constraints.last;
906         
907         workob->pose= pose;     /* need to set pose too, since this is used for both types of Action Constraint */
908
909         strcpy(workob->parsubstr, ob->parsubstr);
910         strcpy(workob->id.name, "OB<ConstrWorkOb>"); /* we don't use real object name, otherwise RNA screws with the real thing */
911         
912         /* if we're given a group to use, it's likely to be more efficient (though a bit more dangerous) */
913         if (agrp) {
914                 /* specifically evaluate this group only */
915                 PointerRNA id_ptr;
916                 
917                 /* get RNA-pointer for the workob's ID */
918                 RNA_id_pointer_create(&workob->id, &id_ptr);
919                 
920                 /* execute action for this group only */
921                 animsys_evaluate_action_group(&id_ptr, act, agrp, NULL, cframe);
922         }
923         else {
924                 AnimData adt;
925                 
926                 /* init animdata, and attach to workob */
927                 memset(&adt, 0, sizeof(AnimData));
928                 workob->adt= &adt;
929                 
930                 adt.recalc= ADT_RECALC_ANIM;
931                 adt.action= act;
932                 
933                 /* execute effects of Action on to workob (or it's PoseChannels) */
934                 BKE_animsys_evaluate_animdata(&workob->id, &adt, cframe, ADT_RECALC_ANIM);
935         }
936 }
937
938 /* ********** NLA with non-poses works with ipo channels ********** */
939
940 #if 0 // XXX OLD ANIMATION SYSTEM (TO BE REMOVED)
941
942 /* ************************ Blending with NLA *************** */
943
944 static void blend_pose_strides(bPose *dst, bPose *src, float srcweight, short mode)
945 {
946         float dstweight;
947         
948         switch (mode){
949                 case ACTSTRIPMODE_BLEND:
950                         dstweight = 1.0F - srcweight;
951                         break;
952                 case ACTSTRIPMODE_ADD:
953                         dstweight = 1.0F;
954                         break;
955                 default :
956                         dstweight = 1.0F;
957         }
958         
959         VecLerpf(dst->stride_offset, dst->stride_offset, src->stride_offset, srcweight);
960 }
961
962
963 /* 
964
965 bone matching diagram, strips A and B
966
967                  .------------------------.
968                  |         A              |
969                  '------------------------'
970                                  .          .             b2
971                  .          .-------------v----------.
972                  .              |         B   .          |
973                  .          '------------------------'
974                  .          .             .
975                  .          .             .
976 offset:          .    0     .    A-B      .  A-b2+B     
977                  .          .             .
978
979 */
980
981
982 static void blend_pose_offset_bone(bActionStrip *strip, bPose *dst, bPose *src, float srcweight, short mode)
983 {
984         /* matching offset bones */
985         /* take dst offset, and put src on on that location */
986         
987         if(strip->offs_bone[0]==0)
988                 return;
989         
990         /* are we also blending with matching bones? */
991         if(strip->prev && strip->start>=strip->prev->start) {
992                 bPoseChannel *dpchan= get_pose_channel(dst, strip->offs_bone);
993                 if(dpchan) {
994                         bPoseChannel *spchan= get_pose_channel(src, strip->offs_bone);
995                         if(spchan) {
996                                 float vec[3];
997                                 
998                                 /* dst->ctime has the internal strip->prev action time */
999                                 /* map this time to nla time */
1000                                 
1001                                 float ctime= get_actionstrip_frame(strip, src->ctime, 1);
1002                                 
1003                                 if( ctime > strip->prev->end) {
1004                                         bActionChannel *achan;
1005                                         
1006                                         /* add src to dest, minus the position of src on strip->prev->end */
1007                                         
1008                                         ctime= get_actionstrip_frame(strip, strip->prev->end, 0);
1009                                         
1010                                         achan= get_action_channel(strip->act, strip->offs_bone);
1011                                         if(achan && achan->ipo) {
1012                                                 bPoseChannel pchan;
1013                                                 /* Evaluates and sets the internal ipo value */
1014                                                 calc_ipo(achan->ipo, ctime);
1015                                                 /* This call also sets the pchan flags */
1016                                                 execute_action_ipo(achan, &pchan);
1017                                                 
1018                                                 /* store offset that moves src to location of pchan */
1019                                                 VecSubf(vec, dpchan->loc, pchan.loc);
1020                                                 
1021                                                 Mat4Mul3Vecfl(dpchan->bone->arm_mat, vec);
1022                                         }
1023                                 }
1024                                 else {
1025                                         /* store offset that moves src to location of dst */
1026                                         
1027                                         VecSubf(vec, dpchan->loc, spchan->loc);
1028                                         Mat4Mul3Vecfl(dpchan->bone->arm_mat, vec);
1029                                 }
1030                                 
1031                                 /* if blending, we only add with factor scrweight */
1032                                 VecMulf(vec, srcweight);
1033                                 
1034                                 VecAddf(dst->cyclic_offset, dst->cyclic_offset, vec);
1035                         }
1036                 }
1037         }
1038         
1039         VecAddf(dst->cyclic_offset, dst->cyclic_offset, src->cyclic_offset);
1040 }
1041
1042
1043 /* Only allowed for Poses with identical channels */
1044 void blend_poses(bPose *dst, bPose *src, float srcweight, short mode)
1045 {
1046         bPoseChannel *dchan;
1047         const bPoseChannel *schan;
1048         bConstraint *dcon, *scon;
1049         float dstweight;
1050         int i;
1051         
1052         switch (mode){
1053         case ACTSTRIPMODE_BLEND:
1054                 dstweight = 1.0F - srcweight;
1055                 break;
1056         case ACTSTRIPMODE_ADD:
1057                 dstweight = 1.0F;
1058                 break;
1059         default :
1060                 dstweight = 1.0F;
1061         }
1062         
1063         schan= src->chanbase.first;
1064         for (dchan = dst->chanbase.first; dchan; dchan=dchan->next, schan= schan->next){
1065                 if (schan->flag & (POSE_ROT|POSE_LOC|POSE_SIZE)) {
1066                         /* replaced quat->matrix->quat conversion with decent quaternion interpol (ton) */
1067                         
1068                         /* Do the transformation blend */
1069                         if (schan->flag & POSE_ROT) {
1070                                 /* quat interpolation done separate */
1071                                 if (schan->rotmode == PCHAN_ROT_QUAT) {
1072                                         float dquat[4], squat[4];
1073                                         
1074                                         QUATCOPY(dquat, dchan->quat);
1075                                         QUATCOPY(squat, schan->quat);
1076                                         if (mode==ACTSTRIPMODE_BLEND)
1077                                                 QuatInterpol(dchan->quat, dquat, squat, srcweight);
1078                                         else {
1079                                                 QuatMulFac(squat, srcweight);
1080                                                 QuatMul(dchan->quat, dquat, squat);
1081                                         }
1082                                         
1083                                         NormalQuat(dchan->quat);
1084                                 }
1085                         }
1086
1087                         for (i=0; i<3; i++) {
1088                                 /* blending for loc and scale are pretty self-explanatory... */
1089                                 if (schan->flag & POSE_LOC)
1090                                         dchan->loc[i] = (dchan->loc[i]*dstweight) + (schan->loc[i]*srcweight);
1091                                 if (schan->flag & POSE_SIZE)
1092                                         dchan->size[i] = 1.0f + ((dchan->size[i]-1.0f)*dstweight) + ((schan->size[i]-1.0f)*srcweight);
1093                                 
1094                                 /* euler-rotation interpolation done here instead... */
1095                                 // FIXME: are these results decent?
1096                                 if ((schan->flag & POSE_ROT) && (schan->rotmode))
1097                                         dchan->eul[i] = (dchan->eul[i]*dstweight) + (schan->eul[i]*srcweight);
1098                         }
1099                         dchan->flag |= schan->flag;
1100                 }
1101                 for(dcon= dchan->constraints.first, scon= schan->constraints.first; dcon && scon; dcon= dcon->next, scon= scon->next) {
1102                         /* no 'add' option for constraint blending */
1103                         dcon->enforce= dcon->enforce*(1.0f-srcweight) + scon->enforce*srcweight;
1104                 }
1105         }
1106         
1107         /* this pose is now in src time */
1108         dst->ctime= src->ctime;
1109 }
1110
1111 typedef struct NlaIpoChannel {
1112         struct NlaIpoChannel *next, *prev;
1113         float val;
1114         void *poin;
1115         int type;
1116 } NlaIpoChannel;
1117
1118 void extract_ipochannels_from_action(ListBase *lb, ID *id, bAction *act, const char *name, float ctime)
1119 {
1120         bActionChannel *achan= get_action_channel(act, name);
1121         IpoCurve *icu;
1122         NlaIpoChannel *nic;
1123         
1124         if(achan==NULL) return;
1125         
1126         if(achan->ipo) {
1127                 calc_ipo(achan->ipo, ctime);
1128                 
1129                 for(icu= achan->ipo->curve.first; icu; icu= icu->next) {
1130                         /* skip IPO_BITS, is for layers and cannot be blended */
1131                         if(icu->vartype != IPO_BITS) {
1132                                 nic= MEM_callocN(sizeof(NlaIpoChannel), "NlaIpoChannel");
1133                                 BLI_addtail(lb, nic);
1134                                 nic->val= icu->curval;
1135                                 nic->poin= get_ipo_poin(id, icu, &nic->type);
1136                         }
1137                 }
1138         }
1139         
1140         /* constraint channels only for objects */
1141         if(GS(id->name)==ID_OB) {
1142                 Object *ob= (Object *)id;
1143                 bConstraint *con;
1144                 bConstraintChannel *conchan;
1145                 
1146                 for (con=ob->constraints.first; con; con=con->next) {
1147                         conchan = get_constraint_channel(&achan->constraintChannels, con->name);
1148                         
1149                         if(conchan && conchan->ipo) {
1150                                 calc_ipo(conchan->ipo, ctime);
1151                                 
1152                                 icu= conchan->ipo->curve.first; // only one ipo now
1153                                 if(icu) {
1154                                         nic= MEM_callocN(sizeof(NlaIpoChannel), "NlaIpoChannel constr");
1155                                         BLI_addtail(lb, nic);
1156                                         nic->val= icu->curval;
1157                                         nic->poin= &con->enforce;
1158                                         nic->type= IPO_FLOAT;
1159                                 }
1160                         }
1161                 }
1162         }
1163 }
1164
1165 static NlaIpoChannel *find_nla_ipochannel(ListBase *lb, void *poin)
1166 {
1167         NlaIpoChannel *nic;
1168         
1169         if(poin) {
1170                 for(nic= lb->first; nic; nic= nic->next) {
1171                         if(nic->poin==poin)
1172                                 return nic;
1173                 }
1174         }
1175         return NULL;
1176 }
1177
1178
1179 static void blend_ipochannels(ListBase *dst, ListBase *src, float srcweight, int mode)
1180 {
1181         NlaIpoChannel *snic, *dnic, *next;
1182         float dstweight;
1183         
1184         switch (mode){
1185                 case ACTSTRIPMODE_BLEND:
1186                         dstweight = 1.0F - srcweight;
1187                         break;
1188                 case ACTSTRIPMODE_ADD:
1189                         dstweight = 1.0F;
1190                         break;
1191                 default :
1192                         dstweight = 1.0F;
1193         }
1194         
1195         for(snic= src->first; snic; snic= next) {
1196                 next= snic->next;
1197                 
1198                 dnic= find_nla_ipochannel(dst, snic->poin);
1199                 if(dnic==NULL) {
1200                         /* remove from src list, and insert in dest */
1201                         BLI_remlink(src, snic);
1202                         BLI_addtail(dst, snic);
1203                 }
1204                 else {
1205                         /* we do the blend */
1206                         dnic->val= dstweight*dnic->val + srcweight*snic->val;
1207                 }
1208         }
1209 }
1210
1211 int execute_ipochannels(ListBase *lb)
1212 {
1213         NlaIpoChannel *nic;
1214         int count = 0;
1215         
1216         for(nic= lb->first; nic; nic= nic->next) {
1217                 if(nic->poin) {
1218                         write_ipo_poin(nic->poin, nic->type, nic->val);
1219                         count++;
1220                 }
1221         }
1222         return count;
1223 }
1224
1225 /* nla timing */
1226
1227 /* this now only used for repeating cycles, to enable fields and blur. */
1228 /* the whole time control in blender needs serious thinking... */
1229 static float nla_time(Scene *scene, float cfra, float unit)
1230 {
1231         extern float bluroffs;  // bad construct, borrowed from object.c for now
1232         extern float fieldoffs;
1233         
1234         /* motion blur & fields */
1235         cfra+= unit*(bluroffs+fieldoffs);
1236         
1237         /* global time */
1238         cfra*= scene->r.framelen;       
1239         
1240         return cfra;
1241 }
1242
1243 /* added "sizecorr" here, to allow armatures to be scaled and still have striding.
1244    Only works for uniform scaling. In general I'd advise against scaling armatures ever though! (ton)
1245 */
1246 static float stridechannel_frame(Object *ob, float sizecorr, bActionStrip *strip, Path *path, float pathdist, float *stride_offset)
1247 {
1248         bAction *act= strip->act;
1249         const char *name= strip->stridechannel;
1250         bActionChannel *achan= get_action_channel(act, name);
1251         int stride_axis= strip->stride_axis;
1252
1253         if(achan && achan->ipo) {
1254                 IpoCurve *icu= NULL;
1255                 float minx=0.0f, maxx=0.0f, miny=0.0f, maxy=0.0f;
1256                 int foundvert= 0;
1257                 
1258                 if(stride_axis==0) stride_axis= AC_LOC_X;
1259                 else if(stride_axis==1) stride_axis= AC_LOC_Y;
1260                 else stride_axis= AC_LOC_Z;
1261                 
1262                 /* calculate the min/max */
1263                 for (icu=achan->ipo->curve.first; icu; icu=icu->next) {
1264                         if(icu->adrcode==stride_axis) {
1265                                 if(icu->totvert>1) {
1266                                         foundvert= 1;
1267                                         minx= icu->bezt[0].vec[1][0];
1268                                         maxx= icu->bezt[icu->totvert-1].vec[1][0];
1269                                         
1270                                         miny= icu->bezt[0].vec[1][1];
1271                                         maxy= icu->bezt[icu->totvert-1].vec[1][1];
1272                                 }
1273                                 break;
1274                         }
1275                 }
1276                 
1277                 if(foundvert && miny!=maxy) {
1278                         float stridelen= sizecorr*fabs(maxy-miny), striptime;
1279                         float actiondist, pdist, pdistNewNormalized, offs;
1280                         float vec1[4], vec2[4], dir[3];
1281                         
1282                         /* internal cycling, actoffs is in frames */
1283                         offs= stridelen*strip->actoffs/(maxx-minx);
1284                         
1285                         /* amount path moves object */
1286                         pdist = (float)fmod (pathdist+offs, stridelen);
1287                         striptime= pdist/stridelen;
1288                         
1289                         /* amount stride bone moves */
1290                         actiondist= sizecorr*eval_icu(icu, minx + striptime*(maxx-minx)) - miny;
1291                         
1292                         pdist = fabs(actiondist) - pdist;
1293                         pdistNewNormalized = (pathdist+pdist)/path->totdist;
1294                         
1295                         /* now we need to go pdist further (or less) on cu path */
1296                         where_on_path(ob, (pathdist)/path->totdist, vec1, dir); /* vec needs size 4 */
1297                         if (pdistNewNormalized <= 1) {
1298                                 // search for correction in positive path-direction
1299                                 where_on_path(ob, pdistNewNormalized, vec2, dir);       /* vec needs size 4 */
1300                                 VecSubf(stride_offset, vec2, vec1);
1301                         }
1302                         else {
1303                                 // we reached the end of the path, search backwards instead
1304                                 where_on_path(ob, (pathdist-pdist)/path->totdist, vec2, dir);   /* vec needs size 4 */
1305                                 VecSubf(stride_offset, vec1, vec2);
1306                         }
1307                         Mat4Mul3Vecfl(ob->obmat, stride_offset);
1308                         return striptime;
1309                 }
1310         }
1311         return 0.0f;
1312 }
1313
1314 static void cyclic_offs_bone(Object *ob, bPose *pose, bActionStrip *strip, float time)
1315 {
1316         /* only called when strip has cyclic, so >= 1.0f works... */
1317         if(time >= 1.0f) {
1318                 bActionChannel *achan= get_action_channel(strip->act, strip->offs_bone);
1319
1320                 if(achan && achan->ipo) {
1321                         IpoCurve *icu= NULL;
1322                         Bone *bone;
1323                         float min[3]={0.0f, 0.0f, 0.0f}, max[3]={0.0f, 0.0f, 0.0f};
1324                         int index=0, foundvert= 0;
1325                         
1326                         /* calculate the min/max */
1327                         for (icu=achan->ipo->curve.first; icu; icu=icu->next) {
1328                                 if(icu->totvert>1) {
1329                                         
1330                                         if(icu->adrcode==AC_LOC_X)
1331                                                 index= 0;
1332                                         else if(icu->adrcode==AC_LOC_Y)
1333                                                 index= 1;
1334                                         else if(icu->adrcode==AC_LOC_Z)
1335                                                 index= 2;
1336                                         else
1337                                                 continue;
1338                                 
1339                                         foundvert= 1;
1340                                         min[index]= icu->bezt[0].vec[1][1];
1341                                         max[index]= icu->bezt[icu->totvert-1].vec[1][1];
1342                                 }
1343                         }
1344                         if(foundvert) {
1345                                 /* bring it into armature space */
1346                                 VecSubf(min, max, min);
1347                                 bone= get_named_bone(ob->data, strip->offs_bone);       /* weak */
1348                                 if(bone) {
1349                                         Mat4Mul3Vecfl(bone->arm_mat, min);
1350                                         
1351                                         /* dominant motion, cyclic_offset was cleared in rest_pose */
1352                                         if (strip->flag & (ACTSTRIP_CYCLIC_USEX | ACTSTRIP_CYCLIC_USEY | ACTSTRIP_CYCLIC_USEZ)) {
1353                                                 if (strip->flag & ACTSTRIP_CYCLIC_USEX) pose->cyclic_offset[0]= time*min[0];
1354                                                 if (strip->flag & ACTSTRIP_CYCLIC_USEY) pose->cyclic_offset[1]= time*min[1];
1355                                                 if (strip->flag & ACTSTRIP_CYCLIC_USEZ) pose->cyclic_offset[2]= time*min[2];
1356                                         } else {
1357                                                 if( fabs(min[0]) >= fabs(min[1]) && fabs(min[0]) >= fabs(min[2]))
1358                                                         pose->cyclic_offset[0]= time*min[0];
1359                                                 else if( fabs(min[1]) >= fabs(min[0]) && fabs(min[1]) >= fabs(min[2]))
1360                                                         pose->cyclic_offset[1]= time*min[1];
1361                                                 else
1362                                                         pose->cyclic_offset[2]= time*min[2];
1363                                         }
1364                                 }
1365                         }
1366                 }
1367         }
1368 }
1369
1370 /* simple case for now; only the curve path with constraint value > 0.5 */
1371 /* blending we might do later... */
1372 static Object *get_parent_path(Object *ob)
1373 {
1374         bConstraint *con;
1375         
1376         if(ob->parent && ob->parent->type==OB_CURVE)
1377                 return ob->parent;
1378         
1379         for (con = ob->constraints.first; con; con=con->next) {
1380                 if(con->type==CONSTRAINT_TYPE_FOLLOWPATH) {
1381                         if(con->enforce>0.5f) {
1382                                 bFollowPathConstraint *data= con->data;
1383                                 return data->tar;
1384                         }
1385                 }
1386         }
1387         return NULL;
1388 }
1389
1390 /* ************** do the action ************ */
1391
1392 /* ----- nla, etc. --------- */
1393
1394 static void do_nla(Scene *scene, Object *ob, int blocktype)
1395 {
1396         bPose *tpose= NULL;
1397         Key *key= NULL;
1398         ListBase tchanbase={NULL, NULL}, chanbase={NULL, NULL};
1399         bActionStrip *strip, *striplast=NULL, *stripfirst=NULL;
1400         float striptime, frametime, length, actlength;
1401         float blendfac, stripframe;
1402         float scene_cfra= frame_to_float(scene, scene->r.cfra); 
1403         int     doit, dostride;
1404         
1405         if(blocktype==ID_AR) {
1406                 copy_pose(&tpose, ob->pose, 1);
1407                 rest_pose(ob->pose);            // potentially destroying current not-keyed pose
1408         }
1409         else {
1410                 key= ob_get_key(ob);
1411         }
1412         
1413         /* check on extend to left or right, when no strip is hit by 'cfra' */
1414         for (strip=ob->nlastrips.first; strip; strip=strip->next) {
1415                 /* escape loop on a hit */
1416                 if( scene_cfra >= strip->start && scene_cfra <= strip->end + 0.1f)      /* note 0.1 comes back below */
1417                         break;
1418                 if(scene_cfra < strip->start) {
1419                         if(stripfirst==NULL)
1420                                 stripfirst= strip;
1421                         else if(stripfirst->start > strip->start)
1422                                 stripfirst= strip;
1423                 }
1424                 else if(scene_cfra > strip->end) {
1425                         if(striplast==NULL)
1426                                 striplast= strip;
1427                         else if(striplast->end < strip->end)
1428                                 striplast= strip;
1429                 }
1430         }
1431         if(strip==NULL) {       /* extend */
1432                 if(striplast)
1433                         scene_cfra= striplast->end;
1434                 else if(stripfirst)
1435                         scene_cfra= stripfirst->start;
1436         }
1437         
1438         /* and now go over all strips */
1439         for (strip=ob->nlastrips.first; strip; strip=strip->next){
1440                 doit=dostride= 0;
1441                 
1442                 if (strip->act && !(strip->flag & ACTSTRIP_MUTE)) {     /* so theres an action */
1443                         
1444                         /* Determine if the current frame is within the strip's range */
1445                         length = strip->end-strip->start;
1446                         actlength = strip->actend-strip->actstart;
1447                         striptime = (scene_cfra-(strip->start)) / length;
1448                         stripframe = (scene_cfra-(strip->start)) ;
1449
1450                         if (striptime>=0.0){
1451                                 
1452                                 if(blocktype==ID_AR) 
1453                                         rest_pose(tpose);
1454                                 
1455                                 /* To handle repeat, we add 0.1 frame extra to make sure the last frame is included */
1456                                 if (striptime < 1.0f + 0.1f/length) {
1457                                         
1458                                         /* Handle path */
1459                                         if ((strip->flag & ACTSTRIP_USESTRIDE) && (blocktype==ID_AR) && (ob->ipoflag & OB_DISABLE_PATH)==0){
1460                                                 Object *parent= get_parent_path(ob);
1461                                                 
1462                                                 if (parent) {
1463                                                         Curve *cu = parent->data;
1464                                                         float ctime, pdist;
1465                                                         
1466                                                         if (cu->flag & CU_PATH){
1467                                                                 /* Ensure we have a valid path */
1468                                                                 if(cu->path==NULL || cu->path->data==NULL) makeDispListCurveTypes(scene, parent, 0);
1469                                                                 if(cu->path) {
1470                                                                         
1471                                                                         /* Find the position on the path */
1472                                                                         ctime= bsystem_time(scene, ob, scene_cfra, 0.0);
1473                                                                         
1474                                                                         if(calc_ipo_spec(cu->ipo, CU_SPEED, &ctime)==0) {
1475                                                                                 /* correct for actions not starting on zero */
1476                                                                                 ctime= (ctime - strip->actstart)/cu->pathlen;
1477                                                                                 CLAMP(ctime, 0.0, 1.0);
1478                                                                         }
1479                                                                         pdist = ctime*cu->path->totdist;
1480                                                                         
1481                                                                         if(tpose && strip->stridechannel[0]) {
1482                                                                                 striptime= stridechannel_frame(parent, ob->size[0], strip, cu->path, pdist, tpose->stride_offset);
1483                                                                         }                                                                       
1484                                                                         else {
1485                                                                                 if (strip->stridelen) {
1486                                                                                         striptime = pdist / strip->stridelen;
1487                                                                                         striptime = (float)fmod (striptime+strip->actoffs, 1.0);
1488                                                                                 }
1489                                                                                 else
1490                                                                                         striptime = 0;
1491                                                                         }
1492                                                                         
1493                                                                         frametime = (striptime * actlength) + strip->actstart;
1494                                                                         frametime= bsystem_time(scene, ob, frametime, 0.0);
1495                                                                         
1496                                                                         if(blocktype==ID_AR) {
1497                                                                                 extract_pose_from_action (tpose, strip->act, frametime);
1498                                                                         }
1499                                                                         else if(blocktype==ID_OB) {
1500                                                                                 extract_ipochannels_from_action(&tchanbase, &ob->id, strip->act, "Object", frametime);
1501                                                                                 if(key)
1502                                                                                         extract_ipochannels_from_action(&tchanbase, &key->id, strip->act, "Shape", frametime);
1503                                                                         }
1504                                                                         doit=dostride= 1;
1505                                                                 }
1506                                                         }
1507                                                 }
1508                                         }
1509                                         /* To handle repeat, we add 0.1 frame extra to make sure the last frame is included */
1510                                         else  {
1511                                                 
1512                                                 /* Mod to repeat */
1513                                                 if(strip->repeat!=1.0f) {
1514                                                         float cycle= striptime*strip->repeat;
1515                                                         
1516                                                         striptime = (float)fmod (cycle, 1.0f + 0.1f/length);
1517                                                         cycle-= striptime;
1518                                                         
1519                                                         if(blocktype==ID_AR)
1520                                                                 cyclic_offs_bone(ob, tpose, strip, cycle);
1521                                                 }
1522
1523                                                 frametime = (striptime * actlength) + strip->actstart;
1524                                                 frametime= nla_time(scene, frametime, (float)strip->repeat);
1525                                                         
1526                                                 if(blocktype==ID_AR) {
1527                                                         extract_pose_from_action (tpose, strip->act, frametime);
1528                                                 }
1529                                                 else if(blocktype==ID_OB) {
1530                                                         extract_ipochannels_from_action(&tchanbase, &ob->id, strip->act, "Object", frametime);
1531                                                         if(key)
1532                                                                 extract_ipochannels_from_action(&tchanbase, &key->id, strip->act, "Shape", frametime);
1533                                                 }
1534                                                 
1535                                                 doit=1;
1536                                         }
1537                                 }
1538                                 /* Handle extend */
1539                                 else {
1540                                         if (strip->flag & ACTSTRIP_HOLDLASTFRAME){
1541                                                 /* we want the strip to hold on the exact fraction of the repeat value */
1542                                                 
1543                                                 frametime = actlength * (strip->repeat-(int)strip->repeat);
1544                                                 if(frametime<=0.000001f) frametime= actlength;  /* rounding errors... */
1545                                                 frametime= bsystem_time(scene, ob, frametime+strip->actstart, 0.0);
1546                                                 
1547                                                 if(blocktype==ID_AR)
1548                                                         extract_pose_from_action (tpose, strip->act, frametime);
1549                                                 else if(blocktype==ID_OB) {
1550                                                         extract_ipochannels_from_action(&tchanbase, &ob->id, strip->act, "Object", frametime);
1551                                                         if(key)
1552                                                                 extract_ipochannels_from_action(&tchanbase, &key->id, strip->act, "Shape", frametime);
1553                                                 }
1554                                                 
1555                                                 /* handle cycle hold */
1556                                                 if(strip->repeat!=1.0f) {
1557                                                         if(blocktype==ID_AR)
1558                                                                 cyclic_offs_bone(ob, tpose, strip, strip->repeat-1.0f);
1559                                                 }
1560                                                 
1561                                                 doit=1;
1562                                         }
1563                                 }
1564                                 
1565                                 /* Handle blendin & blendout */
1566                                 if (doit){
1567                                         /* Handle blendin */
1568                                         
1569                                         if (strip->blendin>0.0 && stripframe<=strip->blendin && scene_cfra>=strip->start){
1570                                                 blendfac = stripframe/strip->blendin;
1571                                         }
1572                                         else if (strip->blendout>0.0 && stripframe>=(length-strip->blendout) && scene_cfra<=strip->end){
1573                                                 blendfac = (length-stripframe)/(strip->blendout);
1574                                         }
1575                                         else
1576                                                 blendfac = 1;
1577                                         
1578                                         if(blocktype==ID_AR) {/* Blend this pose with the accumulated pose */
1579                                                 /* offset bone, for matching cycles */
1580                                                 blend_pose_offset_bone (strip, ob->pose, tpose, blendfac, strip->mode);
1581                                                 
1582                                                 blend_poses (ob->pose, tpose, blendfac, strip->mode);
1583                                                 if(dostride)
1584                                                         blend_pose_strides (ob->pose, tpose, blendfac, strip->mode);
1585                                         }
1586                                         else {
1587                                                 blend_ipochannels(&chanbase, &tchanbase, blendfac, strip->mode);
1588                                                 BLI_freelistN(&tchanbase);
1589                                         }
1590                                 }
1591                         }                                       
1592                 }
1593         }
1594         
1595         if(blocktype==ID_OB) {
1596                 execute_ipochannels(&chanbase);
1597         }
1598         else if(blocktype==ID_AR) {
1599                 /* apply stride offset to object */
1600                 VecAddf(ob->obmat[3], ob->obmat[3], ob->pose->stride_offset);
1601         }
1602         
1603         /* free */
1604         if (tpose)
1605                 free_pose(tpose);
1606         if(chanbase.first)
1607                 BLI_freelistN(&chanbase);
1608 }
1609
1610 #endif // XXX OLD ANIMATION SYSTEM (TO BE REMOVED)