diff --git a/src/LinearMath/btMatrix3x3.h b/src/LinearMath/btMatrix3x3.h index 96d0ba98f..9f642a177 100644 --- a/src/LinearMath/btMatrix3x3.h +++ b/src/LinearMath/btMatrix3x3.h @@ -682,6 +682,7 @@ public: void diagonalize(btMatrix3x3& rot, btScalar tolerance = 1.0e-9, int maxIter=100) { btQuaternion r; + r = btQuaternion::getIdentity(); extractRotation(r,tolerance,maxIter); rot.setRotation(r); btMatrix3x3 rotInv = btMatrix3x3(r.inverse());