Create util.h

Holds a bunch of utility functions used all throughout the program