Utility func tests
Added some tests and benchmarks