Add unit test for UtitlityFunctions.m