Updated lots of commenting

Standardized on Matlab comment style, and began commenting the code
to 15-150 standards. You're just lucky I didn't requires-ensures
everything :P