Add algorithm header to utils.h