use macros RAD2DEG & DEG2RAD rather then multiplying by 180.0/M_PI or M_PI/180.0
[blender.git] / source / blender / collada / TransformReader.cpp
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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
19  *
20  * Contributor(s): Chingiz Dyussenov, Arystanbek Dyussenov, Nathan Letwory.
21  *
22  * ***** END GPL LICENSE BLOCK *****
23  */
24
25 /** \file blender/collada/TransformReader.cpp
26  *  \ingroup collada
27  */
28
29 /* COLLADABU_ASSERT, may be able to remove later */
30 #include "COLLADABUPlatform.h"
31
32 #include "TransformReader.h"
33
34 TransformReader::TransformReader(UnitConverter* conv) : unit_converter(conv) {}
35
36 void TransformReader::get_node_mat(float mat[][4], COLLADAFW::Node *node, std::map<COLLADAFW::UniqueId, Animation> *animation_map, Object *ob)
37 {
38         float cur[4][4];
39         float copy[4][4];
40
41         unit_m4(mat);
42         
43         for (unsigned int i = 0; i < node->getTransformations().getCount(); i++) {
44
45                 COLLADAFW::Transformation *tm = node->getTransformations()[i];
46                 COLLADAFW::Transformation::TransformationType type = tm->getTransformationType();
47
48                         switch(type) {
49                         case COLLADAFW::Transformation::TRANSLATE:
50                                 dae_translate_to_mat4(tm, cur);
51                                 break;
52                         case COLLADAFW::Transformation::ROTATE:
53                                 dae_rotate_to_mat4(tm, cur);
54                                 break;
55                         case COLLADAFW::Transformation::SCALE:
56                                 dae_scale_to_mat4(tm, cur);
57                                 break;
58                         case COLLADAFW::Transformation::MATRIX:
59                                 dae_matrix_to_mat4(tm, cur);
60                                 break;
61                         case COLLADAFW::Transformation::LOOKAT:
62                         case COLLADAFW::Transformation::SKEW:
63                                 fprintf(stderr, "LOOKAT and SKEW transformations are not supported yet.\n");
64                                 break;
65                         }
66
67                 copy_m4_m4(copy, mat);
68                 mul_m4_m4m4(mat, cur, copy);
69
70                 if (animation_map) {
71                         // AnimationList that drives this Transformation
72                         const COLLADAFW::UniqueId& anim_list_id = tm->getAnimationList();
73                 
74                         // store this so later we can link animation data with ob
75                         Animation anim = {ob, node, tm};
76                         (*animation_map)[anim_list_id] = anim;
77                 }
78         }
79 }
80
81 void TransformReader::dae_rotate_to_mat4(COLLADAFW::Transformation *tm, float m[][4])
82 {
83         COLLADAFW::Rotate *ro = (COLLADAFW::Rotate*)tm;
84         COLLADABU::Math::Vector3& axis = ro->getRotationAxis();
85         const float angle = (float)DEG2RAD(ro->getRotationAngle());
86         const float ax[] = {axis[0], axis[1], axis[2]};
87         // float quat[4];
88         // axis_angle_to_quat(quat, axis, angle);
89         // quat_to_mat4(m, quat);
90         axis_angle_to_mat4(m, ax, angle);
91 }
92
93 void TransformReader::dae_translate_to_mat4(COLLADAFW::Transformation *tm, float m[][4])
94 {
95         COLLADAFW::Translate *tra = (COLLADAFW::Translate*)tm;
96         COLLADABU::Math::Vector3& t = tra->getTranslation();
97
98         unit_m4(m);
99
100         m[3][0] = (float)t[0];
101         m[3][1] = (float)t[1];
102         m[3][2] = (float)t[2];
103 }
104
105 void TransformReader::dae_scale_to_mat4(COLLADAFW::Transformation *tm, float m[][4])
106 {
107         COLLADABU::Math::Vector3& s = ((COLLADAFW::Scale*)tm)->getScale();
108         float size[3] = {(float)s[0], (float)s[1], (float)s[2]};
109         size_to_mat4(m, size);
110 }
111
112 void TransformReader::dae_matrix_to_mat4(COLLADAFW::Transformation *tm, float m[][4])
113 {
114         unit_converter->dae_matrix_to_mat4_(m, ((COLLADAFW::Matrix*)tm)->getMatrix());
115 }
116
117 void TransformReader::dae_translate_to_v3(COLLADAFW::Transformation *tm, float v[3])
118 {
119         dae_vector3_to_v3(((COLLADAFW::Translate*)tm)->getTranslation(), v);
120 }
121
122 void TransformReader::dae_scale_to_v3(COLLADAFW::Transformation *tm, float v[3])
123 {
124         dae_vector3_to_v3(((COLLADAFW::Scale*)tm)->getScale(), v);
125 }
126
127 void TransformReader::dae_vector3_to_v3(const COLLADABU::Math::Vector3 &v3, float v[3])
128 {
129         v[0] = v3.x;
130         v[1] = v3.y;
131         v[2] = v3.z;
132 }