Added step functions to math.c, and moved scaleTo()

scaleTo() has been moved from movement.c to math.c. Headers have been
updated to reflect this.
Removed scaleTo method

Read last commit for slightly more info.
Fixed Daniel's crazy methods

They will never work. I've removed them completely so that they can be
rewritten into a working state.
Updated to-do list

Crossed some stuff off today