Timer change, sonar fixes and preliminary motor.

Using timer 5 instead of 3. Only configure sonar if we are using it, and
don't try to send string when serial is disabled. In addition motor code
has been added, but it is untested.
Merge branch 'master' of https://github.com/Boren/BoreCopter