Some whitespace changes
[blender.git] / source / blender / collada / TransformWriter.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, Jan Diederich, Tod Liverseed,
21  *                 Nathan Letwory
22  *
23  * ***** END GPL LICENSE BLOCK *****
24  */
25
26 /** \file blender/collada/TransformWriter.cpp
27  *  \ingroup collada
28  */
29
30
31 #include "BKE_object.h"
32
33 #include "TransformWriter.h"
34
35 #include "BLI_math.h"
36
37 void TransformWriter::add_node_transform(COLLADASW::Node& node, float mat[][4], float parent_mat[][4])
38 {
39         float loc[3], rot[3], scale[3];
40         float local[4][4];
41
42         if (parent_mat) {
43                 float invpar[4][4];
44                 invert_m4_m4(invpar, parent_mat);
45                 mul_m4_m4m4(local, mat, invpar);
46         }
47         else {
48                 copy_m4_m4(local, mat);
49         }
50
51         double dmat[4][4];
52         UnitConverter* converter = new UnitConverter();
53         converter->mat4_to_dae_double(dmat,local);
54
55         TransformBase::decompose(local, loc, rot, NULL, scale);
56         if ( node.getType() == COLLADASW::Node::JOINT)
57                 node.addMatrix("transform",dmat);
58         else
59                 add_transform(node, loc, rot, scale);
60 }
61
62 void TransformWriter::add_node_transform_ob(COLLADASW::Node& node, Object *ob)
63 {
64         float rot[3], loc[3], scale[3];
65
66         if (ob->parent) {
67                 float C[4][4], tmat[4][4], imat[4][4], mat[4][4];
68
69                 // factor out scale from obmat
70
71                 copy_v3_v3(scale, ob->size);
72
73                 ob->size[0] = ob->size[1] = ob->size[2] = 1.0f;
74                 object_to_mat4(ob, C);
75                 copy_v3_v3(ob->size, scale);
76
77                 mul_serie_m4(tmat, ob->parent->obmat, ob->parentinv, C, NULL, NULL, NULL, NULL, NULL);
78
79                 // calculate local mat
80
81                 invert_m4_m4(imat, ob->parent->obmat);
82                 mul_m4_m4m4(mat, tmat, imat);
83
84                 // done
85
86                 mat4_to_eul(rot, mat);
87                 copy_v3_v3(loc, mat[3]);
88         }
89         else {
90                 copy_v3_v3(loc, ob->loc);
91                 copy_v3_v3(rot, ob->rot);
92                 copy_v3_v3(scale, ob->size);
93         }
94
95         add_transform(node, loc, rot, scale);
96 }
97
98 void TransformWriter::add_node_transform_identity(COLLADASW::Node& node)
99 {
100         float loc[] = {0.0f, 0.0f, 0.0f}, scale[] = {1.0f, 1.0f, 1.0f}, rot[] = {0.0f, 0.0f, 0.0f};
101         add_transform(node, loc, rot, scale);
102 }
103
104 void TransformWriter::add_transform(COLLADASW::Node& node, float loc[3], float rot[3], float scale[3])
105 {
106         node.addTranslate("location", loc[0], loc[1], loc[2]);
107         /*node.addRotateZ("rotationZ", COLLADABU::Math::Utils::radToDegF(rot[2]));
108         node.addRotateY("rotationY", COLLADABU::Math::Utils::radToDegF(rot[1]));
109         node.addRotateX("rotationX", COLLADABU::Math::Utils::radToDegF(rot[0]));*/
110         node.addRotateZ("rotationZ", rot[2] * 180.0f/M_PI);
111         node.addRotateY("rotationY", (rot[1]* 180.0f/M_PI));
112         node.addRotateX("rotationX", (rot[0]* 180.0f/M_PI));
113
114         node.addScale("scale", scale[0], scale[1], scale[2]);
115 }