Clean-up, Added InverseMultiply

Some clean-up of the code, removing of test code, and added the
InverseMultiply function to Quaterniond, which multiplies by the
inverse, thus avoiding one inverse operation.