Fixes matrix trace zero validation.

Currently, the matrix trace is adding 1.0 before zero (epsilon) comparison.
Adding the offset of 1 before epsilon comparison introduces instability as Tr + 1 approaches 0.