diff --git a/core/math/matrix3.cpp b/core/math/matrix3.cpp index 98cab39ba35..b31df2fadbb 100644 --- a/core/math/matrix3.cpp +++ b/core/math/matrix3.cpp @@ -575,6 +575,8 @@ Basis::Basis(const Quat &p_quat) { Basis::Basis(const Vector3 &p_axis, real_t p_phi) { // Rotation matrix from axis and angle, see https://en.wikipedia.org/wiki/Rotation_matrix#Rotation_matrix_from_axis_and_angle + ERR_FAIL_COND(p_axis.is_normalized() == false); + Vector3 axis_sq(p_axis.x * p_axis.x, p_axis.y * p_axis.y, p_axis.z * p_axis.z); real_t cosine = Math::cos(p_phi); diff --git a/core/math/vector3.h b/core/math/vector3.h index fc02e66c331..097d6b94802 100644 --- a/core/math/vector3.h +++ b/core/math/vector3.h @@ -75,6 +75,7 @@ struct Vector3 { _FORCE_INLINE_ void normalize(); _FORCE_INLINE_ Vector3 normalized() const; + _FORCE_INLINE_ bool is_normalized() const; _FORCE_INLINE_ Vector3 inverse() const; _FORCE_INLINE_ void zero(); @@ -385,6 +386,10 @@ Vector3 Vector3::normalized() const { return v; } +bool Vector3::is_normalized() const { + return Math::isequal_approx(length(), (real_t)1.0); +} + Vector3 Vector3::inverse() const { return Vector3(1.0 / x, 1.0 / y, 1.0 / z); diff --git a/doc/base/classes.xml b/doc/base/classes.xml index 908995196af..3881197ec93 100644 --- a/doc/base/classes.xml +++ b/doc/base/classes.xml @@ -20704,7 +20704,7 @@ 3x3 matrix datatype. - 3x3 matrix used for 3D rotation and scale. Contains 3 vector fields x,y and z as its columns, which can be interpreted as the local basis vectors of a transformation. Can also be accessed as array of 3D vectors. Almost always used as orthogonal basis for a [Transform]. + 3x3 matrix used for 3D rotation and scale. Contains 3 vector fields x,y and z as its columns, which can be interpreted as the local basis vectors of a transformation. Can also be accessed as array of 3D vectors. These vectors are orthogonal to each other, but are not necessarily normalized. Almost always used as orthogonal basis for a [Transform]. For such use, it is composed of a scaling and a rotation matrix, in that order (M = R.S). @@ -20725,7 +20725,7 @@ - Create a rotation matrix which rotates around the given axis by the specified angle. + Create a rotation matrix which rotates around the given axis by the specified angle. The axis must be a normalized vector. @@ -20792,7 +20792,7 @@ - Introduce an additional rotation around the given axis by phi. Only relevant when the matrix is being used as a part of [Transform]. + Introduce an additional rotation around the given axis by phi. Only relevant when the matrix is being used as a part of [Transform]. The axis must be a normalized vector. @@ -31548,7 +31548,7 @@ - Returns a quaternion that will rotate around the given axis by the specified angle. + Returns a quaternion that will rotate around the given axis by the specified angle. The axis must be a normalized vector. @@ -43200,7 +43200,7 @@ - Rotate the transform around given axis by phi. + Rotate the transform around given axis by phi. The axis must be a normalized vector. @@ -45402,7 +45402,7 @@ do_property]. - Rotates the vector around some axis by phi radians. + Rotates the vector around some axis by phi radians. The axis must be a normalized vector.