Finished the program.
Still need to add better/more comments.