Based on code review comments put this function into util.
Added a couple simple unit tests for sanity checking purposes.