Math documentation

I removed the todos, added comments to all functions. 

Btw, it would be more readable if Math trig functions use 'angle' instead of 'v'.