Fixes bug and add a test in CMath::vec3_t<TYPE>