Try to write tests, added util_test.go