Math lib uses radians, not degrees.

Fixed error in previous commit, should now be working decently.
The actual hooks used to initialize the MotorControl are modified,
since the communications with hardware is not ready quite yet.

Signed-off-by: Anton Landberg <git@atnon.se>