Add MoveTo and Angle methods

I'm not entirely sure that this is a good API. It might be better to
separate the high-level (MoveTo) and low-level (SetGoalPosition) methods
into different objects, but this is rather more usable.
Normalize multiply-rotated angles