moved init timers to motorcontrol.c

- moved init timers to motorcontrol.c
- created arm/disarm function
- created motor drive function