Update Main.c

Added your code so far and the First function using that code. It has errors in init, add, and main that I can't seem to figure out.