Update util.c

+ main