Commented and Cleaned Up Code

Cleaned up my code, should be testing ready now.  Also added comments to
how the algorithms I'm using should work in case there are bugs.