Outlined Math.h (incomplete)

also added some enums. Yum.
Implemented some Math.h stuff.

trig functions still TODO
Polished some inclusions.

Prepatory commit (going to push to swerve-drive next).
Merge pull request #24 from OlyCow/libraries

Library update! (mainly math-related)