Finished init, push, pop and sample implementation file main.c