hamham91/initial utility library

Created a Utility library which currently contains functions for wrapping increments and decrements as well as branchless int comparisons. Also removed most templating in favor of macro declarations to reduce code bloat and compile times. Wrote unit tests for the new functionality and made several miscellaneous fixes.