svn merge https://svn.blender.org/svnroot/bf-blender/trunk/blender -r20855:20928
[blender.git] / intern / moto / intern / MT_Transform.cpp
1 /**
2  * $Id$
3  * ***** BEGIN GPL LICENSE BLOCK *****
4  *
5  * This program is free software; you can redistribute it and/or
6  * modify it under the terms of the GNU General Public License
7  * as published by the Free Software Foundation; either version 2
8  * of the License, or (at your option) any later version.
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  * GNU General Public License for more details.
14  *
15  * You should have received a copy of the GNU General Public License
16  * along with this program; if not, write to the Free Software Foundation,
17  * Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
18  *
19  * The Original Code is Copyright (C) 2001-2002 by NaN Holding BV.
20  * All rights reserved.
21  *
22  * The Original Code is: all of this file.
23  *
24  * Contributor(s): none yet.
25  *
26  * ***** END GPL LICENSE BLOCK *****
27  */
28
29 /*
30
31   MOTTO - 3D Motion Toolkit 
32   Copyright (C) 2000  Gino van den Bergen <gino@acm.org>
33
34   This library is free software; you can redistribute it and/or
35   modify it under the terms of the GNU Library General Public
36   License as published by the Free Software Foundation; either
37   version 2 of the License, or (at your option) any later version.
38
39   This library is distributed in the hope that it will be useful,
40   but WITHOUT ANY WARRANTY; without even the implied warranty of
41   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
42   Library General Public License for more details.
43
44   You should have received a copy of the GNU Library General Public
45   License along with this library; if not, write to the Free
46   Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
47
48 */
49
50 #ifdef HAVE_CONFIG_H
51 #include <config.h>
52 #endif
53
54 #include "MT_Transform.h"
55
56 void MT_Transform::setValue(const float *m) {
57     m_basis.setValue(m);
58     m_origin.setValue(&m[12]);
59     m_type = AFFINE;
60 }
61
62 void MT_Transform::setValue(const double *m) {
63     m_basis.setValue(m);
64     m_origin.setValue(&m[12]);
65     m_type = AFFINE;
66 }
67
68 void MT_Transform::getValue(float *m) const {
69     m_basis.getValue(m);
70     m_origin.getValue(&m[12]);
71     m[15] = 1.0;
72 }
73
74 void MT_Transform::getValue(double *m) const {
75     m_basis.getValue(m);
76     m_origin.getValue(&m[12]);
77     m[15] = 1.0;
78 }
79
80 MT_Transform& MT_Transform::operator*=(const MT_Transform& t) {
81     m_origin += m_basis * t.m_origin;
82     m_basis *= t.m_basis;
83     m_type |= t.m_type; 
84     return *this;
85 }
86
87 void MT_Transform::translate(const MT_Vector3& v) { 
88     m_origin += m_basis * v; 
89     m_type |= TRANSLATION;
90 }
91
92 void MT_Transform::rotate(const MT_Quaternion& q) { 
93     m_basis *= MT_Matrix3x3(q); 
94     m_type |= ROTATION; 
95 }
96
97 void MT_Transform::scale(MT_Scalar x, MT_Scalar y, MT_Scalar z) { 
98     m_basis.scale(x, y, z);  
99     m_type |= SCALING;
100 }
101
102 void MT_Transform::setIdentity() {
103     m_basis.setIdentity();
104     m_origin.setValue(MT_Scalar(0.0), MT_Scalar(0.0), MT_Scalar(0.0));
105     m_type = IDENTITY;
106 }
107
108 void MT_Transform::invert(const MT_Transform& t) {
109     m_basis = t.m_type & SCALING ? 
110                 t.m_basis.inverse() : 
111                 t.m_basis.transposed();
112     m_origin.setValue(-MT_dot(m_basis[0], t.m_origin), 
113                       -MT_dot(m_basis[1], t.m_origin), 
114                       -MT_dot(m_basis[2], t.m_origin));  
115     m_type = t.m_type;
116 }
117
118 void MT_Transform::mult(const MT_Transform& t1, const MT_Transform& t2) {
119     m_basis = t1.m_basis * t2.m_basis;
120     m_origin = t1(t2.m_origin);
121     m_type = t1.m_type | t2.m_type;
122 }
123
124 void MT_Transform::multInverseLeft(const MT_Transform& t1, const MT_Transform& t2) {
125     MT_Vector3 v = t2.m_origin - t1.m_origin;
126     if (t1.m_type & SCALING) {
127         MT_Matrix3x3 inv = t1.m_basis.inverse();
128         m_basis = inv * t2.m_basis;
129         m_origin = inv * v;
130     }
131     else {
132         m_basis = MT_multTransposeLeft(t1.m_basis, t2.m_basis);
133         m_origin = v * t1.m_basis;
134     }
135     m_type = t1.m_type | t2.m_type;
136 }
137
138
139