Add Init.cpp, Update main.cpp and Makefile