Functions mean_square have been moved to 'testhelper.hpp'. Created the functions 'equal_to' to test if matrices or vectors are equals (based on mean_square).