Wrote main body of code, still need to do cleanup and commenting.
Added comments and comment documentation