Added gauss utils functions and tested