Add #define TEST switch in maze.h