mathutils rotate functions for Euler/Quaternion/Matrix/Vector types.

each accept Euler/Quaternion/Matrix types.

eg:
  Euler.rotate(Quaternion(axis, angle))
  Vector.rotate(Euler((pi/2, 0, 0)))

matrix.resize_4x4() and euler.make_compatible() were still returning an instance of themselves, now return None.
This commit is contained in:
Campbell Barton 2011-02-05 09:57:02 +00:00
parent 8b52087d83
commit 998198a041
9 changed files with 167 additions and 46 deletions

@ -10,7 +10,7 @@ vec_b = mathutils.Vector((0, 1, 2))
vec2d = mathutils.Vector((1, 2)) vec2d = mathutils.Vector((1, 2))
vec3d = mathutils.Vector((1, 0, 0)) vec3d = mathutils.Vector((1, 0, 0))
vec4d = vec_a.copy().resize4D() vec4d = vec_a.to_4d()
# other mathutuls types # other mathutuls types
quat = mathutils.Quaternion() quat = mathutils.Quaternion()

@ -3,15 +3,15 @@ from math import radians
vec = mathutils.Vector((1.0, 2.0, 3.0)) vec = mathutils.Vector((1.0, 2.0, 3.0))
mat_rot = mathutils.Matrix.Rotation(radians(90), 4, 'X') mat_rot = mathutils.Matrix.Rotation(radians(90.0), 4, 'X')
mat_trans = mathutils.Matrix.Translation(vec) mat_trans = mathutils.Matrix.Translation(vec)
mat = mat_trans * mat_rot mat = mat_trans * mat_rot
mat.invert() mat.invert()
mat3 = mat.rotation_part() mat3 = mat.to_3x3()
quat1 = mat.to_quat() quat1 = mat.to_quaternion()
quat2 = mat3.to_quat() quat2 = mat3.to_quaternion()
angle = quat1.difference(quat2) angle = quat1.difference(quat2)

@ -47,6 +47,7 @@
* - toEuler --> to_euler * - toEuler --> to_euler
* - toQuat --> to_quat * - toQuat --> to_quat
* - Vector.toTrackQuat --> Vector.to_track_quat * - Vector.toTrackQuat --> Vector.to_track_quat
* - Vector.rotate(axis, angle) --> rotate(other), where other can be Euler/Quaternion/Matrix.
* - Quaternion * Quaternion --> cross product (not dot product) * - Quaternion * Quaternion --> cross product (not dot product)
* - Euler.rotate(angle, axis) --> Euler.rotate_axis(axis, angle) * - Euler.rotate(angle, axis) --> Euler.rotate_axis(axis, angle)
* - Euler.unique() *removed*, not a standard function only toggled different rotations. * - Euler.unique() *removed*, not a standard function only toggled different rotations.
@ -164,6 +165,49 @@ int mathutils_array_parse(float *array, int array_min, int array_max, PyObject *
} }
} }
int mathutils_any_to_rotmat(float rmat[3][3], PyObject *value, const char *error_prefix)
{
if(EulerObject_Check(value)) {
if(!BaseMath_ReadCallback((BaseMathObject *)value)) {
return -1;
}
else {
eulO_to_mat3(rmat, ((EulerObject *)value)->eul, ((EulerObject *)value)->order);
return 0;
}
}
else if (QuaternionObject_Check(value)) {
if(!BaseMath_ReadCallback((BaseMathObject *)value)) {
return -1;
}
else {
float tquat[4];
normalize_qt_qt(tquat, ((QuaternionObject *)value)->quat);
quat_to_mat3(rmat, tquat);
return 0;
}
}
else if (MatrixObject_Check(value)) {
if(!BaseMath_ReadCallback((BaseMathObject *)value)) {
return -1;
}
else if(((MatrixObject *)value)->colSize < 3 || ((MatrixObject *)value)->rowSize < 3) {
PyErr_Format(PyExc_ValueError, "%.200s: matrix must have minimum 3x3 dimensions", error_prefix);
return -1;
}
else {
matrix_as_3x3(rmat, (MatrixObject *)value);
normalize_m3(rmat);
return 0;
}
}
else {
PyErr_Format(PyExc_TypeError, "%.200s: expected a Euler, Quaternion or Matrix type, found %.200s", error_prefix, Py_TYPE(value)->tp_name);
return -1;
}
}
//----------------------------------MATRIX FUNCTIONS-------------------- //----------------------------------MATRIX FUNCTIONS--------------------

