Method InverseUnitDet

TSMatrix4D.cpp:1004–1049

}

Transform3D Terathon::InverseUnitDet(const Transform3D& m)
{
	#ifdef TERATHON_SSE

		Transform3D		result;

		vec_float a = VecLoad(&m(0,0));
		vec_float b = VecLoad(&m(0,1));
		vec_float c = VecLoad(&m(0,2));
		vec_float d = VecLoad(&m(0,3));

		vec_float t0 = VecShuffle<1,0,1,0>(a, b);
		vec_float t1 = VecShuffle<1,0,1,0>(c, d);
		vec_float t2 = VecShuffle<3,2,3,2>(a, b);
		vec_float t3 = VecShuffle<3,2,3,2>(c, d);

		vec_float r0 = VecShuffle<2,0,2,0>(t0, t1);
		vec_float r1 = VecShuffle<3,1,3,1>(t0, t1);
		vec_float r2 = VecShuffle<2,0,2,0>(t2, t3);

		vec_float s = VecCross3D(r0, r1);
		vec_float h = r0 * VecSmearW(r1) - r1 * VecSmearW(r0);

		VecStore(VecCross3D(r1, r2), &result(0,0));
		VecStore(VecCross3D(r2, r0), &result(0,1));
		VecStore(s, &result(0,2));
		VecStore(VecCross3D(h, r2) - s * VecSmearW(r2), &result(0,3));

		result(3,0) = result(3,1) = result(3,2) = 0.0F;
		result(3,3) = 1.0F;
		return (result);

	#else

		const Vector3D& a = m[0];
		const Vector3D& b = m[1];
		const Vector3D& c = m[2];
		const Vector3D& d = m[3];

		Bivector3D s = a ^ b;
		Bivector3D t = c ^ d;

		return (Transform3D(b ^ c, -(b ^ t), c ^ a, a ^ t, s, -(d ^ s)));

	#endif
}

Matrix3D Terathon::InverseUnitDet3D(const Transform3D& m)
{