338 lines
12 KiB
Plaintext
338 lines
12 KiB
Plaintext
// Filename: compose_matrix_src.I
|
|
// Created by: drose (21Feb99)
|
|
//
|
|
////////////////////////////////////////////////////////////////////
|
|
//
|
|
// PANDA 3D SOFTWARE
|
|
// Copyright (c) 2001 - 2004, Disney Enterprises, Inc. All rights reserved
|
|
//
|
|
// All use of this software is subject to the terms of the Panda 3d
|
|
// Software license. You should have received a copy of this license
|
|
// along with this source code; you will also find a current copy of
|
|
// the license at http://etc.cmu.edu/panda3d/docs/license/ .
|
|
//
|
|
// To contact the maintainers of this program write to
|
|
// panda3d-general@lists.sourceforge.net .
|
|
//
|
|
////////////////////////////////////////////////////////////////////
|
|
|
|
|
|
////////////////////////////////////////////////////////////////////
|
|
// Function: compose_matrix
|
|
// Description: Computes the 3x3 matrix from scale, shear, and
|
|
// rotation.
|
|
////////////////////////////////////////////////////////////////////
|
|
INLINE_LINMATH void
|
|
compose_matrix(FLOATNAME(LMatrix3) &mat,
|
|
const FLOATNAME(LVecBase3) &scale,
|
|
const FLOATNAME(LVecBase3) &shear,
|
|
const FLOATNAME(LVecBase3) &hpr,
|
|
CoordinateSystem cs) {
|
|
if (temp_hpr_fix) {
|
|
compose_matrix_new_hpr(mat, scale, shear, hpr, cs);
|
|
} else {
|
|
compose_matrix_old_hpr(mat, scale, shear, hpr, cs);
|
|
}
|
|
}
|
|
|
|
////////////////////////////////////////////////////////////////////
|
|
// Function: compose_matrix
|
|
// Description: Computes the 4x4 matrix according to scale, shear,
|
|
// rotation, and translation.
|
|
////////////////////////////////////////////////////////////////////
|
|
INLINE_LINMATH void
|
|
compose_matrix(FLOATNAME(LMatrix4) &mat,
|
|
const FLOATNAME(LVecBase3) &scale,
|
|
const FLOATNAME(LVecBase3) &shear,
|
|
const FLOATNAME(LVecBase3) &hpr,
|
|
const FLOATNAME(LVecBase3) &translate,
|
|
CoordinateSystem cs) {
|
|
if (temp_hpr_fix) {
|
|
compose_matrix_new_hpr(mat, scale, shear, hpr, translate, cs);
|
|
} else {
|
|
compose_matrix_old_hpr(mat, scale, shear, hpr, translate, cs);
|
|
}
|
|
}
|
|
|
|
////////////////////////////////////////////////////////////////////
|
|
// Function: compose_matrix
|
|
// Description: Computes the 4x4 matrix according to scale, shear,
|
|
// rotation, and translation.
|
|
////////////////////////////////////////////////////////////////////
|
|
INLINE_LINMATH void
|
|
compose_matrix(FLOATNAME(LMatrix4) &mat,
|
|
const FLOATTYPE components[num_matrix_components],
|
|
CoordinateSystem cs) {
|
|
if (temp_hpr_fix) {
|
|
compose_matrix_new_hpr(mat, components, cs);
|
|
} else {
|
|
compose_matrix_old_hpr(mat, components, cs);
|
|
}
|
|
}
|
|
|
|
////////////////////////////////////////////////////////////////////
|
|
// Function: decompose_matrix
|
|
// Description: Extracts out the components of a 3x3 rotation matrix.
|
|
// Returns true if successful, or false if there was an
|
|
// error. Since a 3x3 matrix always contains an affine
|
|
// transform, this should succeed in the normal case;
|
|
// singular transforms are not treated as an error.
|
|
////////////////////////////////////////////////////////////////////
|
|
INLINE_LINMATH bool
|
|
decompose_matrix(const FLOATNAME(LMatrix3) &mat,
|
|
FLOATNAME(LVecBase3) &scale,
|
|
FLOATNAME(LVecBase3) &shear,
|
|
FLOATNAME(LVecBase3) &hpr,
|
|
CoordinateSystem cs) {
|
|
if (temp_hpr_fix) {
|
|
return decompose_matrix_new_hpr(mat, scale, shear, hpr, cs);
|
|
} else {
|
|
return decompose_matrix_old_hpr(mat, scale, shear, hpr, cs);
|
|
}
|
|
}
|
|
|
|
////////////////////////////////////////////////////////////////////
|
|
// Function: decompose_matrix
|
|
// Description: Extracts out the components of an affine matrix.
|
|
// Returns true if the scale, shear, hpr, and translate
|
|
// completely describe the matrix, or false if the
|
|
// matrix is not affine.
|
|
////////////////////////////////////////////////////////////////////
|
|
INLINE_LINMATH bool
|
|
decompose_matrix(const FLOATNAME(LMatrix4) &mat,
|
|
FLOATNAME(LVecBase3) &scale,
|
|
FLOATNAME(LVecBase3) &shear,
|
|
FLOATNAME(LVecBase3) &hpr,
|
|
FLOATNAME(LVecBase3) &translate,
|
|
CoordinateSystem cs) {
|
|
if (temp_hpr_fix) {
|
|
return decompose_matrix_new_hpr(mat, scale, shear, hpr, translate, cs);
|
|
} else {
|
|
return decompose_matrix_old_hpr(mat, scale, shear, hpr, translate, cs);
|
|
}
|
|
}
|
|
|
|
////////////////////////////////////////////////////////////////////
|
|
// Function: decompose_matrix
|
|
// Description: Extracts out the components of an affine matrix.
|
|
// Returns true if the scale, shear, hpr, and translate
|
|
// completely describe the matrix, or false if the
|
|
// matrix is not affine.
|
|
////////////////////////////////////////////////////////////////////
|
|
INLINE_LINMATH bool
|
|
decompose_matrix(const FLOATNAME(LMatrix4) &mat,
|
|
FLOATTYPE components[num_matrix_components],
|
|
CoordinateSystem cs) {
|
|
if (temp_hpr_fix) {
|
|
return decompose_matrix_new_hpr(mat, components, cs);
|
|
} else {
|
|
return decompose_matrix_old_hpr(mat, components, cs);
|
|
}
|
|
}
|
|
|
|
// The following functions are deprecated; they have been replaced
|
|
// with new versions, above, that accept a shear component as well.
|
|
|
|
|
|
// Deprecated function.
|
|
INLINE_LINMATH void
|
|
compose_matrix(FLOATNAME(LMatrix3) &mat,
|
|
const FLOATNAME(LVecBase3) &scale,
|
|
const FLOATNAME(LVecBase3) &hpr,
|
|
CoordinateSystem cs) {
|
|
compose_matrix(mat, scale, FLOATNAME(LVecBase3)(0, 0, 0), hpr, cs);
|
|
}
|
|
|
|
// Deprecated function.
|
|
INLINE_LINMATH void
|
|
compose_matrix(FLOATNAME(LMatrix4) &mat,
|
|
const FLOATNAME(LVecBase3) &scale,
|
|
const FLOATNAME(LVecBase3) &hpr,
|
|
const FLOATNAME(LVecBase3) &translate,
|
|
CoordinateSystem cs) {
|
|
FLOATNAME(LMatrix3) upper3;
|
|
compose_matrix(upper3, scale, hpr, cs);
|
|
mat = FLOATNAME(LMatrix4)(upper3, translate);
|
|
}
|
|
|
|
// Deprecated function.
|
|
INLINE_LINMATH bool
|
|
decompose_matrix(const FLOATNAME(LMatrix3) &mat,
|
|
FLOATNAME(LVecBase3) &scale,
|
|
FLOATNAME(LVecBase3) &hpr,
|
|
CoordinateSystem cs) {
|
|
FLOATNAME(LVecBase3) shear;
|
|
if (!decompose_matrix(mat, scale, shear, hpr, cs)) {
|
|
return false;
|
|
}
|
|
return shear.almost_equal(FLOATNAME(LVecBase3)::zero());
|
|
}
|
|
|
|
// Deprecated function.
|
|
INLINE_LINMATH bool
|
|
decompose_matrix(const FLOATNAME(LMatrix4) &mat,
|
|
FLOATNAME(LVecBase3) &scale,
|
|
FLOATNAME(LVecBase3) &hpr,
|
|
FLOATNAME(LVecBase3) &translate,
|
|
CoordinateSystem cs) {
|
|
// Get the translation first.
|
|
mat.get_row3(translate,3);
|
|
return decompose_matrix(mat.get_upper_3(), scale, hpr, cs);
|
|
}
|
|
|
|
|
|
// The following functions are transitional and serve only to migrate
|
|
// code from the old, incorrect hpr calculations that Panda used to
|
|
// use. New code should not call these functions directly; use the
|
|
// unqualified functions, above, instead.
|
|
|
|
// Transitional function.
|
|
INLINE_LINMATH void
|
|
compose_matrix_old_hpr(FLOATNAME(LMatrix4) &mat,
|
|
const FLOATNAME(LVecBase3) &scale,
|
|
const FLOATNAME(LVecBase3) &shear,
|
|
const FLOATNAME(LVecBase3) &hpr,
|
|
const FLOATNAME(LVecBase3) &translate,
|
|
CoordinateSystem cs) {
|
|
FLOATNAME(LMatrix3) upper3;
|
|
compose_matrix_old_hpr(upper3, scale, shear, hpr, cs);
|
|
mat = FLOATNAME(LMatrix4)(upper3, translate);
|
|
}
|
|
|
|
// Transitional function.
|
|
INLINE_LINMATH void
|
|
compose_matrix_old_hpr(FLOATNAME(LMatrix4) &mat,
|
|
const FLOATTYPE components[num_matrix_components],
|
|
CoordinateSystem cs) {
|
|
FLOATNAME(LVector3) scale(components[0],
|
|
components[1],
|
|
components[2]);
|
|
FLOATNAME(LVector3) shear(components[3],
|
|
components[4],
|
|
components[5]);
|
|
FLOATNAME(LVector3) hpr(components[6],
|
|
components[7],
|
|
components[8]);
|
|
FLOATNAME(LVector3) translate(components[9],
|
|
components[10],
|
|
components[11]);
|
|
compose_matrix_old_hpr(mat, scale, shear, hpr, translate, cs);
|
|
}
|
|
|
|
// Transitional function.
|
|
INLINE_LINMATH bool
|
|
decompose_matrix_old_hpr(const FLOATNAME(LMatrix4) &mat,
|
|
FLOATNAME(LVecBase3) &scale,
|
|
FLOATNAME(LVecBase3) &shear,
|
|
FLOATNAME(LVecBase3) &hpr,
|
|
FLOATNAME(LVecBase3) &translate,
|
|
CoordinateSystem cs) {
|
|
// Get the translation first.
|
|
mat.get_row3(translate,3);
|
|
if (!decompose_matrix_old_hpr(mat.get_upper_3(), scale, shear, hpr, cs)) {
|
|
return false;
|
|
}
|
|
#ifndef NDEBUG
|
|
return mat.get_col(3).almost_equal(FLOATNAME(LVecBase4)(0.0, 0.0, 0.0, 1.0));
|
|
#else
|
|
return true;
|
|
#endif
|
|
}
|
|
|
|
// Transitional function.
|
|
INLINE_LINMATH bool
|
|
decompose_matrix_old_hpr(const FLOATNAME(LMatrix4) &mat,
|
|
FLOATTYPE components[num_matrix_components],
|
|
CoordinateSystem cs) {
|
|
FLOATNAME(LVector3) scale, shear, hpr, translate;
|
|
bool result = decompose_matrix_old_hpr(mat, scale, shear, hpr, translate, cs);
|
|
components[0] = scale[0];
|
|
components[1] = scale[1];
|
|
components[2] = scale[2];
|
|
components[3] = shear[0];
|
|
components[4] = shear[1];
|
|
components[5] = shear[2];
|
|
components[6] = hpr[0];
|
|
components[7] = hpr[1];
|
|
components[8] = hpr[2];
|
|
components[9] = translate[0];
|
|
components[10] = translate[1];
|
|
components[11] = translate[2];
|
|
return result;
|
|
}
|
|
|
|
// Transitional function.
|
|
INLINE_LINMATH void
|
|
compose_matrix_new_hpr(FLOATNAME(LMatrix4) &mat,
|
|
const FLOATNAME(LVecBase3) &scale,
|
|
const FLOATNAME(LVecBase3) &shear,
|
|
const FLOATNAME(LVecBase3) &hpr,
|
|
const FLOATNAME(LVecBase3) &translate,
|
|
CoordinateSystem cs) {
|
|
FLOATNAME(LMatrix3) upper3;
|
|
compose_matrix_new_hpr(upper3, scale, shear, hpr, cs);
|
|
mat = FLOATNAME(LMatrix4)(upper3, translate);
|
|
}
|
|
|
|
// Transitional function.
|
|
INLINE_LINMATH void
|
|
compose_matrix_new_hpr(FLOATNAME(LMatrix4) &mat,
|
|
const FLOATTYPE components[num_matrix_components],
|
|
CoordinateSystem cs) {
|
|
FLOATNAME(LVector3) scale(components[0],
|
|
components[1],
|
|
components[2]);
|
|
FLOATNAME(LVector3) shear(components[3],
|
|
components[4],
|
|
components[5]);
|
|
FLOATNAME(LVector3) hpr(components[6],
|
|
components[7],
|
|
components[8]);
|
|
FLOATNAME(LVector3) translate(components[9],
|
|
components[10],
|
|
components[11]);
|
|
compose_matrix_new_hpr(mat, scale, shear, hpr, translate, cs);
|
|
}
|
|
|
|
// Transitional function.
|
|
INLINE_LINMATH bool
|
|
decompose_matrix_new_hpr(const FLOATNAME(LMatrix4) &mat,
|
|
FLOATNAME(LVecBase3) &scale,
|
|
FLOATNAME(LVecBase3) &shear,
|
|
FLOATNAME(LVecBase3) &hpr,
|
|
FLOATNAME(LVecBase3) &translate,
|
|
CoordinateSystem cs) {
|
|
// Get the translation first.
|
|
mat.get_row3(translate,3);
|
|
if (!decompose_matrix_new_hpr(mat.get_upper_3(), scale, shear, hpr, cs)) {
|
|
return false;
|
|
}
|
|
#ifndef NDEBUG
|
|
return mat.get_col(3).almost_equal(FLOATNAME(LVecBase4)(0.0, 0.0, 0.0, 1.0));
|
|
#else
|
|
return true;
|
|
#endif
|
|
}
|
|
|
|
// Transitional function.
|
|
INLINE_LINMATH bool
|
|
decompose_matrix_new_hpr(const FLOATNAME(LMatrix4) &mat,
|
|
FLOATTYPE components[num_matrix_components],
|
|
CoordinateSystem cs) {
|
|
FLOATNAME(LVector3) scale, shear, hpr, translate;
|
|
bool result = decompose_matrix_new_hpr(mat, scale, shear, hpr, translate, cs);
|
|
components[0] = scale[0];
|
|
components[1] = scale[1];
|
|
components[2] = scale[2];
|
|
components[3] = shear[0];
|
|
components[4] = shear[1];
|
|
components[5] = shear[2];
|
|
components[6] = hpr[0];
|
|
components[7] = hpr[1];
|
|
components[8] = hpr[2];
|
|
components[9] = translate[0];
|
|
components[10] = translate[1];
|
|
components[11] = translate[2];
|
|
return result;
|
|
}
|