Method Transform

TSMotor3D.cpp:213–239

}

FlatPoint3D Terathon::Transform(const FlatPoint3D& p, const Motor3D& Q)
{
	#ifdef TERATHON_SSE

		FlatPoint3D		result;

		vec_float q = VecLoadUnaligned(&p.x);
		vec_float v = VecLoadUnaligned(&Q.v.x);
		vec_float m = VecLoadUnaligned(&Q.m.x);
		vec_float qw = VecSmearW(q);
		vec_float vw = VecSmearW(v);
		vec_float mw = VecSmearW(m);

		vec_float a = VecCross3D(v, q) + m * qw;
		vec_float u = VecCross3D(v, a) + a * vw - v * (mw * qw);

		VecStore3D(q + (u + u), &result.x);
		result.w = p.w;
		return (result);

	#else

		Bivector3D a = (!Q.v.xyz ^ p.xyz) + Q.m.xyz * p.w;
		return (FlatPoint3D(p.xyz + ((Q.v.xyz ^ a) + !a * Q.v.w - !Q.v.xyz * (Q.m.w * p.w)) * 2.0F, p.w));

	#endif
}

Point3D Terathon::Transform(const Point3D& p, const Motor3D& Q)
{