Clean up util.h and util.c