Kent Mein
0fbadc8eb7
added the following 3 lines to everything in the intern dir: #ifdef HAVE_CONFIG_H #include <config.h> #endif Kent -- mein@cs.umn.edu
143 lines
4.1 KiB
C++
143 lines
4.1 KiB
C++
/**
|
|
* $Id$
|
|
* ***** BEGIN GPL/BL DUAL LICENSE BLOCK *****
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version. The Blender
|
|
* Foundation also sells licenses for use in proprietary software under
|
|
* the Blender License. See http://www.blender.org/BL/ for information
|
|
* about this.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software Foundation,
|
|
* Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
*
|
|
* The Original Code is Copyright (C) 2001-2002 by NaN Holding BV.
|
|
* All rights reserved.
|
|
*
|
|
* The Original Code is: all of this file.
|
|
*
|
|
* Contributor(s): none yet.
|
|
*
|
|
* ***** END GPL/BL DUAL LICENSE BLOCK *****
|
|
*/
|
|
|
|
/*
|
|
|
|
MOTTO - 3D Motion Toolkit
|
|
Copyright (C) 2000 Gino van den Bergen <gino@acm.org>
|
|
|
|
This library is free software; you can redistribute it and/or
|
|
modify it under the terms of the GNU Library General Public
|
|
License as published by the Free Software Foundation; either
|
|
version 2 of the License, or (at your option) any later version.
|
|
|
|
This library is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Library General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Library General Public
|
|
License along with this library; if not, write to the Free
|
|
Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include <config.h>
|
|
#endif
|
|
|
|
#include "MT_Transform.h"
|
|
|
|
void MT_Transform::setValue(const float *m) {
|
|
m_basis.setValue(m);
|
|
m_origin.setValue(&m[12]);
|
|
m_type = AFFINE;
|
|
}
|
|
|
|
void MT_Transform::setValue(const double *m) {
|
|
m_basis.setValue(m);
|
|
m_origin.setValue(&m[12]);
|
|
m_type = AFFINE;
|
|
}
|
|
|
|
void MT_Transform::getValue(float *m) const {
|
|
m_basis.getValue(m);
|
|
m_origin.getValue(&m[12]);
|
|
m[15] = 1.0;
|
|
}
|
|
|
|
void MT_Transform::getValue(double *m) const {
|
|
m_basis.getValue(m);
|
|
m_origin.getValue(&m[12]);
|
|
m[15] = 1.0;
|
|
}
|
|
|
|
MT_Transform& MT_Transform::operator*=(const MT_Transform& t) {
|
|
m_origin += m_basis * t.m_origin;
|
|
m_basis *= t.m_basis;
|
|
m_type |= t.m_type;
|
|
return *this;
|
|
}
|
|
|
|
void MT_Transform::translate(const MT_Vector3& v) {
|
|
m_origin += m_basis * v;
|
|
m_type |= TRANSLATION;
|
|
}
|
|
|
|
void MT_Transform::rotate(const MT_Quaternion& q) {
|
|
m_basis *= MT_Matrix3x3(q);
|
|
m_type |= ROTATION;
|
|
}
|
|
|
|
void MT_Transform::scale(MT_Scalar x, MT_Scalar y, MT_Scalar z) {
|
|
m_basis.scale(x, y, z);
|
|
m_type |= SCALING;
|
|
}
|
|
|
|
void MT_Transform::setIdentity() {
|
|
m_basis.setIdentity();
|
|
m_origin.setValue(MT_Scalar(0.0), MT_Scalar(0.0), MT_Scalar(0.0));
|
|
m_type = IDENTITY;
|
|
}
|
|
|
|
void MT_Transform::invert(const MT_Transform& t) {
|
|
m_basis = t.m_type & SCALING ?
|
|
t.m_basis.inverse() :
|
|
t.m_basis.transposed();
|
|
m_origin.setValue(-MT_dot(m_basis[0], t.m_origin),
|
|
-MT_dot(m_basis[1], t.m_origin),
|
|
-MT_dot(m_basis[2], t.m_origin));
|
|
m_type = t.m_type;
|
|
}
|
|
|
|
void MT_Transform::mult(const MT_Transform& t1, const MT_Transform& t2) {
|
|
m_basis = t1.m_basis * t2.m_basis;
|
|
m_origin = t1(t2.m_origin);
|
|
m_type = t1.m_type | t2.m_type;
|
|
}
|
|
|
|
void MT_Transform::multInverseLeft(const MT_Transform& t1, const MT_Transform& t2) {
|
|
MT_Vector3 v = t2.m_origin - t1.m_origin;
|
|
if (t1.m_type & SCALING) {
|
|
MT_Matrix3x3 inv = t1.m_basis.inverse();
|
|
m_basis = inv * t2.m_basis;
|
|
m_origin = inv * v;
|
|
}
|
|
else {
|
|
m_basis = MT_multTransposeLeft(t1.m_basis, t2.m_basis);
|
|
m_origin = v * t1.m_basis;
|
|
}
|
|
m_type = t1.m_type | t2.m_type;
|
|
}
|
|
|
|
|
|
|