Add check_rotation_matrix test

SimoxUtility/math/pose/check_rotation_matrix.cpp

SimoxUtility/tests/math/pose/CMakeLists.txt

SimoxUtility/tests/math/pose/check_rotation_matrix.cpp