@ -100,5 +100,6 @@ int _BaseMathObject_WriteIndexCallback(BaseMathObject *self, int index);
/* utility func */ /* utility func */
int mathutils_array_parse(float *array, int array_min, int array_max, PyObject *value, const char *error_prefix); int mathutils_array_parse(float *array, int array_min, int array_max, PyObject *value, const char *error_prefix);
int mathutils_any_to_rotmat(float rmat[3][3], PyObject *value, const char *error_prefix);
#endif /* MATHUTILS_H */ #endif /* MATHUTILS_H */

@ -180,8 +180,6 @@ static char Euler_rotate_axis_doc[] =
" :type axis: string\n" " :type axis: string\n"
" :arg angle: angle in radians.\n" " :arg angle: angle in radians.\n"
" :type angle: float\n" " :type angle: float\n"
" :return: an instance of itself\n"
" :rtype: :class:`Euler`"
; ;
static PyObject *Euler_rotate_axis(EulerObject * self, PyObject *args) static PyObject *Euler_rotate_axis(EulerObject * self, PyObject *args)
{ {
@ -204,8 +202,35 @@ static PyObject *Euler_rotate_axis(EulerObject * self, PyObject *args)
else rotate_eulO(self->eul, self->order, *axis, angle); else rotate_eulO(self->eul, self->order, *axis, angle);
(void)BaseMath_WriteCallback(self); (void)BaseMath_WriteCallback(self);
Py_INCREF(self);
return (PyObject *)self; Py_RETURN_NONE;
}
static char Euler_rotate_doc[] =
".. method:: rotate(other)\n"
"\n"
" Rotates the euler a by another mathutils value.\n"
"\n"
" :arg other: rotation component of mathutils value\n"
" :type other: :class:`Euler`, :class:`Quaternion` or :class:`Matrix`\n"
;
static PyObject *Euler_rotate(EulerObject * self, PyObject *value)
{
float self_rmat[3][3], other_rmat[3][3], rmat[3][3];
if(!BaseMath_ReadCallback(self))
return NULL;
if(mathutils_any_to_rotmat(other_rmat, value, "euler.rotate(value)") == -1)
return NULL;
eulO_to_mat3(self_rmat, self->eul, self->order);
mul_m3_m3m3(rmat, self_rmat, other_rmat);
mat3_to_compatible_eulO(self->eul, self->eul, self->order, rmat);
(void)BaseMath_WriteCallback(self);
Py_RETURN_NONE;
} }
static char Euler_make_compatible_doc[] = static char Euler_make_compatible_doc[] =
@ -215,8 +240,6 @@ static char Euler_make_compatible_doc[] =
"\n" "\n"
" :arg other: make compatible with this rotation.\n" " :arg other: make compatible with this rotation.\n"
" :type other: :class:`Euler`\n" " :type other: :class:`Euler`\n"
" :return: an instance of itself.\n"
" :rtype: :class:`Euler`\n"
"\n" "\n"
" .. note:: the rotation order is not taken into account for this function.\n" " .. note:: the rotation order is not taken into account for this function.\n"
; ;
@ -233,8 +256,8 @@ static PyObject *Euler_make_compatible(EulerObject * self, PyObject *value)
compatible_eul(self->eul, teul); compatible_eul(self->eul, teul);
(void)BaseMath_WriteCallback(self); (void)BaseMath_WriteCallback(self);
Py_INCREF(self);
return (PyObject *)self; Py_RETURN_NONE;
} }
//----------------------------Euler.rotate()----------------------- //----------------------------Euler.rotate()-----------------------
@ -564,6 +587,7 @@ static struct PyMethodDef Euler_methods[] = {
{"to_matrix", (PyCFunction) Euler_to_matrix, METH_NOARGS, Euler_to_matrix_doc}, {"to_matrix", (PyCFunction) Euler_to_matrix, METH_NOARGS, Euler_to_matrix_doc},
{"to_quaternion", (PyCFunction) Euler_to_quaternion, METH_NOARGS, Euler_to_quaternion_doc}, {"to_quaternion", (PyCFunction) Euler_to_quaternion, METH_NOARGS, Euler_to_quaternion_doc},
{"rotate_axis", (PyCFunction) Euler_rotate_axis, METH_VARARGS, Euler_rotate_axis_doc}, {"rotate_axis", (PyCFunction) Euler_rotate_axis, METH_VARARGS, Euler_rotate_axis_doc},
{"rotate", (PyCFunction) Euler_rotate, METH_O, Euler_rotate_doc},
{"make_compatible", (PyCFunction) Euler_make_compatible, METH_O, Euler_make_compatible_doc}, {"make_compatible", (PyCFunction) Euler_make_compatible, METH_O, Euler_make_compatible_doc},
{"__copy__", (PyCFunction) Euler_copy, METH_NOARGS, Euler_copy_doc}, {"__copy__", (PyCFunction) Euler_copy, METH_NOARGS, Euler_copy_doc},
{"copy", (PyCFunction) Euler_copy, METH_NOARGS, Euler_copy_doc}, {"copy", (PyCFunction) Euler_copy, METH_NOARGS, Euler_copy_doc},

@ -608,7 +608,7 @@ static PyObject *C_Matrix_Shear(PyObject *cls, PyObject *args)
return newMatrixObject(mat, matSize, matSize, Py_NEW, (PyTypeObject *)cls); return newMatrixObject(mat, matSize, matSize, Py_NEW, (PyTypeObject *)cls);
} }
static void matrix_as_3x3(float mat[3][3], MatrixObject *self) void matrix_as_3x3(float mat[3][3], MatrixObject *self)
{ {
copy_v3_v3(mat[0], self->matrix[0]); copy_v3_v3(mat[0], self->matrix[0]);
copy_v3_v3(mat[1], self->matrix[1]); copy_v3_v3(mat[1], self->matrix[1]);
@ -733,9 +733,6 @@ static char Matrix_resize_4x4_doc[] =
".. method:: resize_4x4()\n" ".. method:: resize_4x4()\n"
"\n" "\n"
" Resize the matrix to 4x4.\n" " Resize the matrix to 4x4.\n"
"\n"
" :return: an instance of itself.\n"
" :rtype: :class:`Matrix`\n"
; ;
static PyObject *Matrix_resize_4x4(MatrixObject *self) static PyObject *Matrix_resize_4x4(MatrixObject *self)
{ {
@ -785,8 +782,7 @@ static PyObject *Matrix_resize_4x4(MatrixObject *self)
self->rowSize = 4; self->rowSize = 4;
self->colSize = 4; self->colSize = 4;
Py_INCREF(self); Py_RETURN_NONE;
return (PyObject *)self;
} }
static char Matrix_to_4x4_doc[] = static char Matrix_to_4x4_doc[] =
@ -976,6 +972,40 @@ static PyObject *Matrix_inverted(MatrixObject *self)
MATRIX_APPLY_TO_COPY(Matrix_invert, self); MATRIX_APPLY_TO_COPY(Matrix_invert, self);
} }
static char Matrix_rotate_doc[] =
".. method:: rotate(other)\n"
"\n"
" Rotates the matrix a by another mathutils value.\n"
"\n"
" :arg other: rotation component of mathutils value\n"
" :type other: :class:`Euler`, :class:`Quaternion` or :class:`Matrix`\n"
"\n"
" .. note:: If any of the columns are not unit length this may not have desired results.\n"
;
static PyObject *Matrix_rotate(MatrixObject *self, PyObject *value)
{
float self_rmat[3][3], other_rmat[3][3], rmat[3][3];
if(!BaseMath_ReadCallback(self))
return NULL;
if(mathutils_any_to_rotmat(other_rmat, value, "matrix.rotate(value)") == -1)
return NULL;
if(self->colSize != 3 || self->rowSize != 3) {
PyErr_SetString(PyExc_ValueError, "Matrix must have 3x3 dimensions");
return NULL;
}
matrix_as_3x3(self_rmat, self);
mul_m3_m3m3(rmat, self_rmat, other_rmat);
copy_m3_m3((float (*)[3])(self->contigPtr), rmat);
(void)BaseMath_WriteCallback(self);
Py_RETURN_NONE;
}
/*---------------------------Matrix.decompose() ---------------------*/ /*---------------------------Matrix.decompose() ---------------------*/
static char Matrix_decompose_doc[] = static char Matrix_decompose_doc[] =
".. method:: decompose()\n" ".. method:: decompose()\n"
@ -1733,6 +1763,7 @@ static struct PyMethodDef Matrix_methods[] = {
// TODO. {"resize_3x3", (PyCFunction) Matrix_resize3x3, METH_NOARGS, Matrix_resize3x3_doc}, // TODO. {"resize_3x3", (PyCFunction) Matrix_resize3x3, METH_NOARGS, Matrix_resize3x3_doc},
{"to_4x4", (PyCFunction) Matrix_to_4x4, METH_NOARGS, Matrix_to_4x4_doc}, {"to_4x4", (PyCFunction) Matrix_to_4x4, METH_NOARGS, Matrix_to_4x4_doc},
{"resize_4x4", (PyCFunction) Matrix_resize_4x4, METH_NOARGS, Matrix_resize_4x4_doc}, {"resize_4x4", (PyCFunction) Matrix_resize_4x4, METH_NOARGS, Matrix_resize_4x4_doc},
{"rotate", (PyCFunction) Matrix_rotate, METH_O, Matrix_rotate_doc},
/* return converted representation */ /* return converted representation */
{"to_euler", (PyCFunction) Matrix_to_euler, METH_VARARGS, Matrix_to_euler_doc}, {"to_euler", (PyCFunction) Matrix_to_euler, METH_VARARGS, Matrix_to_euler_doc},

@ -55,4 +55,6 @@ PyObject *newMatrixObject_cb(PyObject *user, int rowSize, int colSize, int cb_ty
extern int mathutils_matrix_vector_cb_index; extern int mathutils_matrix_vector_cb_index;
extern struct Mathutils_Callback mathutils_matrix_vector_cb; extern struct Mathutils_Callback mathutils_matrix_vector_cb;
void matrix_as_3x3(float mat[3][3], MatrixObject *self);
#endif /* MATHUTILS_MATRIX_H */ #endif /* MATHUTILS_MATRIX_H */

@ -256,6 +256,36 @@ static PyObject *Quaternion_slerp(QuaternionObject *self, PyObject *args)
return newQuaternionObject(quat, Py_NEW, Py_TYPE(self)); return newQuaternionObject(quat, Py_NEW, Py_TYPE(self));
} }
static char Quaternion_rotate_doc[] =
".. method:: rotate(other)\n"
"\n"
" Rotates the quaternion a by another mathutils value.\n"
"\n"
" :arg other: rotation component of mathutils value\n"
" :type other: :class:`Euler`, :class:`Quaternion` or :class:`Matrix`\n"
;
static PyObject *Quaternion_rotate(QuaternionObject *self, PyObject *value)
{
float self_rmat[3][3], other_rmat[3][3], rmat[3][3];
float tquat[4], length;
if(!BaseMath_ReadCallback(self))
return NULL;
if(mathutils_any_to_rotmat(other_rmat, value, "quaternion.rotate(value)") == -1)
return NULL;
length= normalize_qt_qt(tquat, self->quat);
quat_to_mat3(self_rmat, tquat);
mul_m3_m3m3(rmat, self_rmat, other_rmat);
mat3_to_quat(self->quat, rmat);
mul_qt_fl(self->quat, length); /* maintain length after rotating */
(void)BaseMath_WriteCallback(self);
Py_RETURN_NONE;
}
//----------------------------Quaternion.normalize()---------------- //----------------------------Quaternion.normalize()----------------
//normalize the axis of rotation of [theta,vector] //normalize the axis of rotation of [theta,vector]
static char Quaternion_normalize_doc[] = static char Quaternion_normalize_doc[] =
@ -962,6 +992,7 @@ static struct PyMethodDef Quaternion_methods[] = {
{"dot", (PyCFunction) Quaternion_dot, METH_O, Quaternion_dot_doc}, {"dot", (PyCFunction) Quaternion_dot, METH_O, Quaternion_dot_doc},
{"difference", (PyCFunction) Quaternion_difference, METH_O, Quaternion_difference_doc}, {"difference", (PyCFunction) Quaternion_difference, METH_O, Quaternion_difference_doc},
{"slerp", (PyCFunction) Quaternion_slerp, METH_VARARGS, Quaternion_slerp_doc}, {"slerp", (PyCFunction) Quaternion_slerp, METH_VARARGS, Quaternion_slerp_doc},
{"rotate", (PyCFunction) Quaternion_rotate, METH_VARARGS, Quaternion_rotate_doc},
{"__copy__", (PyCFunction) Quaternion_copy, METH_NOARGS, Quaternion_copy_doc}, {"__copy__", (PyCFunction) Quaternion_copy, METH_NOARGS, Quaternion_copy_doc},
{"copy", (PyCFunction) Quaternion_copy, METH_NOARGS, Quaternion_copy_doc}, {"copy", (PyCFunction) Quaternion_copy, METH_NOARGS, Quaternion_copy_doc},

@ -715,44 +715,32 @@ static PyObject *Vector_lerp(VectorObject *self, PyObject *args)
} }
static char Vector_rotate_doc[] = static char Vector_rotate_doc[] =
".. function:: rotate(axis, angle)\n" ".. function:: rotate(other)\n"
"\n" "\n"
" Return vector rotated around axis by angle.\n" " Return vector by a rotation value.\n"
"\n" "\n"
" :arg axis: rotation axis.\n" " :arg other: rotation component of mathutils value\n"
" :type axis: :class:`Vector`\n" " :type other: :class:`Euler`, :class:`Quaternion` or :class:`Matrix`\n"
" :arg angle: angle in radians.\n"
" :type angle: float\n"
" :return: an instance of itself\n"
" :rtype: :class:`Vector`\n"
; ;
static PyObject *Vector_rotate(VectorObject *self, PyObject *args) static PyObject *Vector_rotate(VectorObject *self, PyObject *value)
{ {
PyObject *value; float other_rmat[3][3];
float angle, vec[3], tvec[3];
if(!BaseMath_ReadCallback(self)) if(!BaseMath_ReadCallback(self))
return NULL; return NULL;
if(!PyArg_ParseTuple(args, "Of:rotate", &value, &angle)){ if(mathutils_any_to_rotmat(other_rmat, value, "vector.rotate(value)") == -1)
PyErr_SetString(PyExc_TypeError, "vec.rotate(axis, angle): expected 3D axis (Vector) and angle (float)"); return NULL;
if(self->size < 3) {
PyErr_SetString(PyExc_ValueError, "Vector must be 3D or 4D");
return NULL; return NULL;
} }
if(self->size != 3) { mul_m3_v3(other_rmat, self->vec);
PyErr_SetString(PyExc_AttributeError, "vec.rotate(axis, angle): expects both vectors to be 3D");
return NULL;
}
if(mathutils_array_parse(tvec, 3, 3, value, "vector.rotate(axis, angle), invalid 'axis' arg") == -1) (void)BaseMath_WriteCallback(self);
return NULL; Py_RETURN_NONE;
rotate_v3_v3v3fl(vec, self->vec, tvec, angle);
copy_v3_v3(self->vec, vec);
Py_INCREF(self);
return (PyObject *)self;
} }
static char Vector_copy_doc[] = static char Vector_copy_doc[] =
@ -2119,7 +2107,7 @@ static struct PyMethodDef Vector_methods[] = {
{"difference", (PyCFunction) Vector_difference, METH_O, Vector_difference_doc}, {"difference", (PyCFunction) Vector_difference, METH_O, Vector_difference_doc},
{"project", (PyCFunction) Vector_project, METH_O, Vector_project_doc}, {"project", (PyCFunction) Vector_project, METH_O, Vector_project_doc},
{"lerp", (PyCFunction) Vector_lerp, METH_VARARGS, Vector_lerp_doc}, {"lerp", (PyCFunction) Vector_lerp, METH_VARARGS, Vector_lerp_doc},
{"rotate", (PyCFunction) Vector_rotate, METH_VARARGS, Vector_rotate_doc}, {"rotate", (PyCFunction) Vector_rotate, METH_O, Vector_rotate_doc},
{"copy", (PyCFunction) Vector_copy, METH_NOARGS, Vector_copy_doc}, {"copy", (PyCFunction) Vector_copy, METH_NOARGS, Vector_copy_doc},
{"__copy__", (PyCFunction) Vector_copy, METH_NOARGS, NULL}, {"__copy__", (PyCFunction) Vector_copy, METH_NOARGS, NULL},