code cleanup: function naming, use BKE_*type* prefix.
[blender.git] / source / blender / collada / AnimationImporter.cpp
index 9b4e47615f7f8ee2fd66c1fd39f52e1736713fd0..34f7efa9de0fc13e85d5d363f4cd5f8b12cb0719 100644 (file)
@@ -119,7 +119,7 @@ void AnimationImporter::animation_to_fcurves(COLLADAFW::AnimationCurve *curve)
                                        bez.vec[1][1] = bc_get_float_value(output, j * dim + i);
 
 
-                                       if( curve->getInterpolationType() == COLLADAFW::AnimationCurve::INTERPOLATION_BEZIER ||
+                                       if ( curve->getInterpolationType() == COLLADAFW::AnimationCurve::INTERPOLATION_BEZIER ||
                                                curve->getInterpolationType() == COLLADAFW::AnimationCurve::INTERPOLATION_STEP) 
                                        {
                                                COLLADAFW::FloatOrDoubleArray& intan = curve->getInTangentValues();
@@ -132,14 +132,13 @@ void AnimationImporter::animation_to_fcurves(COLLADAFW::AnimationCurve *curve)
                                                // outtangent
                                                bez.vec[2][0] = bc_get_float_value(outtan, (j * 2 * dim ) + (2 * i)) * fps;
                                                bez.vec[2][1] = bc_get_float_value(outtan, (j * 2 * dim )+ (2 * i) + 1);
-                                               if(curve->getInterpolationType() == COLLADAFW::AnimationCurve::INTERPOLATION_BEZIER) 
+                                               if (curve->getInterpolationType() == COLLADAFW::AnimationCurve::INTERPOLATION_BEZIER) 
                                                        bez.ipo = BEZT_IPO_BEZ;
                                                else 
                                                        bez.ipo = BEZT_IPO_CONST;
                                                //bez.h1 = bez.h2 = HD_AUTO;    
                                        }
-                                       else 
-                                       {
+                                       else {
                                                bez.h1 = bez.h2 = HD_AUTO; 
                                                bez.ipo = BEZT_IPO_LIN;
                                        }
@@ -261,7 +260,7 @@ bool AnimationImporter::write_animation(const COLLADAFW::Animation* anim)
                // XXX Don't know if it's necessary
                // Should we check outPhysicalDimension?
                if (curve->getInPhysicalDimension() != COLLADAFW::PHYSICAL_DIMENSION_TIME) {
-                       fprintf(stderr, "Inputs physical dimension is not time. \n");
+                       fprintf(stderr, "Inputs physical dimension is not time.\n");
                        return true;
                }
 
@@ -325,7 +324,7 @@ void AnimationImporter::read_node_transform(COLLADAFW::Node *node, Object *ob)
        TransformReader::get_node_mat(mat, node, &uid_animated_map, ob);
        if (ob) {
                copy_m4_m4(ob->obmat, mat);
-               object_apply_mat4(ob, ob->obmat, 0, 0);
+               BKE_object_apply_mat4(ob, ob->obmat, 0, 0);
        }
 }
 
@@ -424,7 +423,7 @@ virtual void AnimationImporter::change_eul_to_quat(Object *ob, bAction *act)
 
 
 //sets the rna_path and array index to curve
-void AnimationImporter::modify_fcurve(std::vector<FCurve*>* curves , const char* rna_path , int array_index )
+void AnimationImporter::modify_fcurve(std::vector<FCurve*>* curves, const char* rna_path, int array_index )
 {
        std::vector<FCurve*>::iterator it;
        int i;
@@ -439,7 +438,17 @@ void AnimationImporter::modify_fcurve(std::vector<FCurve*>* curves , const char*
        }
 }
 
-void AnimationImporter::find_frames( std::vector<float>* frames , std::vector<FCurve*>* curves)
+void AnimationImporter::unused_fcurve(std::vector<FCurve*>* curves)
+{
+       // when an error happens and we can't actually use curve remove it from unused_curves
+       std::vector<FCurve*>::iterator it;
+       for (it = curves->begin(); it != curves->end(); it++) {
+               FCurve *fcu = *it;
+               unused_curves.erase(std::remove(unused_curves.begin(), unused_curves.end(), fcu), unused_curves.end());
+       }
+}
+
+void AnimationImporter::find_frames( std::vector<float>* frames, std::vector<FCurve*>* curves)
 {
        std::vector<FCurve*>::iterator iter;
        for (iter = curves->begin(); iter != curves->end(); iter++) {
@@ -457,7 +466,7 @@ void AnimationImporter::find_frames( std::vector<float>* frames , std::vector<FC
 }
 
 //creates the rna_paths and array indices of fcurves from animations using transformation and bound animation class of each animation.
-void AnimationImporter:: Assign_transform_animations(COLLADAFW::Transformation * transform , 
+void AnimationImporter:: Assign_transform_animations(COLLADAFW::Transformation * transform,
                                                                                                         const COLLADAFW::AnimationList::AnimationBinding * binding,
                                                                                                         std::vector<FCurve*>* curves, bool is_joint, char * joint_path)
 {
@@ -500,6 +509,7 @@ void AnimationImporter:: Assign_transform_animations(COLLADAFW::Transformation *
                        modify_fcurve(curves, rna_path, -1 );
                        break;
                default:
+                       unused_fcurve(curves);
                        fprintf(stderr, "AnimationClass %d is not supported for %s.\n",
                                binding->animationClass, loc ? "TRANSLATE" : "SCALE");
                                }
@@ -535,10 +545,13 @@ void AnimationImporter:: Assign_transform_animations(COLLADAFW::Transformation *
                        else if (COLLADABU::Math::Vector3::UNIT_Z == axis) {
                                modify_fcurve(curves, rna_path, 2 );
                        }
+                       else
+                               unused_fcurve(curves);
                        break;
                case COLLADAFW::AnimationList::AXISANGLE:
                        // TODO convert axis-angle to quat? or XYZ?
                default:
+                       unused_fcurve(curves);
                        fprintf(stderr, "AnimationClass %d is not supported for ROTATE transformation.\n",
                                binding->animationClass);
                                }
@@ -554,9 +567,11 @@ void AnimationImporter:: Assign_transform_animations(COLLADAFW::Transformation *
 
                        }
                        }*/
+                       unused_fcurve(curves);
                        break;
                case COLLADAFW::Transformation::SKEW:
                case COLLADAFW::Transformation::LOOKAT:
+                       unused_fcurve(curves);
                        fprintf(stderr, "Animation of SKEW and LOOKAT transformations is not supported yet.\n");
                        break;
        }
@@ -564,10 +579,10 @@ void AnimationImporter:: Assign_transform_animations(COLLADAFW::Transformation *
 }
 
 //creates the rna_paths and array indices of fcurves from animations using color and bound animation class of each animation.
-void AnimationImporter:: Assign_color_animations(const COLLADAFW::UniqueId& listid, ListBase *AnimCurves ,const char * anim_type)
+void AnimationImporter:: Assign_color_animations(const COLLADAFW::UniqueId& listid, ListBase *AnimCurvesconst char * anim_type)
 {
        char rna_path[100];
-       BLI_strncpy(rna_path,anim_type, sizeof(rna_path));
+       BLI_strncpy(rna_path, anim_type, sizeof(rna_path));
 
        const COLLADAFW::AnimationList *animlist = animlist_map[listid];
        const COLLADAFW::AnimationList::AnimationBindings& bindings = animlist->getAnimationBindings();
@@ -592,6 +607,7 @@ void AnimationImporter:: Assign_color_animations(const COLLADAFW::UniqueId& list
                        break;
 
                default:
+                       unused_fcurve(&animcurves);
                        fprintf(stderr, "AnimationClass %d is not supported for %s.\n",
                                bindings[j].animationClass, "COLOR" );
                }
@@ -610,9 +626,10 @@ void AnimationImporter:: Assign_color_animations(const COLLADAFW::UniqueId& list
 void AnimationImporter:: Assign_float_animations(const COLLADAFW::UniqueId& listid, ListBase *AnimCurves, const char * anim_type)
 {
        char rna_path[100];
-       if (animlist_map.find(listid) == animlist_map.end()) return ;
-       else 
-       {
+       if (animlist_map.find(listid) == animlist_map.end()) {
+               return;
+       }
+       else {
                //anim_type has animations
                const COLLADAFW::AnimationList *animlist = animlist_map[listid];
                const COLLADAFW::AnimationList::AnimationBindings& bindings = animlist->getAnimationBindings();
@@ -621,7 +638,7 @@ void AnimationImporter:: Assign_float_animations(const COLLADAFW::UniqueId& list
                for (unsigned int j = 0; j < bindings.getCount(); j++) {
                        animcurves = curve_map[bindings[j].animation];
 
-                       BLI_strncpy(rna_path, anim_type , sizeof(rna_path));
+                       BLI_strncpy(rna_path, anim_type, sizeof(rna_path));
                        modify_fcurve(&animcurves, rna_path, 0 );
                        std::vector<FCurve*>::iterator iter;
                        //Add the curves of the current animation to the object
@@ -634,7 +651,7 @@ void AnimationImporter:: Assign_float_animations(const COLLADAFW::UniqueId& list
        
 }
 
-void AnimationImporter::apply_matrix_curves( Object * ob, std::vector<FCurve*>& animcurves, COLLADAFW::Node* root ,COLLADAFW::Node* node, 
+void AnimationImporter::apply_matrix_curves( Object * ob, std::vector<FCurve*>& animcurves, COLLADAFW::Node* root, COLLADAFW::Node* node,
                                                                                                        COLLADAFW::Transformation * tm )
 {
        bool is_joint = node->getType() == COLLADAFW::Node::JOINT;
@@ -665,7 +682,7 @@ void AnimationImporter::apply_matrix_curves( Object * ob, std::vector<FCurve*>&
        }
        // new curves to assign matrix transform animation
        FCurve *newcu[10]; // if tm_type is matrix, then create 10 curves: 4 rot, 3 loc, 3 scale
-       unsigned int totcu = 10 ;
+       unsigned int totcu = 10;
        const char *tm_str = NULL;
        char rna_path[200];
        for (int i = 0; i < totcu; i++) {
@@ -723,9 +740,9 @@ void AnimationImporter::apply_matrix_curves( Object * ob, std::vector<FCurve*>&
 
                        // calc M
                        calc_joint_parent_mat_rest(par, NULL, root, node);
-                       mul_m4_m4m4(temp, matfra, par);
+                       mult_m4_m4m4(temp, par, matfra);
 
-                       // evaluate_joint_world_transform_at_frame(temp, NULL, node, fra);
+                       // evaluate_joint_world_transform_at_frame(temp, NULL, node, fra);
 
                        // calc special matrix
                        mul_serie_m4(mat, irest, temp, irest_dae, rest, NULL, NULL, NULL, NULL);
@@ -778,27 +795,25 @@ void AnimationImporter::apply_matrix_curves( Object * ob, std::vector<FCurve*>&
 
 }
 
-void AnimationImporter::translate_Animations ( COLLADAFW::Node * node , 
-                                                                                                  std::map<COLLADAFW::UniqueId, COLLADAFW::Node*>& root_map,
-                                                                                                  std::map<COLLADAFW::UniqueId, Object*>& object_map,
-                                                                                                  std::map<COLLADAFW::UniqueId, const COLLADAFW::Object*> FW_object_map)
+void AnimationImporter::translate_Animations ( COLLADAFW::Node * node,
+                                                                                               std::map<COLLADAFW::UniqueId, COLLADAFW::Node*>& root_map,
+                                                                                               std::multimap<COLLADAFW::UniqueId, Object*>& object_map,
+                                                                                               std::map<COLLADAFW::UniqueId, const COLLADAFW::Object*> FW_object_map)
 {
        AnimationImporter::AnimMix* animType = get_animation_type(node, FW_object_map );
 
        bool is_joint = node->getType() == COLLADAFW::Node::JOINT;
        COLLADAFW::Node *root = root_map.find(node->getUniqueId()) == root_map.end() ? node : root_map[node->getUniqueId()];
-       Object *ob = is_joint ? armature_importer->get_armature_for_joint(root) : object_map[node->getUniqueId()];
-       if (!ob)
-       {
+    Object *ob = is_joint ? armature_importer->get_armature_for_joint(root) : object_map.find(node->getUniqueId())->second;
+       if (!ob) {
                fprintf(stderr, "cannot find Object for Node with id=\"%s\"\n", node->getOriginalId().c_str());
                return;
        }
 
        bAction * act;
 
-       if ( (animType->transform) != 0 )
-       {
-               const char *bone_name = is_joint ? bc_get_joint_name(node) : NULL;
+       if ( (animType->transform) != 0 ) {
+               /* const char *bone_name = is_joint ? bc_get_joint_name(node) : NULL; */ /* UNUSED */
                char joint_path[200];
 
                if ( is_joint ) 
@@ -824,9 +839,10 @@ void AnimationImporter::translate_Animations ( COLLADAFW::Node * node ,
                        const COLLADAFW::UniqueId& listid = transform->getAnimationList();
 
                        //check if transformation has animations
-                       if (animlist_map.find(listid) == animlist_map.end()) continue ; 
-                       else 
-                       {
+                       if (animlist_map.find(listid) == animlist_map.end()) {
+                               continue;
+                       }
+                       else {
                                //transformation has animations
                                const COLLADAFW::AnimationList *animlist = animlist_map[listid];
                                const COLLADAFW::AnimationList::AnimationBindings& bindings = animlist->getAnimationBindings();
@@ -834,40 +850,38 @@ void AnimationImporter::translate_Animations ( COLLADAFW::Node * node ,
                                std::vector<FCurve*> animcurves;
                                for (unsigned int j = 0; j < bindings.getCount(); j++) {
                                        animcurves = curve_map[bindings[j].animation];
-                                       if ( is_matrix )
-                                               apply_matrix_curves(ob, animcurves, root , node,  transform  );
+                                       if ( is_matrix ) {
+                                               apply_matrix_curves(ob, animcurves, root, node,  transform  );
+                                       }
                                        else {                          
-                                               //calculate rnapaths and array index of fcurves according to transformation and animation class
-                                               Assign_transform_animations(transform, &bindings[j], &animcurves, is_joint, joint_path ); 
-
-                                               std::vector<FCurve*>::iterator iter;
-                                               //Add the curves of the current animation to the object
-                                               for (iter = animcurves.begin(); iter != animcurves.end(); iter++) {
-                                                       FCurve * fcu = *iter;
-                                                       if ((ob->type == OB_ARMATURE))
-                                                               add_bone_fcurve( ob, node , fcu );
-                                                       else 
-                                                               BLI_addtail(AnimCurves, fcu);   
+
+                                               if (is_joint) {
+
+                                                       add_bone_animation_sampled(ob, animcurves, root, node, transform);
                                                }
+                                               else {
+                                                       //calculate rnapaths and array index of fcurves according to transformation and animation class
+                                                       Assign_transform_animations(transform, &bindings[j], &animcurves, is_joint, joint_path ); 
+
+                                                       std::vector<FCurve*>::iterator iter;
+                                                       //Add the curves of the current animation to the object
+                                                       for (iter = animcurves.begin(); iter != animcurves.end(); iter++) {
+                                                               FCurve * fcu = *iter;
+                                                       
+                                                               BLI_addtail(AnimCurves, fcu);
+                                                       }
+                                               }
+                                               
                                        }
                                }
                        }
-                       if (is_rotation) {
-                               if (is_joint) 
-                               {
-                                       bPoseChannel *chan = get_pose_channel(ob->pose, bone_name);
-                                       chan->rotmode = ROT_MODE_EUL;
-                               }
-                               else 
-                               {
-                                       ob->rotmode = ROT_MODE_EUL;
-                               }
+                       if (is_rotation && !is_joint) {
+                               ob->rotmode = ROT_MODE_EUL;
                        }
                }
        }
 
-       if ((animType->light) != 0)
-       {
+       if ((animType->light) != 0) {
                Lamp * lamp  = (Lamp*) ob->data;
 
                if (!lamp->adt || !lamp->adt->action) act = verify_adt_action((ID*)&lamp->id, 1);
@@ -879,33 +893,29 @@ void AnimationImporter::translate_Animations ( COLLADAFW::Node * node ,
                for (unsigned int i = 0; i < nodeLights.getCount(); i++) {
                        const COLLADAFW::Light *light = (COLLADAFW::Light *) FW_object_map[nodeLights[i]->getInstanciatedObjectId()];
 
-                       if ((animType->light & LIGHT_COLOR) != 0)
-                       {
+                       if ((animType->light & LIGHT_COLOR) != 0) {
                                const COLLADAFW::Color *col =  &(light->getColor());
                                const COLLADAFW::UniqueId& listid = col->getAnimationList();
 
                                Assign_color_animations(listid, AnimCurves, "color"); 
                        }
-                       if ((animType->light & LIGHT_FOA) != 0 )
-                       {
+                       if ((animType->light & LIGHT_FOA) != 0 ) {
                                const COLLADAFW::AnimatableFloat *foa =  &(light->getFallOffAngle());
                                const COLLADAFW::UniqueId& listid = foa->getAnimationList();
 
-                               Assign_float_animations( listid ,AnimCurves, "spot_size"); 
+                               Assign_float_animations( listid, AnimCurves, "spot_size");
                        }
-                       if ( (animType->light & LIGHT_FOE) != 0 )
-                       {
+                       if ( (animType->light & LIGHT_FOE) != 0 ) {
                                const COLLADAFW::AnimatableFloat *foe =  &(light->getFallOffExponent());
                                const COLLADAFW::UniqueId& listid = foe->getAnimationList();
 
-                               Assign_float_animations( listid ,AnimCurves, "spot_blend"); 
+                               Assign_float_animations( listid, AnimCurves, "spot_blend");
 
                        }
                }
        }
 
-       if ( (animType->camera) != 0) 
-       {
+       if ( (animType->camera) != 0)  {
                Camera * camera  = (Camera*) ob->data;
 
                if (!camera->adt || !camera->adt->action) act = verify_adt_action((ID*)&camera->id, 1);
@@ -917,37 +927,33 @@ void AnimationImporter::translate_Animations ( COLLADAFW::Node * node ,
                for (unsigned int i = 0; i < nodeCameras.getCount(); i++) {
                        const COLLADAFW::Camera *camera = (COLLADAFW::Camera *) FW_object_map[nodeCameras[i]->getInstanciatedObjectId()];
 
-                       if ((animType->camera & CAMERA_XFOV) != 0 )
-                       {
+                       if ((animType->camera & CAMERA_XFOV) != 0 ) {
                                const COLLADAFW::AnimatableFloat *xfov =  &(camera->getXFov());
                                const COLLADAFW::UniqueId& listid = xfov->getAnimationList();
-                               Assign_float_animations( listid ,AnimCurves, "lens"); 
+                               Assign_float_animations( listid, AnimCurves, "lens");
                        }
 
-                       else if ((animType->camera & CAMERA_XMAG) != 0 )
-                       {
+                       else if ((animType->camera & CAMERA_XMAG) != 0 ) {
                                const COLLADAFW::AnimatableFloat *xmag =  &(camera->getXMag());
                                const COLLADAFW::UniqueId& listid = xmag->getAnimationList();
-                               Assign_float_animations( listid ,AnimCurves, "ortho_scale"); 
+                               Assign_float_animations( listid, AnimCurves, "ortho_scale");
                        }
 
-                       if ((animType->camera & CAMERA_ZFAR) != 0 )
-                       {
+                       if ((animType->camera & CAMERA_ZFAR) != 0 ) {
                                const COLLADAFW::AnimatableFloat *zfar =  &(camera->getFarClippingPlane());
                                const COLLADAFW::UniqueId& listid = zfar->getAnimationList();
-                               Assign_float_animations( listid ,AnimCurves, "clip_end"); 
+                               Assign_float_animations( listid, AnimCurves, "clip_end");
                        }
 
-                       if ((animType->camera & CAMERA_ZNEAR) != 0 )
-                       {
+                       if ((animType->camera & CAMERA_ZNEAR) != 0 ) {
                                const COLLADAFW::AnimatableFloat *znear =  &(camera->getNearClippingPlane());
                                const COLLADAFW::UniqueId& listid = znear->getAnimationList();
-                               Assign_float_animations( listid ,AnimCurves, "clip_start"); 
+                               Assign_float_animations( listid, AnimCurves, "clip_start");
                        }
 
                }
        }
-       if ( animType->material != 0){
+       if ( animType->material != 0) {
                Material *ma = give_current_material(ob, 1);
                if (!ma->adt || !ma->adt->action) act = verify_adt_action((ID*)&ma->id, 1);
                else act = ma->adt->action;
@@ -963,28 +969,28 @@ void AnimationImporter::translate_Animations ( COLLADAFW::Node * node ,
                                if (ef != NULL) { /* can be NULL [#28909] */
                                        const COLLADAFW::CommonEffectPointerArray& commonEffects  =  ef->getCommonEffects();
                                        COLLADAFW::EffectCommon *efc = commonEffects[0];
-                                       if((animType->material & MATERIAL_SHININESS) != 0){
+                                       if ((animType->material & MATERIAL_SHININESS) != 0) {
                                                const COLLADAFW::FloatOrParam *shin = &(efc->getShininess());
                                                const COLLADAFW::UniqueId& listid =  shin->getAnimationList();
-                                               Assign_float_animations( listid, AnimCurves , "specular_hardness" );
+                                               Assign_float_animations( listid, AnimCurves, "specular_hardness" );
                                        }
 
-                                       if((animType->material & MATERIAL_IOR) != 0){
+                                       if ((animType->material & MATERIAL_IOR) != 0) {
                                                const COLLADAFW::FloatOrParam *ior = &(efc->getIndexOfRefraction());
                                                const COLLADAFW::UniqueId& listid =  ior->getAnimationList();
-                                               Assign_float_animations( listid, AnimCurves , "raytrace_transparency.ior" );
+                                               Assign_float_animations( listid, AnimCurves, "raytrace_transparency.ior" );
                                        }
 
-                                       if((animType->material & MATERIAL_SPEC_COLOR) != 0){
+                                       if ((animType->material & MATERIAL_SPEC_COLOR) != 0) {
                                                const COLLADAFW::ColorOrTexture *cot = &(efc->getSpecular());
                                                const COLLADAFW::UniqueId& listid =  cot->getColor().getAnimationList();
-                                               Assign_color_animations( listid, AnimCurves , "specular_color" );
+                                               Assign_color_animations( listid, AnimCurves, "specular_color" );
                                        }
 
-                                       if((animType->material & MATERIAL_DIFF_COLOR) != 0){
+                                       if ((animType->material & MATERIAL_DIFF_COLOR) != 0) {
                                                const COLLADAFW::ColorOrTexture *cot = &(efc->getDiffuse());
                                                const COLLADAFW::UniqueId& listid =  cot->getColor().getAnimationList();
-                                               Assign_color_animations( listid, AnimCurves , "diffuse_color" );
+                                               Assign_color_animations( listid, AnimCurves, "diffuse_color" );
                                        }
                                }
                        }
@@ -992,9 +998,139 @@ void AnimationImporter::translate_Animations ( COLLADAFW::Node * node ,
        }
 }
 
+void AnimationImporter::add_bone_animation_sampled(Object * ob, std::vector<FCurve*>& animcurves, COLLADAFW::Node* root, COLLADAFW::Node* node, COLLADAFW::Transformation * tm)
+{
+       const char *bone_name = bc_get_joint_name(node);
+       char joint_path[200];
+       armature_importer->get_rna_path_for_joint(node, joint_path, sizeof(joint_path));
+
+       std::vector<float> frames;
+       find_frames(&frames, &animcurves);
+
+       // convert degrees to radians
+       if (tm->getTransformationType() == COLLADAFW::Transformation::ROTATE) {
+
+               std::vector<FCurve*>::iterator iter;
+               for (iter = animcurves.begin(); iter != animcurves.end(); iter++) {
+                       FCurve* fcu = *iter;
+
+                       fcurve_deg_to_rad(fcu);          
+               }                                       
+       }
+
+
+       float irest_dae[4][4];
+       float rest[4][4], irest[4][4];
+
+       get_joint_rest_mat(irest_dae, root, node);
+       invert_m4(irest_dae);
+
+       Bone *bone = get_named_bone((bArmature*)ob->data, bone_name);
+       if (!bone) {
+               fprintf(stderr, "cannot find bone \"%s\"\n", bone_name);
+               return;
+       }
+
+       unit_m4(rest);
+       copy_m4_m4(rest, bone->arm_mat);
+       invert_m4_m4(irest, rest);
+
+       // new curves to assign matrix transform animation
+       FCurve *newcu[10]; // if tm_type is matrix, then create 10 curves: 4 rot, 3 loc, 3 scale
+       unsigned int totcu = 10;
+       const char *tm_str = NULL;
+       char rna_path[200];
+       for (int i = 0; i < totcu; i++) {
+
+               int axis = i;
+
+               if (i < 4) {
+                       tm_str = "rotation_quaternion";
+                       axis = i;
+               }
+               else if (i < 7) {
+                       tm_str = "location";
+                       axis = i - 4;
+               }
+               else {
+                       tm_str = "scale";
+                       axis = i - 7;
+               }
+
+
+               BLI_snprintf(rna_path, sizeof(rna_path), "%s.%s", joint_path, tm_str);
+
+               newcu[i] = create_fcurve(axis, rna_path);
+               newcu[i]->totvert = frames.size();
+       }
+
+       if (frames.size() == 0)
+               return;
+
+       std::sort(frames.begin(), frames.end());
+
+       std::vector<float>::iterator it;
+
+       // sample values at each frame
+       for (it = frames.begin(); it != frames.end(); it++) {
+               float fra = *it;
+
+               float mat[4][4];
+               float matfra[4][4];
+
+               unit_m4(matfra);
+
+               // calc object-space mat
+               evaluate_transform_at_frame(matfra, node, fra);
+
+
+               // for joints, we need a special matrix
+               // special matrix: iR * M * iR_dae * R
+               // where R, iR are bone rest and inverse rest mats in world space (Blender bones),
+               // iR_dae is joint inverse rest matrix (DAE) and M is an evaluated joint world-space matrix (DAE)
+               float temp[4][4], par[4][4];
+
+
+               // calc M
+               calc_joint_parent_mat_rest(par, NULL, root, node);
+               mult_m4_m4m4(temp, par, matfra);
+
+               // evaluate_joint_world_transform_at_frame(temp, NULL,, node, fra);
+
+               // calc special matrix
+               mul_serie_m4(mat, irest, temp, irest_dae, rest, NULL, NULL, NULL, NULL);
+
+               float  rot[4], loc[3], scale[3];
+
+               mat4_to_quat(rot, mat);
+               copy_v3_v3(loc, mat[3]);
+               mat4_to_size(scale, mat);
+
+               // add keys
+               for (int i = 0; i < totcu; i++) {
+                       if (i < 4)
+                               add_bezt(newcu[i], fra, rot[i]);
+                       else if (i < 7)
+                               add_bezt(newcu[i], fra, loc[i - 4]);
+                       else
+                               add_bezt(newcu[i], fra, scale[i - 7]);
+               }
+       }
+       verify_adt_action((ID*)&ob->id, 1);
+
+       // add curves
+       for (int i= 0; i < totcu; i++) {
+               add_bone_fcurve(ob, node, newcu[i]);
+       }
+
+       bPoseChannel *chan = get_pose_channel(ob->pose, bone_name);
+       chan->rotmode = ROT_MODE_QUAT;
+
+}
+
 
 //Check if object is animated by checking if animlist_map holds the animlist_id of node transforms
-AnimationImporter::AnimMix* AnimationImporter::get_animation_type ( const COLLADAFW::Node * node , 
+AnimationImporter::AnimMix* AnimationImporter::get_animation_type ( const COLLADAFW::Node * node,
                                                                                        std::map<COLLADAFW::UniqueId, const COLLADAFW::Object*> FW_object_map) 
 {
        AnimMix *types = new AnimMix();
@@ -1007,9 +1143,10 @@ AnimationImporter::AnimMix* AnimationImporter::get_animation_type ( const COLLAD
                const COLLADAFW::UniqueId& listid = transform->getAnimationList();
 
                //check if transformation has animations
-               if (animlist_map.find(listid) == animlist_map.end()) continue ;
-               else 
-               {
+               if (animlist_map.find(listid) == animlist_map.end()) {
+                       continue;
+               }
+               else {
                        types->transform = types->transform|NODE_TRANSFORM;
                        break;
                }
@@ -1018,9 +1155,9 @@ AnimationImporter::AnimMix* AnimationImporter::get_animation_type ( const COLLAD
 
        for (unsigned int i = 0; i < nodeLights.getCount(); i++) {
                const COLLADAFW::Light *light = (COLLADAFW::Light *) FW_object_map[nodeLights[i]->getInstanciatedObjectId()];
-               types->light = setAnimType(&(light->getColor()),(types->light), LIGHT_COLOR);
-               types->light = setAnimType(&(light->getFallOffAngle()),(types->light), LIGHT_FOA);
-               types->light = setAnimType(&(light->getFallOffExponent()),(types->light), LIGHT_FOE);
+               types->light = setAnimType(&(light->getColor()), (types->light), LIGHT_COLOR);
+               types->light = setAnimType(&(light->getFallOffAngle()), (types->light), LIGHT_FOA);
+               types->light = setAnimType(&(light->getFallOffExponent()), (types->light), LIGHT_FOE);
 
                if ( types->light != 0) break;
 
@@ -1030,16 +1167,14 @@ AnimationImporter::AnimMix* AnimationImporter::get_animation_type ( const COLLAD
        for (unsigned int i = 0; i < nodeCameras.getCount(); i++) {
                const COLLADAFW::Camera *camera = (COLLADAFW::Camera *) FW_object_map[nodeCameras[i]->getInstanciatedObjectId()];
 
-               if ( camera->getCameraType() == COLLADAFW::Camera::PERSPECTIVE )
-               {
-                       types->camera = setAnimType(&(camera->getXMag()),(types->camera), CAMERA_XFOV);
+               if ( camera->getCameraType() == COLLADAFW::Camera::PERSPECTIVE ) {
+                       types->camera = setAnimType(&(camera->getXMag()), (types->camera), CAMERA_XFOV);
                }
-               else
-               {
-                       types->camera = setAnimType(&(camera->getXMag()),(types->camera), CAMERA_XMAG);
+               else {
+                       types->camera = setAnimType(&(camera->getXMag()), (types->camera), CAMERA_XMAG);
                }
-               types->camera = setAnimType(&(camera->getFarClippingPlane()),(types->camera), CAMERA_ZFAR);
-               types->camera = setAnimType(&(camera->getNearClippingPlane()),(types->camera), CAMERA_ZNEAR);
+               types->camera = setAnimType(&(camera->getFarClippingPlane()), (types->camera), CAMERA_ZFAR);
+               types->camera = setAnimType(&(camera->getNearClippingPlane()), (types->camera), CAMERA_ZNEAR);
 
                if ( types->camera != 0) break;
 
@@ -1053,13 +1188,13 @@ AnimationImporter::AnimMix* AnimationImporter::get_animation_type ( const COLLAD
                        const COLLADAFW::Effect *ef = (COLLADAFW::Effect *) (FW_object_map[matuid]);
                        if (ef != NULL) { /* can be NULL [#28909] */
                                const COLLADAFW::CommonEffectPointerArray& commonEffects = ef->getCommonEffects();
-                               if(!commonEffects.empty()) {
+                               if (!commonEffects.empty()) {
                                        COLLADAFW::EffectCommon *efc = commonEffects[0];
-                                       types->material =  setAnimType(&(efc->getShininess()),(types->material), MATERIAL_SHININESS);
-                                       types->material =  setAnimType(&(efc->getSpecular().getColor()),(types->material), MATERIAL_SPEC_COLOR);
-                                       types->material =  setAnimType(&(efc->getDiffuse().getColor()),(types->material), MATERIAL_DIFF_COLOR);
-                                       // types->material =  setAnimType(&(efc->get()),(types->material), MATERIAL_TRANSPARENCY);
-                                       types->material =  setAnimType(&(efc->getIndexOfRefraction()),(types->material), MATERIAL_IOR);
+                                       types->material =  setAnimType(&(efc->getShininess()), (types->material), MATERIAL_SHININESS);
+                                       types->material =  setAnimType(&(efc->getSpecular().getColor()), (types->material), MATERIAL_SPEC_COLOR);
+                                       types->material =  setAnimType(&(efc->getDiffuse().getColor()), (types->material), MATERIAL_DIFF_COLOR);
+                                       // types->material =  setAnimType(&(efc->get()), (types->material), MATERIAL_TRANSPARENCY);
+                                       types->material =  setAnimType(&(efc->getIndexOfRefraction()), (types->material), MATERIAL_IOR);
                                }
                        }
                }
@@ -1067,7 +1202,7 @@ AnimationImporter::AnimMix* AnimationImporter::get_animation_type ( const COLLAD
        return types;
 }
 
-int AnimationImporter::setAnimType ( const COLLADAFW::Animatable * prop , int types, int addition)
+int AnimationImporter::setAnimType ( const COLLADAFW::Animatable * prop, int types, int addition)
 {
        const COLLADAFW::UniqueId& listid =  prop->getAnimationList();
        if (animlist_map.find(listid) != animlist_map.end())
@@ -1076,7 +1211,7 @@ int AnimationImporter::setAnimType ( const COLLADAFW::Animatable * prop , int ty
 }              
 
 // Is not used anymore.
-void AnimationImporter::find_frames_old(std::vector<float> * frames, COLLADAFW::Node * node , COLLADAFW::Transformation::TransformationType tm_type)
+void AnimationImporter::find_frames_old(std::vector<float> * frames, COLLADAFW::Node * node, COLLADAFW::Transformation::TransformationType tm_type)
 {
        bool is_matrix = tm_type == COLLADAFW::Transformation::MATRIX;
        bool is_rotation = tm_type == COLLADAFW::Transformation::ROTATE;
@@ -1161,7 +1296,7 @@ Object *AnimationImporter::translate_animation_OLD(COLLADAFW::Node *node,
        // frames at which to sample
        std::vector<float> frames;
        
-       find_frames_old(&frames, node , tm_type);
+       find_frames_old(&frames, node, tm_type);
        
        unsigned int i;
        
@@ -1276,9 +1411,9 @@ Object *AnimationImporter::translate_animation_OLD(COLLADAFW::Node *node,
 
                        // calc M
                        calc_joint_parent_mat_rest(par, NULL, root, node);
-                       mul_m4_m4m4(temp, matfra, par);
+                       mult_m4_m4m4(temp, par, matfra);
 
-                       // evaluate_joint_world_transform_at_frame(temp, NULL, , node, fra);
+                       // evaluate_joint_world_transform_at_frame(temp, NULL,, node, fra);
 
                        // calc special matrix
                        mul_serie_m4(mat, irest, temp, irest_dae, rest, NULL, NULL, NULL, NULL);
@@ -1406,12 +1541,10 @@ void AnimationImporter::evaluate_transform_at_frame(float mat[4][4], COLLADAFW::
                float m[4][4];
 
                unit_m4(m);
-               if ( type != COLLADAFW::Transformation::MATRIX )
-                       continue;
 
                std::string nodename = node->getName().size() ? node->getName() : node->getOriginalId();
                if (!evaluate_animation(tm, m, fra, nodename.c_str())) {
-                       /*switch (type) {
+                       switch (type) {
                        case COLLADAFW::Transformation::ROTATE:
                                dae_rotate_to_mat4(tm, m);
                                break;
@@ -1426,15 +1559,15 @@ void AnimationImporter::evaluate_transform_at_frame(float mat[4][4], COLLADAFW::
                                break;
                        default:
                                fprintf(stderr, "unsupported transformation type %d\n", type);
-                       }*/
-                       dae_matrix_to_mat4(tm, m);
+                       }
+                       // dae_matrix_to_mat4(tm, m);
                        
                }
 
                float temp[4][4];
                copy_m4_m4(temp, mat);
 
-               mul_m4_m4m4(mat, m, temp);
+               mult_m4_m4m4(mat, temp, m);
        }
 }
 
@@ -1510,7 +1643,8 @@ bool AnimationImporter::evaluate_animation(COLLADAFW::Transformation *tm, float
                                }
 
                                COLLADABU::Math::Vector3& axis = ((COLLADAFW::Rotate*)tm)->getRotationAxis();
-                               float ax[3] = {axis[0], axis[1], axis[2]};
+
+                               float ax[3] = {(float)axis[0], (float)axis[1], (float)axis[2]};
                                float angle = evaluate_fcurve(curves[0], fra);
                                axis_angle_to_mat4(mat, ax, angle);
 
@@ -1597,7 +1731,7 @@ void AnimationImporter::get_joint_rest_mat(float mat[4][4], COLLADAFW::Node *roo
 
                calc_joint_parent_mat_rest(par, NULL, root, node);
                get_node_mat(m, node, NULL, NULL);
-               mul_m4_m4m4(mat, m, par);
+               mult_m4_m4m4(mat, par, m);
        }
 }
 
@@ -1616,7 +1750,7 @@ bool AnimationImporter::calc_joint_parent_mat_rest(float mat[4][4], float par[4]
                if (par) {
                        float temp[4][4];
                        get_node_mat(temp, node, NULL, NULL);
-                       mul_m4_m4m4(m, temp, par);
+                       mult_m4_m4m4(m, par, temp);
                }
                else {
                        get_node_mat(m, node, NULL, NULL);
@@ -1636,9 +1770,7 @@ bool AnimationImporter::calc_joint_parent_mat_rest(float mat[4][4], float par[4]
 Object *AnimationImporter::get_joint_object(COLLADAFW::Node *root, COLLADAFW::Node *node, Object *par_job)
 {
        if (joint_objects.find(node->getUniqueId()) == joint_objects.end()) {
-               Object *job = add_object(scene, OB_EMPTY);
-
-               rename_id((ID*)&job->id, (char*)get_joint_name(node));
+               Object *job = bc_add_object(scene, OB_EMPTY, (char*)get_joint_name(node));
 
                job->lay = object_in_scene(job, scene)->lay = 2;
 
@@ -1656,7 +1788,7 @@ Object *AnimationImporter::get_joint_object(COLLADAFW::Node *root, COLLADAFW::No
                        float temp[4][4], ipar[4][4];
                        invert_m4_m4(ipar, par_job->obmat);
                        copy_m4_m4(temp, mat);
-                       mul_m4_m4m4(mat, temp, ipar);
+                       mult_m4_m4m4(mat, ipar, temp);
                }
 
                TransformBase::decompose(mat, job->loc, NULL, job->quat, job->size);
@@ -1668,7 +1800,7 @@ Object *AnimationImporter::get_joint_object(COLLADAFW::Node *root, COLLADAFW::No
                        job->parsubstr[0] = 0;
                }
 
-               where_is_object(scene, job);
+               BKE_object_where_is_calc(scene, job);
 
                // after parenting and layer change
                DAG_scene_sort(CTX_data_main(C), scene);
@@ -1689,7 +1821,7 @@ bool AnimationImporter::evaluate_joint_world_transform_at_frame(float mat[4][4],
        if (par) {
                float temp[4][4];
                evaluate_transform_at_frame(temp, node, node == end ? fra : 0.0f);
-               mul_m4_m4m4(m, temp, par);
+               mult_m4_m4m4(m, par, temp);
        }
        else {
                evaluate_transform_at_frame(m, node, node == end ? fra : 0.0f);
@@ -1740,7 +1872,7 @@ void AnimationImporter::add_bezt(FCurve *fcu, float fra, float value)
        //float fps = (float)FPS;
        BezTriple bez;
        memset(&bez, 0, sizeof(BezTriple));
-       bez.vec[1][0] = fra ;
+       bez.vec[1][0] = fra;
        bez.vec[1][1] = value;
        bez.ipo = BEZT_IPO_LIN ;/* use default interpolation mode here... */
        bez.f1 = bez.f2 = bez.f3 = SELECT;