Math Lib: rename mul_serie_m3 to mul_m3_series & reorder args
[blender-staging.git] / source / blender / collada / TransformWriter.cpp
1 /*
2  * ***** BEGIN GPL LICENSE BLOCK *****
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU General Public License
6  * as published by the Free Software Foundation; either version 2
7  * of the License, or (at your option) any later version.
8  *
9  * This program is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  * GNU General Public License for more details.
13  *
14  * You should have received a copy of the GNU General Public License
15  * along with this program; if not, write to the Free Software Foundation,
16  * Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
17  *
18  * Contributor(s): Chingiz Dyussenov, Arystanbek Dyussenov, Jan Diederich, Tod Liverseed,
19  *                 Nathan Letwory
20  *
21  * ***** END GPL LICENSE BLOCK *****
22  */
23
24 /** \file blender/collada/TransformWriter.cpp
25  *  \ingroup collada
26  */
27
28
29 #include "BKE_object.h"
30
31 #include "TransformWriter.h"
32
33 #include "BLI_math.h"
34
35 void TransformWriter::add_node_transform(COLLADASW::Node& node, float mat[4][4], float parent_mat[4][4])
36 {
37         float loc[3], rot[3], scale[3];
38         float local[4][4];
39
40         if (parent_mat) {
41                 float invpar[4][4];
42                 invert_m4_m4(invpar, parent_mat);
43                 mul_m4_m4m4(local, invpar, mat);
44         }
45         else {
46                 copy_m4_m4(local, mat);
47         }
48
49         double dmat[4][4];
50         UnitConverter *converter = new UnitConverter();
51         converter->mat4_to_dae_double(dmat, local);
52
53         TransformBase::decompose(local, loc, rot, NULL, scale);
54
55         if (node.getType() == COLLADASW::Node::JOINT) {
56                 // XXX Why are joints handled differently ?
57                 node.addMatrix("transform", dmat);
58         }
59         else {
60                 add_transform(node, loc, rot, scale);
61         }
62 }
63
64 void TransformWriter::add_node_transform_ob(COLLADASW::Node& node, Object *ob, BC_export_transformation_type transformation_type)
65 {
66 #if 0
67         float rot[3], loc[3], scale[3];
68
69         if (ob->parent) {
70                 float C[4][4], tmat[4][4], imat[4][4], mat[4][4];
71
72                 // factor out scale from obmat
73
74                 copy_v3_v3(scale, ob->size);
75
76                 ob->size[0] = ob->size[1] = ob->size[2] = 1.0f;
77                 BKE_object_to_mat4(ob, C);
78                 copy_v3_v3(ob->size, scale);
79
80                 mul_m4_series(tmat, ob->parent->obmat, ob->parentinv, C);
81
82                 // calculate local mat
83
84                 invert_m4_m4(imat, ob->parent->obmat);
85                 mul_m4_m4m4(mat, imat, tmat);
86
87                 // done
88
89                 mat4_to_eul(rot, mat);
90                 copy_v3_v3(loc, mat[3]);
91         }
92         else {
93                 copy_v3_v3(loc, ob->loc);
94                 copy_v3_v3(rot, ob->rot);
95                 copy_v3_v3(scale, ob->size);
96         }
97
98         add_transform(node, loc, rot, scale);
99 #endif
100
101         UnitConverter converter;
102         double d_obmat[4][4];
103         float  f_obmat[4][4];
104
105         /* Export the local Matrix (relative to the object parent) */
106         BKE_object_matrix_local_get(ob, f_obmat);
107         converter.mat4_to_dae_double(d_obmat, f_obmat);
108
109         switch (transformation_type) {
110                 case BC_TRANSFORMATION_TYPE_MATRIX:
111                 {
112                         node.addMatrix("transform",d_obmat);
113                         break;
114                 }
115                 case BC_TRANSFORMATION_TYPE_BOTH:
116                 {
117                         node.addMatrix("transform",d_obmat);
118                         /* fall-through */
119                 }
120                 case BC_TRANSFORMATION_TYPE_TRANSROTLOC:
121                 {
122                         float loc[3], rot[3], scale[3];
123                         TransformBase::decompose(f_obmat, loc, rot, NULL, scale);
124                         add_transform(node, loc, rot, scale); 
125                         break;
126                 }
127         }
128
129 }
130
131 void TransformWriter::add_node_transform_identity(COLLADASW::Node& node)
132 {
133         float loc[3] = {0.0f, 0.0f, 0.0f}, scale[3] = {1.0f, 1.0f, 1.0f}, rot[3] = {0.0f, 0.0f, 0.0f};
134         add_transform(node, loc, rot, scale);
135 }
136
137 void TransformWriter::add_transform(COLLADASW::Node& node, float loc[3], float rot[3], float scale[3])
138 {
139 #if 0
140         node.addRotateZ("rotationZ", COLLADABU::Math::Utils::radToDegF(rot[2]));
141         node.addRotateY("rotationY", COLLADABU::Math::Utils::radToDegF(rot[1]));
142         node.addRotateX("rotationX", COLLADABU::Math::Utils::radToDegF(rot[0]));
143 #endif
144         node.addTranslate("location", loc[0], loc[1], loc[2]);
145         node.addRotateZ("rotationZ", RAD2DEGF(rot[2]));
146         node.addRotateY("rotationY", RAD2DEGF(rot[1]));
147         node.addRotateX("rotationX", RAD2DEGF(rot[0]));
148         node.addScale("scale", scale[0], scale[1], scale[2]);
149
150 }