Fix wrong index in get_euler_xyz and wrong get_euler in G6DF Joint

This commit is contained in:
m4nu3lf 2017-09-17 01:48:46 +01:00
parent d4452e3a65
commit 0cb8d3ccbf
1 changed files with 1 additions and 1 deletions

View File

@ -221,7 +221,7 @@ Generic6DOFJointSW::Generic6DOFJointSW(BodySW *rbA, BodySW *rbB, const Transform
void Generic6DOFJointSW::calculateAngleInfo() { void Generic6DOFJointSW::calculateAngleInfo() {
Basis relative_frame = m_calculatedTransformB.basis.inverse() * m_calculatedTransformA.basis; Basis relative_frame = m_calculatedTransformB.basis.inverse() * m_calculatedTransformA.basis;
m_calculatedAxisAngleDiff = relative_frame.get_euler(); m_calculatedAxisAngleDiff = relative_frame.get_euler_xyz();
// in euler angle mode we do not actually constrain the angular velocity // in euler angle mode we do not actually constrain the angular velocity
// along the axes axis[0] and axis[2] (although we do use axis[1]) : // along the axes axis[0] and axis[2] (although we do use axis[1]) :