Add utils.cpp and utils.h