Added an utility library

Contains a few functions that should be useful for the implementation