Add lib/utility.h with various utility macros/functions