Subversion Repositories gelsvn

  /** Compute inverse assuming that the upper-left 3x3 sub-matrix is

      orthonormal (which is the case if the transformation is only

      a concatenation of rotations and translations).

  */

  inline Mat4x4f invert_ortho(const Mat4x4f& m)

  {

    Vec3f rx(m[0][0], m[1][0], m[2][0]);

    Vec3f ry(m[0][1], m[1][1], m[2][1]);

    Vec3f rz(m[0][2], m[1][2], m[2][2]);

    Vec3f t(m[0][3], m[1][3], m[2][3]);

    return Mat4x4f(Vec4f(rx, -dot(t, rx)),

		   Vec4f(ry, -dot(t, ry)),

		   Vec4f(rz, -dot(t, rz)),

		   Vec4f(0.0, 0.0, 0.0, 1.0));

  }