Simple math fucntions added and tested