Fix: MAke quaternion check in unittest more robust

Fix: MAke quaternion check in unittest more robust

Just add an epsilon test by using the correct comparator from gtest.